view rvinterf/tmsh/audioresp.c @ 505:7bf0d909c87e

fc-loadtool flash ID check: change of reset after the check logic This change only affects those flash configurations that have ID checks enabled. The logic for resetting the flash after the ID check has been changed as follows: 1) If the check fails, we return without attempting to reset the flash. 2) If the check is successful, we reset the flash using the configured method (could be AMD or Intel or Intel W30) instead of always doing an AMD flash reset as the original code did.
author Mychaela Falconia <falcon@freecalypso.org>
date Mon, 27 May 2019 19:58:01 +0000
parents ce7479d28b02
children
line wrap: on
line source

/*
 * In this module we are going to implement the handling of ETM_AUDIO responses.
 */

#include <sys/types.h>
#include <stdio.h>
#include <string.h>
#include <strings.h>
#include <stdlib.h>
#include "pktmux.h"
#include "limits.h"
#include "localtypes.h"
#include "etm.h"

extern u_char rvi_msg[];
extern int rvi_msg_len;

static void
aul_aus_response(op)
	char *op;
{
	char buf[80];

	if (rvi_msg_len != 6) {
		sprintf(buf, "%s response wrong length", op);
		print_etm_pkt_raw(buf);
		return;
	}
	if (rvi_msg[3])
		sprintf(buf, "%s error %u (0x%02X)", op,
			rvi_msg[3], rvi_msg[3]);
	else
		sprintf(buf, "%s OK", op);
	async_msg_output(buf);
}

static void
aur_response()
{
	char buf[80], *dp;
	unsigned i, j, l, size;

	if (rvi_msg_len < 7) {
tooshort:	print_etm_pkt_raw("aur response too short");
		return;
	}
	if (rvi_msg[3]) {
		if (rvi_msg_len == 7) {
			sprintf(buf, "aur %u error %u (0x%02X)", rvi_msg[5],
				rvi_msg[3], rvi_msg[3]);
			async_msg_output(buf);
		} else
			print_etm_pkt_raw("aur long error response");
		return;
	}
	if (rvi_msg_len < 8)
		goto tooshort;
	size = rvi_msg_len - 7;
	sprintf(buf, "aur %u: %u byte%s", rvi_msg[5], size,
		size != 1 ? "s" : "");
	async_msg_output(buf);
	for (i = 0; i < size; ) {
		l = size - i;
		if (l > 16)
			l = 16;
		sprintf(buf, "offset %02X:", i);
		dp = index(buf, '\0');
		for (j = 0; j < l; j++) {
			if (j == 0 || j == 8)
				*dp++ = ' ';
			sprintf(dp, " %02X", rvi_msg[i + 6]);
			i++;
			dp += 3;
		}
		async_msg_output(buf);
	}
}

static void
auw_response()
{
	char buf[80];

	if (rvi_msg_len != 7) {
		print_etm_pkt_raw("auw response wrong length");
		return;
	}
	if (rvi_msg[3])
		sprintf(buf, "auw %u error %u (0x%02X)", rvi_msg[5],
			rvi_msg[3], rvi_msg[3]);
	else
		sprintf(buf, "auw %u OK", rvi_msg[5]);
	async_msg_output(buf);
}

void
etm_audio_msg_rx()
{
	switch (rvi_msg[4]) {
	case 'L':
		aul_aus_response("aul");
		return;
	case 'S':
		aul_aus_response("aus");
		return;
	case 'R':
		aur_response();
		return;
	case 'W':
		auw_response();
		return;
	default:
	unknown:
		print_etm_pkt_raw("ETM_AUDIO");
	}
}