|  |  |  | @ -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}") | 
			
		
	
	
		
			
				
					|  |  |  | 
 |