improve touchpad emulation on sd

antheas · antheas · commit cce142940c8e · 2025-06-29T12:20:44.000+02:00
diff --git a/src/hhd/controller/virtual/sd/__init__.py b/src/hhd/controller/virtual/sd/__init__.py
@@ -7,6 +7,7 @@
     Consumer,
     Event,
     Producer,
+    DEBUG_MODE,
 )
 from hhd.controller.lib.uhid import UhidDevice, BUS_USB
 from hhd.controller.lib.common import encode_axis, set_button
@@ -19,6 +20,7 @@
     SDCONT_DESCRIPTOR,
     SD_AXIS_MAP,
     SD_BTN_MAP,
+    SD_SETTINGS,
 )
 
 MAX_IMU_SYNC_DELAY = 2
@@ -137,10 +139,14 @@ def produce(self, fds: Sequence[int]) -> Sequence[Event]:
         assert self.dev
         while ev := self.dev.read_event():
             match ev["type"]:
-                # case "open":
-                #     logger.info(f"SD OPENED")
-                # case "close":
-                #     logger.info(f"SD CLOSED")
+                case "open":
+                    # logger.info(f"SD OPENED")
+                    pass
+                case "close":
+                    # logger.info(f"SD CLOSED")
+                    pass
+                case "start":
+                    pass
                 case "get_report":
                     match self.last_rep:
                         case 0x83:
@@ -235,12 +241,35 @@ def produce(self, fds: Sequence[int]) -> Sequence[Event]:
                                     "weak_magnitude": right / (2**16 - 1),
                                 }
                             )
+                        case 0xea:
+                            # Touchpad stuff
+                            pass
                         case 0x8F:
+                            # logger.info(f"SD Received Haptics ({time.perf_counter()*1000:.3f}ms):\n{ev['data'].hex().rstrip(' 0')}")
                             pass
+                        case 0x87:
+                            if DEBUG_MODE:
+                                rnum = ev["data"][4]
+                                ss = []
+                                for i in range(0, rnum, 3):
+                                    rtype = ev["data"][5 + i]
+                                    rdata = int.from_bytes(
+                                        ev["data"][6 + i : 8 + i],
+                                        byteorder="little",
+                                        signed=False,
+                                    )
+                                    ss.append(
+                                        f"{SD_SETTINGS[rtype] if rtype < len(SD_SETTINGS) else "UKNOWN"} ({rtype:02d}): {rdata:02x}"
+                                    )
+                                mlen = max(map(len, ss))
+                                logger.info(
+                                    f"SD Received Settings (n={rnum // 3}):{''.join(map(lambda x: '\n > ' + ' '*(mlen - len(x)) + x, ss))}"
+                                )
                         case _:
-                            logger.info(
-                                f"SD SET_REPORT({ev['rnum']:02x}:{ev['rtype']:02x}): {trim(ev['data']).hex()}"
-                            )
+                            if DEBUG_MODE:
+                                logger.info(
+                                    f"SD SET_REPORT({ev['rnum']:02x}:{ev['rtype']:02x}): {trim(ev['data']).hex()}"
+                                )
 
                     # 410000eb 0901401f 0000 0000 fbfb
                     # 410000eb 0901401f ff7f ff7f fbfb
@@ -312,6 +341,18 @@ def consume(self, events: Sequence[Event]):
                     elif code in SD_BTN_MAP:
                         set_button(new_rep, SD_BTN_MAP[code], ev["value"])
 
+        if not self.touchpad_touch:
+            encode_axis(
+                new_rep,
+                SD_AXIS_MAP["touchpad_x"],
+                0.5,
+            )
+            encode_axis(
+                new_rep,
+                SD_AXIS_MAP["touchpad_y"],
+                0.5,
+            )
+
         # If the IMU breaks, smoothly re-enable the controller
         failover = self.last_imu + MAX_IMU_SYNC_DELAY < curr
         if self.sync_gyro and failover and not self.imu_failed:
