FreeCalypso > hg > freecalypso-tools
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); +}