|
|
|
@ -1,6 +1,4 @@ |
|
|
|
|
#!/usr/bin/env python3 |
|
|
|
|
import os |
|
|
|
|
import unittest |
|
|
|
|
from parameterized import parameterized |
|
|
|
|
|
|
|
|
|
from cereal import log, car |
|
|
|
@ -36,94 +34,87 @@ CX5_FW_VERSIONS = [ |
|
|
|
|
(Ecu.transmission, 0x7e1, None, b'PYNC-21PS1-B\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00\x00'), |
|
|
|
|
] |
|
|
|
|
|
|
|
|
|
class TestStartup(unittest.TestCase): |
|
|
|
|
|
|
|
|
|
def tearDown(self): |
|
|
|
|
managed_processes['controlsd'].stop() |
|
|
|
|
|
|
|
|
|
@parameterized.expand([ |
|
|
|
|
# TODO: test EventName.startup for release branches |
|
|
|
|
|
|
|
|
|
# officially supported car |
|
|
|
|
(EventName.startupMaster, TOYOTA.COROLLA, COROLLA_FW_VERSIONS, "toyota"), |
|
|
|
|
(EventName.startupMaster, TOYOTA.COROLLA, COROLLA_FW_VERSIONS, "toyota"), |
|
|
|
|
|
|
|
|
|
# dashcamOnly car |
|
|
|
|
(EventName.startupNoControl, MAZDA.CX5, CX5_FW_VERSIONS, "mazda"), |
|
|
|
|
(EventName.startupNoControl, MAZDA.CX5, CX5_FW_VERSIONS, "mazda"), |
|
|
|
|
|
|
|
|
|
# unrecognized car with no fw |
|
|
|
|
(EventName.startupNoFw, None, None, ""), |
|
|
|
|
(EventName.startupNoFw, None, None, ""), |
|
|
|
|
|
|
|
|
|
# unrecognized car |
|
|
|
|
(EventName.startupNoCar, None, COROLLA_FW_VERSIONS[:1], "toyota"), |
|
|
|
|
(EventName.startupNoCar, None, COROLLA_FW_VERSIONS[:1], "toyota"), |
|
|
|
|
|
|
|
|
|
# fuzzy match |
|
|
|
|
(EventName.startupMaster, TOYOTA.COROLLA, COROLLA_FW_VERSIONS_FUZZY, "toyota"), |
|
|
|
|
(EventName.startupMaster, TOYOTA.COROLLA, COROLLA_FW_VERSIONS_FUZZY, "toyota"), |
|
|
|
|
]) |
|
|
|
|
def test_startup_alert(self, expected_event, car_model, fw_versions, brand): |
|
|
|
|
controls_sock = messaging.sub_sock("controlsState") |
|
|
|
|
pm = messaging.PubMaster(['can', 'pandaStates']) |
|
|
|
|
|
|
|
|
|
params = Params() |
|
|
|
|
params.put_bool("OpenpilotEnabledToggle", True) |
|
|
|
|
|
|
|
|
|
# Build capnn version of FW array |
|
|
|
|
if fw_versions is not None: |
|
|
|
|
car_fw = [] |
|
|
|
|
cp = car.CarParams.new_message() |
|
|
|
|
for ecu, addr, subaddress, version in fw_versions: |
|
|
|
|
f = car.CarParams.CarFw.new_message() |
|
|
|
|
f.ecu = ecu |
|
|
|
|
f.address = addr |
|
|
|
|
f.fwVersion = version |
|
|
|
|
f.brand = brand |
|
|
|
|
|
|
|
|
|
if subaddress is not None: |
|
|
|
|
f.subAddress = subaddress |
|
|
|
|
|
|
|
|
|
car_fw.append(f) |
|
|
|
|
cp.carVin = "1" * 17 |
|
|
|
|
cp.carFw = car_fw |
|
|
|
|
params.put("CarParamsCache", cp.to_bytes()) |
|
|
|
|
else: |
|
|
|
|
os.environ['SKIP_FW_QUERY'] = '1' |
|
|
|
|
|
|
|
|
|
managed_processes['controlsd'].start() |
|
|
|
|
|
|
|
|
|
assert pm.wait_for_readers_to_update('can', 5) |
|
|
|
|
pm.send('can', can_list_to_can_capnp([[0, 0, b"", 0]])) |
|
|
|
|
|
|
|
|
|
msg = messaging.new_message('pandaStates', 1) |
|
|
|
|
msg.pandaStates[0].pandaType = log.PandaState.PandaType.uno |
|
|
|
|
pm.send('pandaStates', msg) |
|
|
|
|
|
|
|
|
|
# fingerprint |
|
|
|
|
if (car_model is None) or (fw_versions is not None): |
|
|
|
|
finger = {addr: 1 for addr in range(1, 100)} |
|
|
|
|
else: |
|
|
|
|
finger = _FINGERPRINTS[car_model][0] |
|
|
|
|
|
|
|
|
|
msgs = [[addr, 0, b'\x00'*length, 0] for addr, length in finger.items()] |
|
|
|
|
for _ in range(1000): |
|
|
|
|
# controlsd waits for boardd to echo back that it has changed the multiplexing mode |
|
|
|
|
if not params.get_bool("ObdMultiplexingChanged"): |
|
|
|
|
params.put_bool("ObdMultiplexingChanged", True) |
|
|
|
|
|
|
|
|
|
pm.send('can', can_list_to_can_capnp(msgs)) |
|
|
|
|
assert pm.wait_for_readers_to_update('can', 2, dt=0.001) |
|
|
|
|
|
|
|
|
|
ctrls = messaging.drain_sock(controls_sock) |
|
|
|
|
if len(ctrls): |
|
|
|
|
event_name = ctrls[0].controlsState.alertType.split("/")[0] |
|
|
|
|
self.assertEqual(EVENT_NAME[expected_event], event_name, |
|
|
|
|
f"expected {EVENT_NAME[expected_event]} for '{car_model}', got {event_name}") |
|
|
|
|
break |
|
|
|
|
else: |
|
|
|
|
self.fail(f"failed to fingerprint {car_model}") |
|
|
|
|
|
|
|
|
|
if __name__ == "__main__": |
|
|
|
|
unittest.main() |
|
|
|
|
|
|
|
|
|
@parameterized.expand([ |
|
|
|
|
# TODO: test EventName.startup for release branches |
|
|
|
|
|
|
|
|
|
# officially supported car |
|
|
|
|
(EventName.startupMaster, TOYOTA.COROLLA, COROLLA_FW_VERSIONS, "toyota"), |
|
|
|
|
(EventName.startupMaster, TOYOTA.COROLLA, COROLLA_FW_VERSIONS, "toyota"), |
|
|
|
|
|
|
|
|
|
# dashcamOnly car |
|
|
|
|
(EventName.startupNoControl, MAZDA.CX5, CX5_FW_VERSIONS, "mazda"), |
|
|
|
|
(EventName.startupNoControl, MAZDA.CX5, CX5_FW_VERSIONS, "mazda"), |
|
|
|
|
|
|
|
|
|
# unrecognized car with no fw |
|
|
|
|
(EventName.startupNoFw, None, None, ""), |
|
|
|
|
(EventName.startupNoFw, None, None, ""), |
|
|
|
|
|
|
|
|
|
# unrecognized car |
|
|
|
|
(EventName.startupNoCar, None, COROLLA_FW_VERSIONS[:1], "toyota"), |
|
|
|
|
(EventName.startupNoCar, None, COROLLA_FW_VERSIONS[:1], "toyota"), |
|
|
|
|
|
|
|
|
|
# fuzzy match |
|
|
|
|
(EventName.startupMaster, TOYOTA.COROLLA, COROLLA_FW_VERSIONS_FUZZY, "toyota"), |
|
|
|
|
(EventName.startupMaster, TOYOTA.COROLLA, COROLLA_FW_VERSIONS_FUZZY, "toyota"), |
|
|
|
|
]) |
|
|
|
|
def test_startup_alert(expected_event, car_model, fw_versions, brand): |
|
|
|
|
controls_sock = messaging.sub_sock("controlsState") |
|
|
|
|
pm = messaging.PubMaster(['can', 'pandaStates']) |
|
|
|
|
|
|
|
|
|
params = Params() |
|
|
|
|
params.put_bool("OpenpilotEnabledToggle", True) |
|
|
|
|
|
|
|
|
|
# Build capnn version of FW array |
|
|
|
|
if fw_versions is not None: |
|
|
|
|
car_fw = [] |
|
|
|
|
cp = car.CarParams.new_message() |
|
|
|
|
for ecu, addr, subaddress, version in fw_versions: |
|
|
|
|
f = car.CarParams.CarFw.new_message() |
|
|
|
|
f.ecu = ecu |
|
|
|
|
f.address = addr |
|
|
|
|
f.fwVersion = version |
|
|
|
|
f.brand = brand |
|
|
|
|
|
|
|
|
|
if subaddress is not None: |
|
|
|
|
f.subAddress = subaddress |
|
|
|
|
|
|
|
|
|
car_fw.append(f) |
|
|
|
|
cp.carVin = "1" * 17 |
|
|
|
|
cp.carFw = car_fw |
|
|
|
|
params.put("CarParamsCache", cp.to_bytes()) |
|
|
|
|
else: |
|
|
|
|
os.environ['SKIP_FW_QUERY'] = '1' |
|
|
|
|
|
|
|
|
|
managed_processes['controlsd'].start() |
|
|
|
|
|
|
|
|
|
assert pm.wait_for_readers_to_update('can', 5) |
|
|
|
|
pm.send('can', can_list_to_can_capnp([[0, 0, b"", 0]])) |
|
|
|
|
|
|
|
|
|
assert pm.wait_for_readers_to_update('pandaStates', 5) |
|
|
|
|
msg = messaging.new_message('pandaStates', 1) |
|
|
|
|
msg.pandaStates[0].pandaType = log.PandaState.PandaType.uno |
|
|
|
|
pm.send('pandaStates', msg) |
|
|
|
|
|
|
|
|
|
# fingerprint |
|
|
|
|
if (car_model is None) or (fw_versions is not None): |
|
|
|
|
finger = {addr: 1 for addr in range(1, 100)} |
|
|
|
|
else: |
|
|
|
|
finger = _FINGERPRINTS[car_model][0] |
|
|
|
|
|
|
|
|
|
msgs = [[addr, 0, b'\x00'*length, 0] for addr, length in finger.items()] |
|
|
|
|
for _ in range(1000): |
|
|
|
|
# controlsd waits for boardd to echo back that it has changed the multiplexing mode |
|
|
|
|
if not params.get_bool("ObdMultiplexingChanged"): |
|
|
|
|
params.put_bool("ObdMultiplexingChanged", True) |
|
|
|
|
|
|
|
|
|
pm.send('can', can_list_to_can_capnp(msgs)) |
|
|
|
|
assert pm.wait_for_readers_to_update('can', 5, dt=0.001), f"step: {_}" |
|
|
|
|
|
|
|
|
|
ctrls = messaging.drain_sock(controls_sock) |
|
|
|
|
if len(ctrls): |
|
|
|
|
event_name = ctrls[0].controlsState.alertType.split("/")[0] |
|
|
|
|
assert EVENT_NAME[expected_event] == event_name, f"expected {EVENT_NAME[expected_event]} for '{car_model}', got {event_name}" |
|
|
|
|
break |
|
|
|
|
else: |
|
|
|
|
raise Exception(f"failed to fingerprint {car_model}") |
|
|
|
|