# HG changeset patch
# User Michael Spacefalcon <msokolov@ivan.Harhan.ORG>
# Date 1387097332 0
# Node ID c9ea2f7441a5f413f6a1f90b678aa016ef4fcb4d
# Parent  fa7174faa9aa1d41f267e07ccab7e1667f78f066
fc-tmsh: abb[rw] commands implemented

diff -r fa7174faa9aa -r c9ea2f7441a5 rvinterf/etm/Makefile
--- a/rvinterf/etm/Makefile	Sun Dec 15 07:31:52 2013 +0000
+++ b/rvinterf/etm/Makefile	Sun Dec 15 08:48:52 2013 +0000
@@ -3,7 +3,7 @@
 PROGS=	fc-tmsh
 INSTBIN=/usr/local/bin
 
-TMSH_OBJS=	etmbasic.o init.o interf.o launchrvif.o main.o pktsort.o \
+TMSH_OBJS=	abb.o etmbasic.o init.o interf.o launchrvif.o main.o pktsort.o \
 		tmcore.o ttymagic.o usercmd.o
 
 all:	${PROGS}
diff -r fa7174faa9aa -r c9ea2f7441a5 rvinterf/etm/abb.c
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/rvinterf/etm/abb.c	Sun Dec 15 08:48:52 2013 +0000
@@ -0,0 +1,98 @@
+/*
+ * In this module we are going to implement commands dealing with the ABB.
+ */
+
+#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;
+
+void
+cmd_abbr(argc, argv)
+	char **argv;
+{
+	u32 page, reg;
+	u_char cmdpkt[5];
+
+	page = strtoul(argv[1], 0, 0);
+	reg = strtoul(argv[2], 0, 0);
+	if (page > 1 || reg > 31) {
+		printf("error: argument(s) out of range\n");
+		return;
+	}
+	cmdpkt[1] = ETM_CORE;
+	cmdpkt[2] = TMCORE_OPC_CODEC_RD;
+	cmdpkt[3] = page << 5 | reg;
+	send_etm_cmd(cmdpkt, 3);
+}
+
+void
+abbr_response()
+{
+	unsigned pg, reg, val;
+	char buf[80];
+
+	if (rvi_msg[3]) {
+		print_etm_pkt_raw("abbr error");
+		return;
+	}
+	if (rvi_msg_len != 9) {
+		print_etm_pkt_raw("abbr malformed resp");
+		return;
+	}
+	pg = rvi_msg[5] >> 5;
+	reg = rvi_msg[5] & 0x1F;
+	val = rvi_msg[6] | rvi_msg[7] << 8;
+	sprintf(buf, "abbr %u %u: %03X", pg, reg, val);
+	async_msg_output(buf);
+}
+
+void
+cmd_abbw(argc, argv)
+	char **argv;
+{
+	u32 page, reg, val;
+	u_char cmdpkt[7];
+
+	page = strtoul(argv[1], 0, 0);
+	reg = strtoul(argv[2], 0, 0);
+	val = strtoul(argv[3], 0, 16);
+	if (page > 1 || reg > 31 || val > 0x3FF) {
+		printf("error: argument(s) out of range\n");
+		return;
+	}
+	cmdpkt[1] = ETM_CORE;
+	cmdpkt[2] = TMCORE_OPC_CODEC_WR;
+	cmdpkt[3] = page << 5 | reg;
+	cmdpkt[4] = val;
+	cmdpkt[5] = val >> 8;
+	send_etm_cmd(cmdpkt, 5);
+}
+
+void
+abbw_response()
+{
+	unsigned pg, reg;
+	char buf[80];
+
+	if (rvi_msg[3]) {
+		print_etm_pkt_raw("abbw error");
+		return;
+	}
+	if (rvi_msg_len != 7) {
+		print_etm_pkt_raw("abbw malformed resp");
+		return;
+	}
+	pg = rvi_msg[5] >> 5;
+	reg = rvi_msg[5] & 0x1F;
+	sprintf(buf, "abbw %u %u OK", pg, reg);
+	async_msg_output(buf);
+}
diff -r fa7174faa9aa -r c9ea2f7441a5 rvinterf/etm/tmcore.c
--- a/rvinterf/etm/tmcore.c	Sun Dec 15 07:31:52 2013 +0000
+++ b/rvinterf/etm/tmcore.c	Sun Dec 15 08:48:52 2013 +0000
@@ -180,9 +180,11 @@
 		version_response();
 		return;
 	case TMCORE_OPC_CODEC_RD:
+		abbr_response();
+		return;
 	case TMCORE_OPC_CODEC_WR:
-		/* not yet implemented */
-		goto unknown;
+		abbw_response();
+		return;
 	case TMCORE_OPC_DIEID:
 		dieid_response();
 		return;
diff -r fa7174faa9aa -r c9ea2f7441a5 rvinterf/etm/usercmd.c
--- a/rvinterf/etm/usercmd.c	Sun Dec 15 07:31:52 2013 +0000
+++ b/rvinterf/etm/usercmd.c	Sun Dec 15 08:48:52 2013 +0000
@@ -11,6 +11,8 @@
 
 extern char usercmd[];
 
+extern void cmd_abbr();
+extern void cmd_abbw();
 extern void cmd_dieid();
 extern void cmd_etmpkt();
 extern void cmd_ping();
@@ -36,6 +38,8 @@
 	int maxargs;
 	void (*func)();
 } cmdtab[] = {
+	{"abbr", 2, 2, cmd_abbr},
+	{"abbw", 3, 3, cmd_abbw},
 	{"dieid", 0, 0, cmd_dieid},
 	{"etmpkt", 1, 253, cmd_etmpkt},
 	{"exit", 0, 0, cmd_exit},