# HG changeset patch
# User Mychaela Falconia <falcon@freecalypso.org>
# Date 1590635743 0
# Node ID def882d1b354a7322c696f8215a0d9ca57d9530a
# Parent  227d37a968ec8ca6d7e691d22283ce4b579ff9d5
AT+IOR and AT+IOW GPIO commands implemented in aci3

diff -r 227d37a968ec -r def882d1b354 src/g23m-aci/aci/ati_cmd.c
--- a/src/g23m-aci/aci/ati_cmd.c	Thu May 28 02:55:26 2020 +0000
+++ b/src/g23m-aci/aci/ati_cmd.c	Thu May 28 03:15:43 2020 +0000
@@ -780,6 +780,8 @@
 EXTERN T_ATI_RSLT atAtPWL (char *cl, UBYTE srcId);
 EXTERN T_ATI_RSLT queatAtPWL (char *cl, UBYTE srcId);
 #endif
+EXTERN T_ATI_RSLT atPlusIOR (char *cl, UBYTE srcId);
+EXTERN T_ATI_RSLT atPlusIOW (char *cl, UBYTE srcId);
 
 LOCAL const ATCommand_bas cmds_bas[] =
 {
@@ -1252,6 +1254,9 @@
 #ifdef TARGET_HAS_PWL
     {"@PWL",	AT_CMD_AT_PWL,   atAtPWL, test_gen, queatAtPWL, "%s: (0-255)"},
 #endif
+    {"+IOR",	AT_CMD_IOR,      atPlusIOR,	test_gen, 0,	"%s: (0-13)"},
+    {"+IOW",	AT_CMD_IOW,      atPlusIOW,	test_gen, 0,
+						"%s: (0-13),(0,1)"},
     /* terminator */
     {NULL,AT_CMD_NONE,NULL,NULL,NULL,NULL}
 };
diff -r 227d37a968ec -r def882d1b354 src/g23m-aci/aci/ati_fcmisc.c
--- a/src/g23m-aci/aci/ati_fcmisc.c	Thu May 28 02:55:26 2020 +0000
+++ b/src/g23m-aci/aci/ati_fcmisc.c	Thu May 28 03:15:43 2020 +0000
@@ -165,4 +165,44 @@
 }
 #endif	/* TARGET_HAS_PWL */
 
+/* AT+IOR - read GPIO pin */
+GLOBAL T_ATI_RSLT atPlusIOR (char *cl, UBYTE srcId)
+{
+	char *me="+IOR: ";
+	unsigned ionum;
+	int state;
+
+	TRACE_FUNCTION("atPlusIOR()");
+
+	cl = parse(cl, "D", &ionum);
+	if (!cl)
+		return (ATI_FAIL);
+	if (ionum > 13)
+		return (ATI_FAIL);
+	state = AI_ReadBit(ionum);
+	sprintf(g_sa, "%s%u,%d", me, ionum, state);
+	io_sendMessage(srcId, g_sa, ATI_NORMAL_OUTPUT);
+	return (ATI_CMPL);
+}
+
+/* AT+IOW - set GPIO pin */
+GLOBAL T_ATI_RSLT atPlusIOW (char *cl, UBYTE srcId)
+{
+	unsigned ionum;
+	int state;
+
+	TRACE_FUNCTION("atPlusIOW()");
+
+	cl = parse(cl, "DD", &ionum, &state);
+	if (!cl)
+		return (ATI_FAIL);
+	if (ionum > 13)
+		return (ATI_FAIL);
+	if (state)
+		AI_SetBit(ionum);
+	else
+		AI_ResetBit(ionum);
+	return (ATI_CMPL);
+}
+
 #endif /* ATI_FCMISC_C */