--- /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);
+}