FreeCalypso > hg > freecalypso-tools
view rvinterf/tmsh/abb.c @ 748:b55a81ce7497
fc-shell: implement MMI_BATTERY_IND sending
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Thu, 22 Oct 2020 05:39:47 +0000 |
parents | 2159f260ed13 |
children |
line wrap: on
line source
/* * 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" #include "exitcodes.h" extern u_char rvi_msg[]; extern int rvi_msg_len; 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(ERROR_USAGE); } cmdpkt[1] = ETM_CORE; cmdpkt[2] = TMCORE_OPC_CODEC_RD; cmdpkt[3] = page << 5 | reg; send_etm_cmd(cmdpkt, 3); return(0); } 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); } 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(ERROR_USAGE); } 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); return(0); } 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); }