chuni-io: handle incoming messages

Author: magicnat

ChuniVController/ChuniIO/chuniio.cc

@@ -20,7 +20,6 @@ static HANDLE chuni_io_slider_thread;
 static bool chuni_io_slider_stop_flag;
 static SOCKET chuni_socket;
 static USHORT chuni_port = 24864; // CHUNI on dialpad
-static char recv_buf[32];
 
 HRESULT chuni_io_jvs_init(void)
 {
@@ -73,18 +72,22 @@ void chuni_io_jvs_read_coin_counter(uint16_t* out)
     }
 
     if (chuni_coin_pending) chuni_coins++;
+    chuni_coin_pending = false;
 
     *out = chuni_coins;
 }
 
 void chuni_io_jvs_poll(uint8_t* opbtn, uint8_t* beams)
 {
     if (chuni_test_pending) {
-        *opbtn |= 0x01; /* Test */
+        *opbtn |= 0x01;
+        chuni_test_pending = false;
     }
 
     if (chuni_service_pending) {
-        *opbtn |= 0x02; /* Service */
+        *opbtn |= 0x02;
+        chuni_service_pending = false;
+
     }
 
     *beams = chuni_ir_sensor_map;
@@ -136,28 +139,66 @@ void chuni_io_slider_stop(void)
 
 void chuni_io_slider_set_leds(const uint8_t* rgb)
 {
-    /*for (uint8_t i = 0; i < 32; i++) {
-        log_debug("SET_LED[%d]: %d\n", i, rgb[i]);
-    }*/
+    static uint8_t prev_rgb_status[32];
+
+    for (uint8_t i = 0; i < 32; i++) {
+        if (rgb[i] != prev_rgb_status[i]) log_debug("SET_LED[%d]: %d\n", i, rgb[i]);
+        prev_rgb_status[i] = rgb[i];
+    }
 }
 
 static unsigned int __stdcall chuni_io_slider_thread_proc(void* ctx)
 {
     chuni_io_slider_callback_t callback;
-    uint8_t pressure[32];
+    static uint8_t pressure[32];
+    static char recv_buf[32];
     size_t i;
 
     for (i = 0; i < _countof(pressure); i++) pressure[i] = 0;
 
     callback = (chuni_io_slider_callback_t) ctx;
 
     while (!chuni_io_slider_stop_flag) {
-        int len = recv(chuni_socket, recv_buf, 32, 0);
+        int len = recv(chuni_socket, recv_buf, 32, 0); // FIXME: discard pending data on proc start
         if (len == (int) sizeof(chuni_msg_t)) {
-            // TOD: message parsing, event dispatch logic
+            const chuni_msg_t* msg = (const chuni_msg_t*)recv_buf;
+            if (msg->src != SRC_CONTROLLER) {
+                log_warn("got non-controller message.\n");
+                callback(pressure);
+                continue;
+            }
+            switch (msg->type) {
+                case COIN_INSERT: 
+                    chuni_coin_pending = true;
+                    break;
+                case SLIDER_PRESS: 
+                    if (msg->target >= 32) log_error("invalid slider value %d in SLIDER_PRESS.\n", msg->target);
+                    else pressure[msg->target] = 128;
+                    break;
+                case SLIDER_RELEASE:
+                    if (msg->target >= 32) log_error("invalid slider value %d in SLIDER_RELEASE.\n", msg->target);
+                    else pressure[msg->target] = 0;
+                    break;
+                case CABINET_TEST:
+                    chuni_test_pending = true;
+                    break;
+                case CABINET_SERVICE:
+                    chuni_service_pending = true;
+                    break;
+                case IR_BLOCKED:
+                    if (msg->target >= 6) log_error("invalid slider value %d in IR_BLOCKED.\n", msg->target);
+                    else chuni_ir_sensor_map |= 1 << msg->target;
+                    break;
+                case IR_UNBLOCKED:
+                    if (msg->target >= 6) log_error("invalid slider value %d in IR_UNBLOCKED.\n", msg->target);
+                    else chuni_ir_sensor_map &= ~(1 << msg->target);
+                    break;
+                default:
+                    log_error("bad message type %d.\n", msg->type);
+            }
         }
         else if (len > 0) {
-            log_warn("got invalid packet of length %d.", len);
+            log_warn("got invalid packet of length %d.\n", len);
         }
 
         callback(pressure);