# HG changeset patch
# User Michael Spacefalcon <msokolov@ivan.Harhan.ORG>
# Date 1385280207 0
# Node ID 85222710dc92725e349bc634786756a9030f5b16
# Parent  13a0348ffce448791e286eee837e9a02e7241b4a
rvinterf/etm: implemented everything except the packet sending command

diff -r 13a0348ffce4 -r 85222710dc92 rvinterf/etm/Makefile
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/rvinterf/etm/Makefile	Sun Nov 24 08:03:27 2013 +0000
@@ -0,0 +1,18 @@
+CC=	gcc
+CFLAGS=	-O2
+PROGS=	fc-tmsh
+INSTBIN=/usr/local/bin
+
+TMSH_OBJS=	etmbasic.o init.o interf.o main.o pktsort.o ttymagic.o usercmd.o
+
+all:	${PROGS}
+
+fc-tmsh:	${TMSH_OBJS}
+	${CC} ${CFLAGS} -o $@ ${TMSH_OBJS}
+
+install:	${PROGS}
+	mkdir -p ${INSTBIN}
+	install -c ${PROGS} ${INSTBIN}
+
+clean:
+	rm -f *.o *.out *errs ${PROGS}
diff -r 13a0348ffce4 -r 85222710dc92 rvinterf/etm/etmbasic.c
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/rvinterf/etm/etmbasic.c	Sun Nov 24 08:03:27 2013 +0000
@@ -0,0 +1,35 @@
+/*
+ * Basic ETM interaction
+ */
+
+#include <sys/types.h>
+#include <stdio.h>
+#include <string.h>
+#include <strings.h>
+#include <stdlib.h>
+#include "../limits.h"
+
+extern u_char rvi_msg[];
+extern int rvi_msg_len;
+
+void
+etm_packet_rx()
+{
+	char buf[MAX_PKT_FROM_TARGET*3+80], *dp;
+	int i, c;
+
+	if (rvi_msg_len < 4) {
+		async_msg_output("!!! Short ETM Rx packet !!!");
+		return;
+	}
+	strcpy(buf, "Pkt from ETM:");
+	dp = index(buf, '\0');
+	c = 0;
+	for (i = 2; i < rvi_msg_len; i++) {
+		sprintf(dp, " %02X", rvi_msg[i]);
+		dp += 3;
+		c ^= rvi_msg[i];
+	}
+	sprintf(dp, " chksum %s", c ? "BAD" : "OK");
+	async_msg_output(buf);
+}
diff -r 13a0348ffce4 -r 85222710dc92 rvinterf/etm/interf.c
--- a/rvinterf/etm/interf.c	Sun Nov 24 06:59:09 2013 +0000
+++ b/rvinterf/etm/interf.c	Sun Nov 24 08:03:27 2013 +0000
@@ -35,8 +35,27 @@
 void
 process_msg_from_rvinterf()
 {
-
-
+	switch (rvi_msg[0]) {
+	case RVI2CLI_PKT_FROM_TARGET:
+		process_pkt_from_target();
+		return;
+	case RVI2CLI_LOCAL_CMD_RESP:
+		if (rvi_msg_len < 2)
+			goto bad;
+		if (rvi_msg[1] == '+')
+			return;
+		tty_cleanup();
+		fprintf(stderr, "Error from rvinterf: %.*s\n", rvi_msg_len - 1,
+			rvi_msg + 1);
+		exit(1);
+	default:
+	bad:
+		tty_cleanup();
+		fprintf(stderr,
+			"Error: unexpected message type %02X from rvinterf\n",
+			rvi_msg[0]);
+		exit(1);
+	}
 }
 
 void
