From aeaf12853e98181048cf5900a8a17eaac7a2bb0f Mon Sep 17 00:00:00 2001
From: James Tavares <jtavares@kvh.com>
Date: Mon, 10 Jan 2022 18:06:45 -0500
Subject: [PATCH] simtrace2-tool: add "modem sim-card (insert|remove)" command

Add a new command to request that the simtrace2 firmware manipulate the
card detect signal, causing the downstream cellular modem to believe
that the SIM card has been inserted or removed, respectfully.

Change-Id: I8c79eb29379a789d9d0d21495e30d66ddbdfb022
---
 host/src/simtrace2-tool.c | 26 ++++++++++++++++++++++++++
 1 file changed, 26 insertions(+)

diff --git a/host/src/simtrace2-tool.c b/host/src/simtrace2-tool.c
index d92638f3..eb61ee22 100644
--- a/host/src/simtrace2-tool.c
+++ b/host/src/simtrace2-tool.c
@@ -65,6 +65,7 @@ static void print_help(void)
 	printf( "Commands:\n"
 		"\tmodem reset (enable|disable|cycle)\n"
 		"\tmodem sim-switch (local|remote)\n"
+		"\tmodem sim-card (insert|remove)\n"
 		"\n");
 }
 
@@ -167,6 +168,29 @@ static int do_modem_sim_switch(int argc, char **argv)
 	return 0;
 }
 
+/* emulate SIM card insertion / removal from modem */
+static int do_modem_sim_card(int argc, char **argv)
+{
+	char *command;
+	if (argc < 1)
+		return -EINVAL;
+	command = argv[0];
+	argc--;
+	argv++;
+
+	if (!strcmp(command, "insert")) {
+		printf("Setting SIM=INSERTED; Modem reset recommended\n");
+		return osmo_st2_cardem_request_card_insert(ci, 1);
+	} else if (!strcmp(command, "remove")) {
+		printf("Setting SIM=REMOVED; Modem reset recommended\n");
+		return osmo_st2_cardem_request_card_insert(ci, 0);
+	} else {
+		fprintf(stderr, "Unsupported modem sim-card command: '%s'\n", command);
+		return -EINVAL;
+	}
+	return 0;
+}
+
 static int do_subsys_modem(int argc, char **argv)
 {
 	char *command;
@@ -182,6 +206,8 @@ static int do_subsys_modem(int argc, char **argv)
 		rc = do_modem_reset(argc, argv);
 	} else if (!strcmp(command, "sim-switch")) {
 		rc = do_modem_sim_switch(argc, argv);
+	} else if (!strcmp(command, "sim-card")) {
+		rc = do_modem_sim_card(argc, argv);
 	} else {
 		fprintf(stderr, "Unsupported command for subsystem modem: '%s'\n", command);
 		return -EINVAL;