From 6513d5593a99128e95a8ac1d60668d24e2cc689b Mon Sep 17 00:00:00 2001
From: Silvano Seva <silseva@fastwebnet.it>
Date: Tue, 15 Oct 2024 19:04:36 +0200
Subject: [PATCH] CS7000: driver for channel selector knob

---
 platform/drivers/keyboard/keyboard_CS7000.c | 59 +++++++++++++++++++++
 platform/targets/CS7000/platform.c          |  5 --
 2 files changed, 59 insertions(+), 5 deletions(-)

diff --git a/platform/drivers/keyboard/keyboard_CS7000.c b/platform/drivers/keyboard/keyboard_CS7000.c
index a9702fe4..649d4592 100644
--- a/platform/drivers/keyboard/keyboard_CS7000.c
+++ b/platform/drivers/keyboard/keyboard_CS7000.c
@@ -19,6 +19,7 @@
 #include <peripherals/gpio.h>
 #include <interfaces/delays.h>
 #include <interfaces/keyboard.h>
+#include <interfaces/platform.h>
 #include <hwconfig.h>
 
 
@@ -40,6 +41,25 @@
  *
  */
 
+static uint8_t knobPrev = 0;
+static uint8_t knobPos = 0;
+
+static uint8_t getKnobPos()
+{
+    static const uint8_t knobTable[] =
+    {
+        0x09, 0x0A, 0x04, 0x03, 0x08,
+        0x07, 0x05, 0x06, 0x0C, 0x0B,
+        0x01, 0x02, 0x0D, 0x0E, 0x10, 0x0F
+    };
+
+    uint8_t encState = (gpio_readPin(CH_SELECTOR_3) << 3)
+                     | (gpio_readPin(CH_SELECTOR_2) << 2)
+                     | (gpio_readPin(CH_SELECTOR_1) << 1)
+                     |  gpio_readPin(CH_SELECTOR_0);
+
+    return knobTable[encState];
+}
 
 void kbd_init()
 {
@@ -48,6 +68,14 @@ void kbd_init()
     gpio_setMode(SIDE_KEY2, INPUT);
     gpio_setMode(SIDE_KEY3, INPUT);
     gpio_setMode(ALARM_KEY, INPUT);
+
+    gpio_setMode(CH_SELECTOR_0, INPUT);
+    gpio_setMode(CH_SELECTOR_1, INPUT);
+    gpio_setMode(CH_SELECTOR_2, INPUT);
+    gpio_setMode(CH_SELECTOR_3, INPUT);
+
+    knobPos = getKnobPos();
+    knobPrev = knobPos;
 }
 
 void kbd_terminate()
@@ -59,6 +87,29 @@ keyboard_t kbd_getKeys()
 {
     keyboard_t keys = 0;
 
+    knobPos = getKnobPos();
+    if(knobPos != knobPrev)
+    {
+        if(knobPos > knobPrev)
+            keys |= KNOB_RIGHT;
+        else if(knobPos < knobPrev)
+            keys |= KNOB_LEFT;
+
+        if((knobPos > 8) && (knobPrev < 8))
+        {
+            keys |= KNOB_LEFT;
+            keys &= ~KNOB_RIGHT;
+        }
+
+        if((knobPos < 8) && (knobPrev > 8))
+        {
+            keys |= KNOB_RIGHT;
+            keys &= ~KNOB_LEFT;
+        }
+
+        knobPrev = knobPos;
+    }
+
     /*
      * Rows and columns lines are in common with the display, so we have to
      * configure them as inputs before scanning. However, before configuring them
@@ -136,3 +187,11 @@ keyboard_t kbd_getKeys()
 
     return keys;
 }
+
+/*
+ * This function is defined in platform.h
+ */
+int8_t platform_getChSelector()
+{
+    return knobPos;
+}
diff --git a/platform/targets/CS7000/platform.c b/platform/targets/CS7000/platform.c
index 47b53f64..82efa0c2 100644
--- a/platform/targets/CS7000/platform.c
+++ b/platform/targets/CS7000/platform.c
@@ -120,11 +120,6 @@ uint8_t platform_getVolumeLevel()
     return output;
 }
 
-int8_t platform_getChSelector()
-{
-    return 0;    // TODO
-}
-
 bool platform_getPttStatus()
 {
     /* PTT line has a pullup resistor with PTT switch closing to ground */