FreeCalypso > hg > freecalypso-tools
diff rvinterf/tmsh/bsimcmd.c @ 816:b3724fe6c581
fc-tmsh bsim commands implemented
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Fri, 14 May 2021 17:16:43 +0000 |
parents | |
children |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/rvinterf/tmsh/bsimcmd.c Fri May 14 17:16:43 2021 +0000 @@ -0,0 +1,139 @@ +/* + * In this module we are going to implement FreeCalypso BSIM + * (battery simulation mode) commands. + */ + +#include <sys/types.h> +#include <stdio.h> +#include <string.h> +#include <strings.h> +#include <stdlib.h> +#include "limits.h" +#include "localtypes.h" +#include "etm.h" +#include "bsim_etm_cmd.h" +#include "exitcodes.h" + +cmd_bsim_query(argc, argv) + char **argv; +{ + u_char cmdpkt[4]; + + cmdpkt[1] = ETM_BSIM; + cmdpkt[2] = BSIM_CMD_QUERY; + send_etm_cmd(cmdpkt, 2); + return(0); +} + +cmd_bsim_disch(argc, argv) + char **argv; +{ + u_char cmdpkt[5]; + + cmdpkt[1] = ETM_BSIM; + cmdpkt[2] = BSIM_CMD_DISCHARGE; + cmdpkt[3] = strtoul(argv[1], 0, 0); + send_etm_cmd(cmdpkt, 3); + return(0); +} + +cmd_bsim_start(argc, argv) + char **argv; +{ + u_char cmdpkt[4]; + + cmdpkt[1] = ETM_BSIM; + cmdpkt[2] = BSIM_CMD_CHG_START; + send_etm_cmd(cmdpkt, 2); + return(0); +} + +cmd_bsim_start_enable(argc, argv) + char **argv; +{ + u_char cmdpkt[5]; + + cmdpkt[1] = ETM_BSIM; + cmdpkt[2] = BSIM_CMD_START_ENABLE; + cmdpkt[3] = strtoul(argv[1], 0, 0); + send_etm_cmd(cmdpkt, 3); + return(0); +} + +cmd_bsim_ci2cv(argc, argv) + char **argv; +{ + u_char cmdpkt[4]; + + cmdpkt[1] = ETM_BSIM; + cmdpkt[2] = BSIM_CMD_CHG_CI2CV; + send_etm_cmd(cmdpkt, 2); + return(0); +} + +cmd_bsim_complete(argc, argv) + char **argv; +{ + u_char cmdpkt[4]; + + cmdpkt[1] = ETM_BSIM; + cmdpkt[2] = BSIM_CMD_CHG_COMPLETE; + send_etm_cmd(cmdpkt, 2); + return(0); +} + +cmd_bsim_ichg(argc, argv) + char **argv; +{ + u_char cmdpkt[6]; + unsigned ichg; + + ichg = strtoul(argv[1], 0, 0); + cmdpkt[1] = ETM_BSIM; + cmdpkt[2] = BSIM_CMD_SET_ICHG; + cmdpkt[3] = ichg; + cmdpkt[4] = ichg >> 8; + send_etm_cmd(cmdpkt, 4); + return(0); +} + +static struct cmdtab { + char *cmd; + int minargs; + int maxargs; + int (*func)(); +} bsim_cmds[] = { + {"ci2cv", 0, 0, cmd_bsim_ci2cv}, + {"complete", 0, 0, cmd_bsim_complete}, + {"disch", 1, 1, cmd_bsim_disch}, + {"ichg", 1, 1, cmd_bsim_ichg}, + {"query", 0, 0, cmd_bsim_query}, + {"start", 0, 0, cmd_bsim_start}, + {"start-enable", 1, 1, cmd_bsim_start_enable}, + {0, 0, 0, 0} +}; + +cmd_bsim(argc, argv) + char **argv; +{ + struct cmdtab *tp; + int extargs; + + for (tp = bsim_cmds; tp->cmd; tp++) + if (!strcmp(tp->cmd, argv[1])) + break; + if (!tp->func) { + printf("error: no such bsim command\n"); + return(ERROR_USAGE); + } + extargs = argc - 2; + if (extargs > tp->maxargs) { + printf("error: too many arguments\n"); + return(ERROR_USAGE); + } + if (extargs < tp->minargs) { + printf("error: too few arguments\n"); + return(ERROR_USAGE); + } + return tp->func(argc - 1, argv + 1); +}