From 2616c66854bfe9054083f32d43466416ee0da7c3 Mon Sep 17 00:00:00 2001
From: Jos van Mourik <mourix@live.nl>
Date: Mon, 29 Jul 2024 20:28:20 +0200
Subject: [PATCH] Add controller identity menu option

---
 src/device/mouse_microtouch_touchscreen.c | 43 +++++++++++++++++------
 1 file changed, 33 insertions(+), 10 deletions(-)

diff --git a/src/device/mouse_microtouch_touchscreen.c b/src/device/mouse_microtouch_touchscreen.c
index 74ace2653..c727f11a2 100644
--- a/src/device/mouse_microtouch_touchscreen.c
+++ b/src/device/mouse_microtouch_touchscreen.c
@@ -44,13 +44,20 @@ enum mtouch_modes {
     MODE_HEX    = 3
 };
 
+const char* mtouch_identity[] = {
+    "A30100", /* SMT2 Serial / SMT3(R)V */
+    "A40100", /* PC Bus SMT2 */
+    "P50100", /* TouchPen 4 (+) */
+    "Q10100", /* SMT3(R) Serial */
+};
+
 typedef struct mouse_microtouch_t {
     double     baud_rate;
     int        b;
     char       cmd[512];
     int        cmd_pos;
     int        mode;
-    uint8_t    cal_cntr, pen_mode;
+    uint8_t    id, cal_cntr, pen_mode;
     bool       soh;
     bool       in_reset;
     serial_t  *serial;
@@ -64,9 +71,9 @@ static mouse_microtouch_t *mtouch_inst = NULL;
 void
 mt_fifo8_puts(Fifo8 *fifo, const uint8_t *data)
 {
-	fifo8_push(fifo, 1);
-	fifo8_push_all(fifo, data, strlen(data));
-	fifo8_push(fifo, '\r');
+    fifo8_push(fifo, 1);
+    fifo8_push_all(fifo, data, strlen(data));
+    fifo8_push(fifo, '\r');
 }
 
 void
@@ -100,17 +107,17 @@ microtouch_process_commands(mouse_microtouch_t *mtouch)
         mtouch->cmd[i] = toupper(mtouch->cmd[i]);
     }
     if (mtouch->cmd[0] == 'Z') { /* Null */
-		mt_fifo8_puts(&mtouch->resp, "0");
+        mt_fifo8_puts(&mtouch->resp, "0");
     }
     if (mtouch->cmd[0] == 'F' && mtouch->cmd[1] == 'O') { /* Finger Only */
         mtouch->pen_mode = 1;
-		mt_fifo8_puts(&mtouch->resp, "0");
+        mt_fifo8_puts(&mtouch->resp, "0");
     }
     if (mtouch->cmd[0] == 'U' && mtouch->cmd[1] == 'T') { /* Unit Type */
-		mt_fifo8_puts(&mtouch->resp, "TP****00");
+        mt_fifo8_puts(&mtouch->resp, "TP****00");
     }
     if (mtouch->cmd[0] == 'O' && mtouch->cmd[1] == 'I') { /* Output Identity */
-		mt_fifo8_puts(&mtouch->resp, "A30600");
+        mt_fifo8_puts(&mtouch->resp, mtouch_identity[mtouch->id]);
     }
     if (mtouch->cmd[0] == 'F' && mtouch->cmd[1] == 'T') { /* Format Tablet */
         mtouch->mode = MODE_TABLET;
@@ -158,8 +165,8 @@ microtouch_process_commands(mouse_microtouch_t *mtouch)
         mtouch->cal_cntr = 2;
     }
     if (mtouch->cmd[0] == 'G' && mtouch->cmd[1] == 'P' && mtouch->cmd[2] == '1') { /* Get Parameter Block 1 */
-		mt_fifo8_puts(&mtouch->resp, "A");
-		mt_fifo8_puts(&mtouch->resp, "0000000000000000000000000");
+        mt_fifo8_puts(&mtouch->resp, "A");
+        mt_fifo8_puts(&mtouch->resp, "0000000000000000000000000");
         mt_fifo8_puts(&mtouch->resp, "0");
     }
     if (mtouch->cmd[0] == 'S' && mtouch->cmd[1] == 'P' && mtouch->cmd[2] == '1') { /* Set Parameter Block 1 */
@@ -331,6 +338,7 @@ mtouch_init(const device_t *info)
     timer_add(&dev->host_to_serial_timer, mtouch_write_to_host, dev, 0);
     timer_add(&dev->reset_timer, microtouch_reset_complete, dev, 0);
     timer_on_auto(&dev->host_to_serial_timer, (1000000. / dev->baud_rate) * 10);
+    dev->id          = device_get_config_int("identity");
     dev->mode        = MODE_TABLET;
     dev->pen_mode    = 3;
     mouse_input_mode = device_get_config_int("crosshair") + 1;
@@ -390,6 +398,21 @@ static const device_config_t mtouch_config[] = {
             { .description =   "1200", .value =   1200 }
         }
     },
+    {
+        .name = "identity",
+        .description = "Controller",
+        .type = CONFIG_SELECTION,
+        .default_string = "",
+        .default_int = 0,
+        .file_filter = NULL,
+        .spinner = { 0 },
+        .selection = {
+            { .description =  "A3 - SMT2 Serial / SMT3(R)V", .value =   0 },
+            { .description =  "A4 - SMT2 PCBus",             .value =   1 },
+            { .description =  "P5 - TouchPen 4(+)",          .value =   2 },
+            { .description =  "Q1 - SMT3(R) Serial",         .value =   3 }
+        }
+    },
     {
         .name = "crosshair",
         .description = "Show Crosshair",