You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
34 lines
1.0 KiB
34 lines
1.0 KiB
6 years ago
|
#!/usr/bin/env python3
|
||
|
|
import traceback
|
||
|
|
|
||
|
|
import cereal.messaging as messaging
|
||
|
|
from panda.python.uds import FUNCTIONAL_ADDRS
|
||
|
|
from selfdrive.car.isotp_parallel_query import IsoTpParallelQuery
|
||
|
|
from selfdrive.swaglog import cloudlog
|
||
|
|
|
||
|
|
VIN_REQUEST = b'\x09\x02'
|
||
|
|
VIN_RESPONSE = b'\x49\x02\x01'
|
||
|
|
VIN_UNKNOWN = "0" * 17
|
||
|
|
|
||
|
|
|
||
|
|
def get_vin(logcan, sendcan, bus, timeout=0.1, retry=5, debug=False):
|
||
|
|
for i in range(retry):
|
||
|
|
try:
|
||
|
|
query = IsoTpParallelQuery(sendcan, logcan, bus, FUNCTIONAL_ADDRS, [VIN_REQUEST], [VIN_RESPONSE], functional_addr=True, debug=debug)
|
||
|
|
for addr, vin in query.get_data(timeout).items():
|
||
|
|
return addr[0], vin.decode()
|
||
|
|
print(f"vin query retry ({i+1}) ...")
|
||
|
|
except Exception:
|
||
|
|
cloudlog.warning(f"VIN query exception: {traceback.format_exc()}")
|
||
|
|
|
||
|
|
return 0, VIN_UNKNOWN
|
||
|
|
|
||
|
|
|
||
|
|
if __name__ == "__main__":
|
||
|
|
import time
|
||
|
|
sendcan = messaging.pub_sock('sendcan')
|
||
|
|
logcan = messaging.sub_sock('can')
|
||
|
|
time.sleep(1)
|
||
|
|
addr, vin = get_vin(logcan, sendcan, 1, debug=False)
|
||
|
|
print(hex(addr), vin)
|