peripherals/touch.c: update for ESP32-P4

Author: dhalbert

ports/espressif/peripherals/touch.c

@@ -119,19 +119,29 @@ uint16_t peripherals_touch_read(int channel_id) {
     }
 
     uint32_t touch_value = 0;
-    touch_channel_read_data(touch_channels[idx], TOUCH_CHAN_DATA_TYPE_RAW, &touch_value);
 
     #if SOC_TOUCH_SENSOR_VERSION == 1
     // ESP32 touch reads a lower value when touched.
     // Flip the values to be consistent with TouchIn assumptions.
+    touch_channel_read_data(touch_channels[idx], TOUCH_CHAN_DATA_TYPE_RAW, &touch_value);
     if (touch_value > UINT16_MAX) {
         return 0;
     }
     return UINT16_MAX - (uint16_t)touch_value;
-    #else
+    touch_channel_read_data(touch_channels[idx], TOUCH_CHAN_DATA_TYPE_RAW, &touch_value);
+    return UINT16_MAX - (uint16_t)touch_value;
+    #elif SOC_TOUCH_SENSOR_VERSION == 2
     if (touch_value > UINT16_MAX) {
         return UINT16_MAX;
     }
     return (uint16_t)touch_value;
+    #elif SOC_TOUCH_SENSOR_VERSION == 3
+    touch_channel_read_data(touch_channels[idx], TOUCH_CHAN_DATA_TYPE_SMOOTH, &touch_value);
+    if (touch_value > UINT16_MAX) {
+        return UINT16_MAX;
+    }
+    return (uint16_t)touch_value;
+    #else
+    #error bad SOC_TOUCH_SENSOR_VERSION
     #endif
 }