view rvinterf/lowlevel/logsent.c @ 992:a7b0b426f9ca

target-utils: boot ROM UART autodetection revamped The new implementation should work with both the familiar Calypso C035 boot ROM version found in our regular targets as well as the older Calypso F741979B version found on the vintage D-Sample board.
author Mychaela Falconia <falcon@ivan.Harhan.ORG>
date Wed, 30 Dec 2015 21:28:41 +0000
parents da9a36515da6
children
line wrap: on
line source

/*
 * This module implements the logging of sent packets
 */

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

static void
log_sent_ati(pkt, pktlen)
	u_char *pkt;
{
	char buf[MAX_PKT_TO_TARGET*4+10];
	int i, c;
	char *dp;

	strcpy(buf, "Sent to ATI: ");
	dp = buf + 13;
	for (i = 1; i < pktlen; i++) {
		c = pkt[i];
		if (c & 0x80) {
			*dp++ = 'M';
			*dp++ = '-';
			c &= 0x7F;
		}
		if (c < 0x20) {
			*dp++ = '^';
			*dp++ = c + '@';
		} else if (c == 0x7F) {
			*dp++ = '^';
			*dp++ = '?';
		} else
			*dp++ = c;
	}
	*dp = '\0';
	output_line(buf);
}

static void
log_sent_gpf(pkt, pktlen)
	u_char *pkt;
{
	char buf[MAX_PKT_TO_TARGET*4+30];

	strcpy(buf, "Sent ");
	format_g23_packet(pkt, pktlen, buf + 5);
	output_line(buf);
}

static void
log_sent_other(pkt, pktlen)
	u_char *pkt;
{
	char buf[MAX_PKT_TO_TARGET*3+5];
	int i;
	char *dp;

	dp = buf;
	strcpy(dp, "Sent");
	dp += 4;
	for (i = 0; i < pktlen; i++) {
		sprintf(dp, " %02X", pkt[i]);
		dp += 3;
	}
	*dp = '\0';
	output_line(buf);
}

log_sent_packet(pkt, pktlen)
	u_char *pkt;
{
	switch (pkt[0]) {
	case RVT_L23_HEADER:
		log_sent_gpf(pkt, pktlen);
		return;
	case RVT_AT_HEADER:
		log_sent_ati(pkt, pktlen);
		return;
	default:
		log_sent_other(pkt, pktlen);
	}
}