Revert "Ford: don't fingerprint on engine (commaai#31195)"

This reverts commit 1d1c993.
Edison-CBS · Feb 5, 2024 · 7694712 · 7694712
1 parent 43f151e
commit 7694712
Show file tree

Hide file tree

Showing 4 changed files with 64 additions and 6 deletions.
diff --git a/selfdrive/car/ford/fingerprints.py b/selfdrive/car/ford/fingerprints.py
@@ -19,6 +19,12 @@
     (Ecu.fwdCamera, 0x706, None): [
       b'M1PT-14F397-AC\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
     ],
+    (Ecu.engine, 0x7e0, None): [
+      b'M1PA-14C204-GF\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'M1PA-14C204-RE\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'N1PA-14C204-AC\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'N1PA-14C204-AD\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+    ],
   },
   CAR.ESCAPE_MK4: {
     (Ecu.eps, 0x730, None): [
@@ -41,6 +47,17 @@
       b'LJ6T-14F397-AE\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
       b'LV4T-14F397-GG\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
     ],
+    (Ecu.engine, 0x7e0, None): [
+      b'LX6A-14C204-BJV\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'LX6A-14C204-BJX\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'LX6A-14C204-CNG\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'LX6A-14C204-DPK\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'LX6A-14C204-ESG\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'MX6A-14C204-BEF\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'MX6A-14C204-BEJ\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'MX6A-14C204-CAB\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'NX6A-14C204-BLE\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+    ],
   },
   CAR.EXPLORER_MK6: {
     (Ecu.eps, 0x730, None): [
@@ -66,9 +83,21 @@
       b'LB5T-14F397-AD\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
       b'LB5T-14F397-AE\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
       b'LB5T-14F397-AF\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
-      b'LC5T-14F397-AE\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
       b'LC5T-14F397-AH\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
     ],
+    (Ecu.engine, 0x7e0, None): [
+      b'LB5A-14C204-ATJ\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'LB5A-14C204-ATS\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'LB5A-14C204-AUJ\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'LB5A-14C204-AZL\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'LB5A-14C204-BUJ\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'LB5A-14C204-EAC\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'MB5A-14C204-MD\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'MB5A-14C204-RC\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'NB5A-14C204-AZD\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'NB5A-14C204-HB\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'PB5A-14C204-DA\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+    ],
   },
   CAR.F_150_MK14: {
     (Ecu.eps, 0x730, None): [
@@ -83,6 +112,9 @@
     (Ecu.fwdCamera, 0x706, None): [
       b'PJ6T-14H102-ABJ\x00\x00\x00\x00\x00\x00\x00\x00\x00',
     ],
+    (Ecu.engine, 0x7e0, None): [
+      b'PL3A-14C204-BRB\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+    ],
   },
   CAR.F_150_LIGHTNING_MK1: {
     (Ecu.abs, 0x760, None): [
@@ -94,6 +126,9 @@
     (Ecu.fwdRadar, 0x764, None): [
       b'ML3T-14D049-AL\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
     ],
+    (Ecu.engine, 0x7e0, None): [
+      b'NL3A-14C204-BAR\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+    ],
   },
   CAR.MUSTANG_MACH_E_MK1: {
     (Ecu.eps, 0x730, None): [
@@ -109,6 +144,11 @@
     (Ecu.fwdCamera, 0x706, None): [
       b'ML3T-14H102-ABS\x00\x00\x00\x00\x00\x00\x00\x00\x00',
     ],
+    (Ecu.engine, 0x7e0, None): [
+      b'MJ98-14C204-BBP\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'MJ98-14C204-BBS\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'NJ98-14C204-VH\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+    ],
   },
   CAR.FOCUS_MK4: {
     (Ecu.eps, 0x730, None): [
@@ -123,6 +163,9 @@
     (Ecu.fwdCamera, 0x706, None): [
       b'JX7T-14F397-AH\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
     ],
+    (Ecu.engine, 0x7e0, None): [
+      b'JX6A-14C204-BPL\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+    ],
   },
   CAR.MAVERICK_MK1: {
     (Ecu.eps, 0x730, None): [
@@ -139,5 +182,14 @@
     (Ecu.fwdCamera, 0x706, None): [
       b'NZ6T-14F397-AC\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
     ],
+    (Ecu.engine, 0x7e0, None): [
+      b'NZ6A-14C204-AAA\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'NZ6A-14C204-PA\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'NZ6A-14C204-ZA\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'NZ6A-14C204-ZC\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'PZ6A-14C204-BE\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'PZ6A-14C204-JC\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+      b'PZ6A-14C204-JE\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00',
+    ],
   },
 }
diff --git a/selfdrive/car/ford/tests/test_ford.py b/selfdrive/car/ford/tests/test_ford.py
@@ -52,7 +52,7 @@ def test_fw_query_config(self):
   @parameterized.expand(FW_VERSIONS.items())
   def test_fw_versions(self, car_model: str, fw_versions: Dict[Tuple[capnp.lib.capnp._EnumModule, int, Optional[int]], Iterable[bytes]]):
     for (ecu, addr, subaddr), fws in fw_versions.items():
-      self.assertIn(ecu, ECU_FW_CORE, "Unexpected ECU")
+      self.assertIn(ecu, ECU_ADDRESSES, "Unknown ECU")
       self.assertEqual(addr, ECU_ADDRESSES[ecu], "ECU address mismatch")
       self.assertIsNone(subaddr, "Unexpected ECU subaddress")
 

diff --git a/selfdrive/car/ford/values.py b/selfdrive/car/ford/values.py
@@ -111,15 +111,21 @@ def init_make(self, CP: car.CarParams):
   requests=[
     # CAN and CAN FD queries are combined.
     # FIXME: For CAN FD, ECUs respond with frames larger than 8 bytes on the powertrain bus
+    # TODO: properly handle auxiliary requests to separate queries and add back whitelists
     Request(
       [StdQueries.TESTER_PRESENT_REQUEST, StdQueries.MANUFACTURER_SOFTWARE_VERSION_REQUEST],
       [StdQueries.TESTER_PRESENT_RESPONSE, StdQueries.MANUFACTURER_SOFTWARE_VERSION_RESPONSE],
+      # whitelist_ecus=[Ecu.engine],
+    ),
+    Request(
+      [StdQueries.TESTER_PRESENT_REQUEST, StdQueries.MANUFACTURER_SOFTWARE_VERSION_REQUEST],
+      [StdQueries.TESTER_PRESENT_RESPONSE, StdQueries.MANUFACTURER_SOFTWARE_VERSION_RESPONSE],
+      # whitelist_ecus=[Ecu.eps, Ecu.abs, Ecu.fwdRadar, Ecu.fwdCamera, Ecu.shiftByWire],
       bus=0,
       auxiliary=True,
     ),
   ],
   extra_ecus=[
-    (Ecu.engine, 0x7e0, None),
     (Ecu.shiftByWire, 0x732, None),
   ],
 )
diff --git a/selfdrive/car/tests/test_fw_fingerprint.py b/selfdrive/car/tests/test_fw_fingerprint.py
@@ -254,13 +254,13 @@ def fake_get_ecu_addrs(*_, timeout):
 
   @pytest.mark.timeout(60)
   def test_fw_query_timing(self):
-    total_ref_time = 6.8
+    total_ref_time = 7.0
     brand_ref_times = {
       1: {
         'gm': 0.5,
         'body': 0.1,
         'chrysler': 0.3,
-        'ford': 0.1,
+        'ford': 0.2,
         'honda': 0.55,
         'hyundai': 0.65,
         'mazda': 0.1,
@@ -271,7 +271,7 @@ def test_fw_query_timing(self):
         'volkswagen': 0.2,
       },
       2: {
-        'ford': 0.2,
+        'ford': 0.3,
         'hyundai': 1.05,
       }
     }