# HG changeset patch
# User Mychaela Falconia <falcon@freecalypso.org>
# Date 1615675293 0
# Node ID b761029f9c0331bf051a190df18a1a899cfd5686
# Parent  56506e9165bc61f221a1119a36760dd74b0320e2
simagent: spenh command implemented

diff -r 56506e9165bc -r b761029f9c03 target-utils/simagent/cmdtab.c
--- a/target-utils/simagent/cmdtab.c	Sat Mar 13 22:17:39 2021 +0000
+++ b/target-utils/simagent/cmdtab.c	Sat Mar 13 22:41:33 2021 +0000
@@ -11,6 +11,7 @@
 extern void cmd_sertimeout();
 extern void cmd_set_spenh();
 extern void cmd_sim_up();
+extern void cmd_spenh();
 extern void cmd_tx();
 extern void cmd_w8();
 extern void cmd_w16();
@@ -37,6 +38,7 @@
 	{"sertimeout", cmd_sertimeout},
 	{"set-spenh", cmd_set_spenh},
 	{"sim-up", cmd_sim_up},
+	{"spenh", cmd_spenh},
 	{"tx", cmd_tx},
 	{"w8", cmd_w8},
 	{"w16", cmd_w16},
diff -r 56506e9165bc -r b761029f9c03 target-utils/simagent/spenh.c
--- a/target-utils/simagent/spenh.c	Sat Mar 13 22:17:39 2021 +0000
+++ b/target-utils/simagent/spenh.c	Sat Mar 13 22:41:33 2021 +0000
@@ -3,8 +3,43 @@
 #include "types.h"
 #include "simregs.h"
 
+extern int sim_if_state;
 extern u16 conf1_reg;
 
+const u8 pts_for_spenh[4] = {0xFF, 0x10, 0x94, 0x7B};
+
+void
+cmd_spenh()
+{
+	int rc;
+	unsigned count;
+
+	if (sim_if_state != 2) {
+		printf("ERROR: SIM interface is not up\n");
+		return;
+	}
+	if (conf1_reg & SIM_CONF1_ETU) {
+		printf("ERROR: speed enhancement is already on\n");
+		return;
+	}
+	rc = flush_rx_fifo();
+	if (rc < 0)
+		return;
+	rc = send_to_sim(pts_for_spenh, 4);
+	if (rc < 0)
+		return;
+	for (count = 0; count < 4; count++) {
+		rc = rx_sim_byte_hl();
+		if (rc < 0)
+			return;
+		if (rc != pts_for_spenh[count]) {
+			printf("ERROR: PTS response does not match request\n");
+			return;
+		}
+	}
+	SIMREGS.conf1 = conf1_reg |= SIM_CONF1_ETU;
+}
+
 void
 cmd_set_spenh(argbulk)
 	char *argbulk;