diff --git a/src/hhd/controller/virtual/sd/const.py b/src/hhd/controller/virtual/sd/const.py
@@ -48,9 +48,9 @@
 )
 
 SD_AXIS_MAP = {
-    "touchpad_x": AM((20 << 3), "u16", scale=2**14 - 2, offset=2**14),
-    "touchpad_y": AM((22 << 3), "u16", scale=2**14 - 2, offset=2**14),
-    "touchpad_force": AM((58 << 3), "u16", scale=2**14 - 2),
+    "touchpad_x": AM((20 << 3), "i16", scale=2**16-3, offset=-2**15+1),
+    "touchpad_y": AM((22 << 3), "i16", scale=-2**16+3, offset=2**15-1),
+    "touchpad_force": AM((58 << 3), "i16", scale=2**14 - 2),
     "accel_x": AM(
         (24 << 3), "i16", scale=16384 / 9.80665, bounds=(-(2**15) + 2, 2**15 - 1)
     ),
@@ -109,3 +109,97 @@
     # "touchpad_touch2": BM((36 << 3), flipped=True),
     # "touchpad_left": BM((9 << 3) + 6),
 }
+
+SD_SETTINGS = [
+    # /* 0 */
+    "SETTING_MOUSE_SENSITIVITY",
+    "SETTING_MOUSE_ACCELERATION",
+    "SETTING_TRACKBALL_ROTATION_ANGLE",
+    "SETTING_HAPTIC_INTENSITY_UNUSED",
+    "SETTING_LEFT_GAMEPAD_STICK_ENABLED",
+    "SETTING_RIGHT_GAMEPAD_STICK_ENABLED",
+    "SETTING_USB_DEBUG_MODE",
+    "SETTING_LEFT_TRACKPAD_MODE",
+    "SETTING_RIGHT_TRACKPAD_MODE",
+    "SETTING_MOUSE_POINTER_ENABLED",
+    # /* 10 */
+    "SETTING_DPAD_DEADZONE",
+    "SETTING_MINIMUM_MOMENTUM_VEL",
+    "SETTING_MOMENTUM_DECAY_AMMOUNT",
+    "SETTING_TRACKPAD_RELATIVE_MODE_TICKS_PER_PIXEL",
+    "SETTING_HAPTIC_INCREMENT",
+    "SETTING_DPAD_ANGLE_SIN",
+    "SETTING_DPAD_ANGLE_COS",
+    "SETTING_MOMENTUM_VERTICAL_DIVISOR",
+    "SETTING_MOMENTUM_MAXIMUM_VELOCITY",
+    "SETTING_TRACKPAD_Z_ON",
+    # /* 20 */
+    "SETTING_TRACKPAD_Z_OFF",
+    "SETTING_SENSITIVY_SCALE_AMMOUNT",
+    "SETTING_LEFT_TRACKPAD_SECONDARY_MODE",
+    "SETTING_RIGHT_TRACKPAD_SECONDARY_MODE",
+    "SETTING_SMOOTH_ABSOLUTE_MOUSE",
+    "SETTING_STEAMBUTTON_POWEROFF_TIME",
+    "SETTING_UNUSED_1",
+    "SETTING_TRACKPAD_OUTER_RADIUS",
+    "SETTING_TRACKPAD_Z_ON_LEFT",
+    "SETTING_TRACKPAD_Z_OFF_LEFT",
+    # /* 30 */
+    "SETTING_TRACKPAD_OUTER_SPIN_VEL",
+    "SETTING_TRACKPAD_OUTER_SPIN_RADIUS",
+    "SETTING_TRACKPAD_OUTER_SPIN_HORIZONTAL_ONLY",
+    "SETTING_TRACKPAD_RELATIVE_MODE_DEADZONE",
+    "SETTING_TRACKPAD_RELATIVE_MODE_MAX_VEL",
+    "SETTING_TRACKPAD_RELATIVE_MODE_INVERT_Y",
+    "SETTING_TRACKPAD_DOUBLE_TAP_BEEP_ENABLED",
+    "SETTING_TRACKPAD_DOUBLE_TAP_BEEP_PERIOD",
+    "SETTING_TRACKPAD_DOUBLE_TAP_BEEP_COUNT",
+    "SETTING_TRACKPAD_OUTER_RADIUS_RELEASE_ON_TRANSITION",
+    # /* 40 */
+    "SETTING_RADIAL_MODE_ANGLE",
+    "SETTING_HAPTIC_INTENSITY_MOUSE_MODE",
+    "SETTING_LEFT_DPAD_REQUIRES_CLICK",
+    "SETTING_RIGHT_DPAD_REQUIRES_CLICK",
+    "SETTING_LED_BASELINE_BRIGHTNESS",
+    "SETTING_LED_USER_BRIGHTNESS",
+    "SETTING_ENABLE_RAW_JOYSTICK",
+    "SETTING_ENABLE_FAST_SCAN",
+    "SETTING_IMU_MODE",
+    "SETTING_WIRELESS_PACKET_VERSION",
+    # /* 50 */
+    "SETTING_SLEEP_INACTIVITY_TIMEOUT",
+    "SETTING_TRACKPAD_NOISE_THRESHOLD",
+    "SETTING_LEFT_TRACKPAD_CLICK_PRESSURE",
+    "SETTING_RIGHT_TRACKPAD_CLICK_PRESSURE",
+    "SETTING_LEFT_BUMPER_CLICK_PRESSURE",
+    "SETTING_RIGHT_BUMPER_CLICK_PRESSURE",
+    "SETTING_LEFT_GRIP_CLICK_PRESSURE",
+    "SETTING_RIGHT_GRIP_CLICK_PRESSURE",
+    "SETTING_LEFT_GRIP2_CLICK_PRESSURE",
+    "SETTING_RIGHT_GRIP2_CLICK_PRESSURE",
+    # /* 60 */
+    "SETTING_PRESSURE_MODE",
+    "SETTING_CONTROLLER_TEST_MODE",
+    "SETTING_TRIGGER_MODE",
+    "SETTING_TRACKPAD_Z_THRESHOLD",
+    "SETTING_FRAME_RATE",
+    "SETTING_TRACKPAD_FILT_CTRL",
+    "SETTING_TRACKPAD_CLIP",
+    "SETTING_DEBUG_OUTPUT_SELECT",
+    "SETTING_TRIGGER_THRESHOLD_PERCENT",
+    "SETTING_TRACKPAD_FREQUENCY_HOPPING",
+    # /* 70 */
+    "SETTING_HAPTICS_ENABLED",
+    "SETTING_STEAM_WATCHDOG_ENABLE",
+    "SETTING_TIMP_TOUCH_THRESHOLD_ON",
+    "SETTING_TIMP_TOUCH_THRESHOLD_OFF",
+    "SETTING_FREQ_HOPPING",
+    "SETTING_TEST_CONTROL",
+    "SETTING_HAPTIC_MASTER_GAIN_DB",
+    "SETTING_THUMB_TOUCH_THRESH",
+    "SETTING_DEVICE_POWER_STATUS",
+    "SETTING_HAPTIC_INTENSITY",
+    # /* 80 */
+    "SETTING_STABILIZER_ENABLED",
+    "SETTING_TIMP_MODE_MTE",
+]
diff --git a/src/hhd/device/legion_go/slim/controller.yml b/src/hhd/device/legion_go/slim/controller.yml
@@ -52,7 +52,7 @@ children:
 
   touchpad:
     type: multiple
-    title: Touchpad Emulation [ALPHA]
+    title: Touchpad Emulation [BETA]
     default: disabled
     tags: [ non-essential, ordinal ]
     hint: >-
diff --git a/src/hhd/plugins/outputs.yml b/src/hhd/plugins/outputs.yml
@@ -98,7 +98,7 @@ modes:
           Allows for gyro, paddles, and has a proper QAM button.
       handheld_mode:
         type: bool
-        title: Handheld Mode [ALPHA]
+        title: Handheld Mode [BETA]
         tags: [non-essential]
         default: False
         hint: >-