diff -r 13a0348ffce4 -r 85222710dc92 rvinterf/etm/localtypes.h
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/rvinterf/etm/localtypes.h	Sun Nov 24 08:03:27 2013 +0000
@@ -0,0 +1,7 @@
+/*
+ * Our own definition of u8/u16/u32
+ */
+
+typedef unsigned char u8;
+typedef unsigned short u16;
+typedef unsigned int u32;
diff -r 13a0348ffce4 -r 85222710dc92 rvinterf/etm/pktsort.c
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/rvinterf/etm/pktsort.c	Sun Nov 24 08:03:27 2013 +0000
@@ -0,0 +1,111 @@
+/*
+ * Here we sort out incoming packets from the target relayed via rvinterf.
+ */
+
+#include <sys/types.h>
+#include <stdio.h>
+#include <string.h>
+#include <strings.h>
+#include <stdlib.h>
+#include "../pktmux.h"
+#include "../limits.h"
+#include "../localsock.h"
+#include "localtypes.h"
+#include "etm.h"
+
+extern u_char rvi_msg[];
+extern int rvi_msg_len;
+
+void
+safe_print_trace(src, srclen, dest)
+	u_char *src;
+	char *dest;
+{
+	int i, c;
+	char *dp;
+
+	dp = dest;
+	for (i = 0; i < srclen; i++) {
+		c = src[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';
+}
+
+static void
+handle_useid_0()
+{
+	char buf[MAX_PKT_FROM_TARGET*4];
+
+	if (strncmp(rvi_msg + 7, "RVT: Lost Message", 17))
+		return;
+	safe_print_trace(rvi_msg + 7, rvi_msg_len - 7, buf);
+	async_msg_output(buf);
+}
+
+static void
+print_etm_trace()
+{
+	char buf[MAX_PKT_FROM_TARGET*4];
+
+	strcpy(buf, "ETM Tr: ");
+	safe_print_trace(rvi_msg + 7, rvi_msg_len - 7, buf + 9);
+	async_msg_output(buf);
+}
+
+static void
+process_rvt()
+{
+	u32 useid;
+
+	if (rvi_msg_len < 7) {
+		tty_cleanup();
+		fprintf(stderr, "Error: rvinterf sent us an invalid RVT msg\n");
+		exit(1);
+	}
+	useid = rvi_msg[2] << 24 | rvi_msg[3] << 16 | rvi_msg[4] << 8
+		| rvi_msg[5];
+	switch (useid) {
+	case 0:
+		handle_useid_0();
+		return;
+	case ETM_USE_ID:
+		print_etm_trace();
+		return;
+	default:
+		tty_cleanup();
+		fprintf(stderr, "unexpected fwd of USEID %08X from rvinterf\n",
+			useid);
+		exit(1);
+	}
+}
+
+void
+process_pkt_from_target()
+{
+	switch (rvi_msg[1]) {
+	case RVT_RV_HEADER:
+		process_rvt();
+		return;
+	case RVT_TM_HEADER:
+		etm_packet_rx();
+		return;
+	default:
+		tty_cleanup();
+		fprintf(stderr, "unexpected fwd of MUX %02X from rvinterf\n",
+			rvi_msg[1]);
+		exit(1);
+	}
+}
diff -r 13a0348ffce4 -r 85222710dc92 rvinterf/etm/ttymagic.c
--- a/rvinterf/etm/ttymagic.c	Sun Nov 24 06:59:09 2013 +0000
+++ b/rvinterf/etm/ttymagic.c	Sun Nov 24 08:03:27 2013 +0000
@@ -87,3 +87,26 @@
 		}
 	}
 }
+
+void
+async_msg_output(msg)
+	char *msg;
+{
+	int msglen, i;
+
+	msglen = strlen(msg);
+	if (ttyhacks)
+		putchar('\r');
+	fputs(msg, stdout);
+	if (ttyhacks)
+		for (i = msglen; i < usercmd_len + 1; i++)
+			putchar(' ');
+	putchar('\n');
+	if (!ttyhacks)
+		return;
+	/* reprint the input line */
+	putchar('>');
+	if (!usercmd_len)
+		return;
+	fwrite(usercmd, 1, usercmd_len, stdout);
+}