add gasPressed

commaai · Mar 19, 2024 · 6a3835c · 6a3835c
1 parent fafc77f
commit 6a3835c
Show file tree

Hide file tree

Showing 3 changed files with 8 additions and 5 deletions.
diff --git a/opendbc b/opendbc
diff --git a/selfdrive/car/toyota/carstate.py b/selfdrive/car/toyota/carstate.py
@@ -67,10 +67,11 @@ def update(self, cp, cp_cam):
     if self.CP.enableGasInterceptor:
       ret.gas = (cp.vl["GAS_SENSOR"]["INTERCEPTOR_GAS"] + cp.vl["GAS_SENSOR"]["INTERCEPTOR_GAS2"]) // 2
       ret.gasPressed = ret.gas > 805
+    elif self.CP.flags & ToyotaFlags.GEAR_PACKET_HYBRID.value:
+      ret.gas = cp.vl["GAS_PEDAL"]["GAS_PEDAL_USER"]
+      ret.gasPressed = cp.vl["GAS_PEDAL"]["GAS_PEDAL_USER"] > 0
     else:
-      # TODO: find a common gas pedal percentage signal
-      if self.CP.carFingerprint not in [CAR.RAV4_PRIME]:
-        ret.gasPressed = cp.vl["PCM_CRUISE"]["GAS_RELEASED"] == 0
+      ret.gasPressed = cp.vl["PCM_CRUISE"]["GAS_RELEASED"] == 0
 
     ret.wheelSpeeds = self.get_wheel_speeds(
       cp.vl["WHEEL_SPEEDS"]["WHEEL_SPEED_FL"],
@@ -217,6 +218,7 @@ def get_can_parser(CP):
 
     if CP.flags & ToyotaFlags.GEAR_PACKET_HYBRID.value:
       messages.append(("GEAR_PACKET_HYBRID", 60))
+      messages.append(("GAS_PEDAL", 42))
     else:
       messages.append(("GEAR_PACKET", 1))
 

diff --git a/selfdrive/car/toyota/interface.py b/selfdrive/car/toyota/interface.py
@@ -55,7 +55,8 @@ def _get_params(ret, candidate, fingerprint, car_fw, experimental_long, docs):
       ret.flags |= ToyotaFlags.RADAR_CAN_FILTER.value
 
     # Detect missing GEAR_PACKET msg, but has GEAR_PACKET_HYBRID
-    if 0x3BC not in fingerprint[0] and 0x127 in fingerprint[0]:
+    # For new we also assume this correlates to having a the GAS_PEDAL message on 0x116
+    if 0x3BC not in fingerprint[0] and 0x127 in fingerprint[0] and 0x116 in fingerprint[0]:
       ret.flags |= ToyotaFlags.GEAR_PACKET_HYBRID.value
 
     # In TSS2 cars, the camera does long control