diff rvinterf/tmsh/abbtm3.c @ 150:45d8c175f9b5

fc-tmsh: oabbr and oabbw command sending implemented
author Mychaela Falconia <falcon@freecalypso.org>
date Sun, 05 Mar 2017 09:07:01 +0000
parents
children 74b9aeb25d79
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/rvinterf/tmsh/abbtm3.c	Sun Mar 05 09:07:01 2017 +0000
@@ -0,0 +1,58 @@
+/*
+ * Old TM3 versions of ABB register read and write commands
+ */
+
+#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 "tm3.h"
+#include "exitcodes.h"
+
+extern u_char rvi_msg[];
+extern int rvi_msg_len;
+
+cmd_oabbr(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(ERROR_USAGE);
+	}
+	cmdpkt[1] = CODEC_READ;
+	cmdpkt[2] = page << 5 | reg;
+	cmdpkt[3] = 0;
+	send_etm_cmd(cmdpkt, 3);
+	return(0);
+}
+
+cmd_oabbw(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(ERROR_USAGE);
+	}
+	cmdpkt[1] = CODEC_WRITE;
+	cmdpkt[2] = page << 5 | reg;
+	cmdpkt[3] = 0;
+	cmdpkt[4] = val;
+	cmdpkt[5] = val >> 8;
+	send_etm_cmd(cmdpkt, 5);
+	return(0);
+}