panda/python/uds.py

571 lines
24 KiB
Python
Raw Normal View History

2018-11-18 00:18:48 -07:00
#!/usr/bin/env python
import time
import struct
from enum import Enum
import threading
2018-11-25 12:51:39 -07:00
class SERVICE_TYPE(Enum):
DIAGNOSTIC_SESSION_CONTROL = 0x10
ECU_RESET = 0x11
SECURITY_ACCESS = 0x27
COMMUNICATION_CONTROL = 0x28
TESTER_PRESENT = 0x3E
ACCESS_TIMING_PARAMETER = 0x83
SECURED_DATA_TRANSMISSION = 0x84
CONTROL_DTC_SETTING = 0x85
RESPONSE_ON_EVENT = 0x86
LINK_CONTROL = 0x87
READ_DATA_BY_IDENTIFIER = 0x22
READ_MEMORY_BY_ADDRESS = 0x23
READ_SCALING_DATA_BY_IDENTIFIER = 0x24
READ_DATA_BY_PERIODIC_IDENTIFIER = 0x2A
DYNAMICALLY_DEFINE_DATA_IDENTIFIER = 0x2C
WRITE_DATA_BY_IDENTIFIER = 0x2E
WRITE_MEMORY_BY_ADDRESS = 0x3D
CLEAR_DIAGNOSTIC_INFORMATION = 0x14
READ_DTC_INFORMATION = 0x19
INPUT_OUTPUT_CONTROL_BY_IDENTIFIER = 0x2F
ROUTINE_CONTROL = 0x31
REQUEST_DOWNLOAD = 0x34
REQUEST_UPLOAD = 0x35
TRANSFER_DATA = 0x36
REQUEST_TRANSFER_EXIT = 0x37
2018-11-18 00:18:48 -07:00
_negative_response_codes = {
'\x00': 'positive response',
'\x10': 'general reject',
'\x11': 'service not supported',
'\x12': 'sub-function not supported',
'\x13': 'incorrect message length or invalid format',
'\x14': 'response too long',
'\x21': 'busy repeat request',
'\x22': 'conditions not correct',
'\x24': 'request sequence error',
'\x25': 'no response from subnet component',
'\x26': 'failure prevents execution of requested action',
'\x31': 'request out of range',
'\x33': 'security access denied',
'\x35': 'invalid key',
'\x36': 'exceed numebr of attempts',
'\x37': 'required time delay not expired',
'\x70': 'upload download not accepted',
'\x71': 'transfer data suspended',
'\x72': 'general programming failure',
'\x73': 'wrong block sequence counter',
'\x78': 'request correctly received - response pending',
'\x7e': 'sub-function not supported in active session',
'\x7f': 'service not supported in active session',
'\x81': 'rpm too high',
'\x82': 'rpm too low',
'\x83': 'engine is running',
'\x84': 'engine is not running',
'\x85': 'engine run time too low',
'\x86': 'temperature too high',
'\x87': 'temperature too low',
'\x88': 'vehicle speed too high',
'\x89': 'vehicle speed too low',
'\x8a': 'throttle/pedal too high',
'\x8b': 'throttle/pedal too low',
'\x8c': 'transmission not in neutral',
'\x8d': 'transmission not in gear',
'\x8f': 'brake switch(es) not closed',
'\x90': 'shifter lever not in park',
'\x91': 'torque converter clutch locked',
'\x92': 'voltage too high',
'\x93': 'voltage too low',
}
2018-11-25 03:46:20 -07:00
class NegativeResponseError(Exception):
pass
class InvalidServiceIdError(Exception):
pass
class InvalidSubFunctioneError(Exception):
pass
2018-11-18 00:18:48 -07:00
# generic uds request
2018-11-25 12:51:39 -07:00
def _request(address, service_type, subfunction, data=None):
2018-11-18 00:18:48 -07:00
# TODO: send request
# TODO: wait for response
# raise exception on error
if resp[0] == '\x7f'
error_code = resp[2]
error_desc = _negative_response_codes[error_code]
2018-11-25 03:46:20 -07:00
raise NegativeResponseError('[{}] {}'.format(hex(ord(error_code)), error_desc))
2018-11-18 00:18:48 -07:00
resp_sid = ord(resp[0]) if len(resp) > 0 else None
if service != resp_sid + 0x40:
resp_sid_hex = hex(resp_sid) if resp_sid is not None else None
2018-11-25 03:46:20 -07:00
raise InvalidServiceIdError('invalid response service id: {}'.format(resp_sid_hex))
2018-11-18 00:18:48 -07:00
if subfunction is None:
resp_subf = ord(resp[1]) if len(resp) > 1 else None
if subfunction != resp_subf:
resp_subf_hex = hex(resp_subf) if resp_subf is not None else None
2018-11-25 03:46:20 -07:00
raise InvalidSubFunctioneError('invalid response subfunction: {}'.format(hex(resp_subf)))
2018-11-18 00:18:48 -07:00
# return data (exclude service id and sub-function id)
return resp[(1 if subfunction is None else 2):]
# services
2018-11-25 03:46:20 -07:00
class SESSION_TYPE(Enum):
2018-11-18 00:18:48 -07:00
DEFAULT = 1
PROGRAMMING = 2
EXTENDED_DIAGNOSTIC = 3
SAFETY_SYSTEM_DIAGNOSTIC = 4
def diagnostic_session_control(address, session_type):
2018-11-25 12:51:39 -07:00
_request(address, service=SERVICE_TYPE.DIAGNOSTIC_SESSION_CONTROL, subfunction=session_type)
2018-11-18 00:18:48 -07:00
2018-11-25 03:46:20 -07:00
class RESET_TYPE(Enum):
2018-11-18 00:18:48 -07:00
HARD = 1
KEY_OFF_ON = 2
SOFT = 3
ENABLE_RAPID_POWER_SHUTDOWN = 4
DISABLE_RAPID_POWER_SHUTDOWN = 5
def ecu_reset(address, reset_type):
2018-11-25 12:51:39 -07:00
resp = _request(address, SERVICE_TYPE.ECU_RESET, subfunction=reset_type)
2018-11-18 00:18:48 -07:00
power_down_time = None
if reset_type == RESET_TYPE.ENABLE_RAPID_POWER_SHUTDOWN
power_down_time = ord(resp[0])
2018-11-25 03:46:20 -07:00
return power_down_time
2018-11-18 00:18:48 -07:00
2018-11-25 03:46:20 -07:00
class ACCESS_TYPE(Enum):
2018-11-18 00:18:48 -07:00
REQUEST_SEED = 1
SEND_KEY = 2
def security_access(address, access_type, security_key=None):
request_seed = access_type % 2 == 0
if request_seed and security_key is not None:
raise ValueError('security_key not allowed')
if not request_seed and security_key is None:
raise ValueError('security_key is missing')
2018-11-25 12:51:39 -07:00
resp = _request(address, service=SERVICE_TYPE.SECURITY_ACCESS, subfunction=access_type, data=security_key)
2018-11-18 00:18:48 -07:00
if request_seed:
2018-11-25 03:46:20 -07:00
security_seed = resp
return security_seed
2018-11-18 00:18:48 -07:00
2018-11-25 03:46:20 -07:00
class CONTROL_TYPE(Enum):
2018-11-18 00:18:48 -07:00
ENABLE_RX_ENABLE_TX = 0
ENABLE_RX_DISABLE_TX = 1
DISABLE_RX_ENABLE_TX = 2
DISABLE_RX_DISABLE_TX = 3
2018-11-25 03:46:20 -07:00
class MESSAGE_TYPE(Enum):
2018-11-18 00:18:48 -07:00
NORMAL = 1
NETWORK_MANAGEMENT = 2
NORMAL_AND_NETWORK_MANAGEMENT = 3
def communication_control(address, control_type, message_type):
data = chr(message_type)
2018-11-25 12:51:39 -07:00
_request(address, service=SERVICE_TYPE.COMMUNICATION_CONTROL, subfunction=control_type, data=data)
2018-11-18 00:18:48 -07:00
def tester_present(address):
2018-11-25 12:51:39 -07:00
_request(address, service=SERVICE_TYPE.TESTER_PRESENT, subfunction=0x00)
2018-11-18 00:18:48 -07:00
2018-11-25 03:46:20 -07:00
class TIMING_PARAMETER_TYPE(Enum):
2018-11-18 00:18:48 -07:00
READ_EXTENDED_SET = 1
SET_TO_DEFAULT_VALUES = 2
READ_CURRENTLY_ACTIVE = 3
SET_TO_GIVEN_VALUES = 4
2018-11-25 03:46:20 -07:00
def access_timing_parameter(address, timing_parameter_type, parameter_values):
write_custom_values = timing_parameter_type == ACCESS_TIMING_PARAMETER_TYPE.SET_TO_GIVEN_VALUES
2018-11-18 00:18:48 -07:00
read_values = (
2018-11-25 03:46:20 -07:00
timing_parameter_type == ACCESS_TIMING_PARAMETER_TYPE.READ_CURRENTLY_ACTIVE or
timing_parameter_type == ACCESS_TIMING_PARAMETER_TYPE.READ_EXTENDED_SET
2018-11-18 00:18:48 -07:00
)
if not write_custom_values and parameter_values is not None:
raise ValueError('parameter_values not allowed')
if write_custom_values and parameter_values is None:
raise ValueError('parameter_values is missing')
2018-11-25 12:51:39 -07:00
resp = _request(address, service=SERVICE_TYPE.ACCESS_TIMING_PARAMETER, subfunction=timing_parameter_type, data=parameter_values)
2018-11-18 00:18:48 -07:00
if read_values:
# TODO: parse response into values?
2018-11-25 03:46:20 -07:00
parameter_values = resp
return parameter_values
2018-11-18 00:18:48 -07:00
def secured_data_transmission(address, data):
# TODO: split data into multiple input parameters?
2018-11-25 12:51:39 -07:00
resp = _request(address, service=SERVICE_TYPE.SECURED_DATA_TRANSMISSION, subfunction=None, data=data)
2018-11-18 00:18:48 -07:00
# TODO: parse response into multiple output values?
2018-11-25 03:46:20 -07:00
return resp
2018-11-18 00:18:48 -07:00
2018-11-25 03:46:20 -07:00
class DTC_SETTING_TYPE(Enum):
2018-11-18 00:18:48 -07:00
ON = 1
OFF = 2
2018-11-25 03:46:20 -07:00
def control_dtc_setting(address, dtc_setting_type):
2018-11-25 12:51:39 -07:00
_request(address, service=SERVICE_TYPE.CONTROL_DTC_SETTING, subfunction=dtc_setting_type)
2018-11-18 00:18:48 -07:00
2018-11-25 03:46:20 -07:00
class RESPONSE_EVENT_TYPE(Enum):
2018-11-18 00:18:48 -07:00
STOP_RESPONSE_ON_EVENT = 0
ON_DTC_STATUS_CHANGE = 1
ON_TIMER_INTERRUPT = 2
ON_CHANGE_OF_DATA_IDENTIFIER = 3
REPORT_ACTIVATED_EVENTS = 4
START_RESPONSE_ON_EVENT = 5
CLEAR_RESPONSE_ON_EVENT = 6
ON_COMPARISON_OF_VALUES = 7
2018-11-25 03:46:20 -07:00
def response_on_event(address, response_event_type, store_event, window_time, event_type_record, service_response_record):
2018-11-18 00:18:48 -07:00
if store_event:
2018-11-25 03:46:20 -07:00
response_event_type |= 0x20
2018-11-18 00:18:48 -07:00
# TODO: split record parameters into arrays
data = char(window_time) + event_type_record + service_response_record
2018-11-25 12:51:39 -07:00
resp = _request(address, service=SERVICE_TYPE.RESPONSE_ON_EVENT, subfunction=response_event_type, data=data)
2018-11-25 03:46:20 -07:00
if response_event_type == REPORT_ACTIVATED_EVENTS:
return {
"num_of_activated_events": ord(resp[0]),
"data": resp[1:], # TODO: parse the reset of response
}
return {
"num_of_identified_events": ord(resp[0]),
"event_window_time": ord(resp[1]),
"data": resp[2:], # TODO: parse the reset of response
}
2018-11-18 00:18:48 -07:00
class LINK_CONTROL_TYPE(Enum):
VERIFY_BAUDRATE_TRANSITION_WITH_FIXED_BAUDRATE = 1
VERIFY_BAUDRATE_TRANSITION_WITH_SPECIFIC_BAUDRATE = 2
TRANSITION_BAUDRATE = 3
2018-11-25 03:46:20 -07:00
class BAUD_RATE_TYPE(Enum):
2018-11-18 00:18:48 -07:00
PC9600 = 1
PC19200 = 2
PC38400 = 3
PC57600 = 4
PC115200 = 5
CAN125000 = 16
CAN250000 = 17
CAN500000 = 18
CAN1000000 = 19
2018-11-25 03:46:20 -07:00
def link_control(address, link_control_type, baud_rate_type=None):
2018-11-18 00:18:48 -07:00
if LINK_CONTROL_TYPE.VERIFY_BAUDRATE_TRANSITION_WITH_FIXED_BAUDRATE:
2018-11-25 03:46:20 -07:00
# baud_rate_type = BAUD_RATE_TYPE
data = chr(baud_rate_type)
2018-11-18 00:18:48 -07:00
elif LINK_CONTROL_TYPE.VERIFY_BAUDRATE_TRANSITION_WITH_SPECIFIC_BAUDRATE:
2018-11-25 03:46:20 -07:00
# baud_rate_type = custom value (3 bytes big-endian)
data = struct.pack('!I', baud_rate_type)[1:]
2018-11-18 00:18:48 -07:00
else:
data = None
2018-11-25 12:51:39 -07:00
_request(address, service=SERVICE_TYPE.LINK_CONTROL, subfunction=link_control_type, data=data)
2018-11-18 00:18:48 -07:00
2018-11-25 03:46:20 -07:00
class DATA_IDENTIFIER_TYPE(Enum):
2018-11-18 00:18:48 -07:00
BOOT_SOFTWARE_IDENTIFICATION = 0XF180
APPLICATION_SOFTWARE_IDENTIFICATION = 0XF181
APPLICATION_DATA_IDENTIFICATION = 0XF182
BOOT_SOFTWARE_FINGERPRINT = 0XF183
APPLICATION_SOFTWARE_FINGERPRINT = 0XF184
APPLICATION_DATA_FINGERPRINT = 0XF185
ACTIVE_DIAGNOSTIC_SESSION = 0XF186
VEHICLE_MANUFACTURER_SPARE_PART_NUMBER = 0XF187
VEHICLE_MANUFACTURER_ECU_SOFTWARE_NUMBER = 0XF188
VEHICLE_MANUFACTURER_ECU_SOFTWARE_VERSION_NUMBER = 0XF189
SYSTEM_SUPPLIER_IDENTIFIER = 0XF18A
ECU_MANUFACTURING_DATE = 0XF18B
ECU_SERIAL_NUMBER = 0XF18C
SUPPORTED_FUNCTIONAL_UNITS = 0XF18D
VEHICLE_MANUFACTURER_KIT_ASSEMBLY_PART_NUMBER = 0XF18E
VIN = 0XF190
VEHICLE_MANUFACTURER_ECU_HARDWARE_NUMBER = 0XF191
SYSTEM_SUPPLIER_ECU_HARDWARE_NUMBER = 0XF192
SYSTEM_SUPPLIER_ECU_HARDWARE_VERSION_NUMBER = 0XF193
SYSTEM_SUPPLIER_ECU_SOFTWARE_NUMBER = 0XF194
SYSTEM_SUPPLIER_ECU_SOFTWARE_VERSION_NUMBER = 0XF195
EXHAUST_REGULATION_OR_TYPE_APPROVAL_NUMBER = 0XF196
SYSTEM_NAME_OR_ENGINE_TYPE = 0XF197
REPAIR_SHOP_CODE_OR_TESTER_SERIAL_NUMBER = 0XF198
PROGRAMMING_DATE = 0XF199
CALIBRATION_REPAIR_SHOP_CODE_OR_CALIBRATION_EQUIPMENT_SERIAL_NUMBER = 0XF19A
CALIBRATION_DATE = 0XF19B
CALIBRATION_EQUIPMENT_SOFTWARE_NUMBER = 0XF19C
ECU_INSTALLATION_DATE = 0XF19D
ODX_FILE = 0XF19E
ENTITY = 0XF19F
2018-11-25 03:46:20 -07:00
def read_data_by_identifier(address, data_identifier_type):
2018-11-18 00:18:48 -07:00
# TODO: support list of identifiers
2018-11-25 03:46:20 -07:00
data = struct.pack('!H', data_identifier_type)
2018-11-25 12:51:39 -07:00
resp = _request(address, service=SERVICE_TYPE.READ_DATA_BY_IDENTIFIER, subfunction=None, data=data)
2018-11-25 03:46:20 -07:00
resp_id = struct.unpack('!H', resp[0:2])[0] if len(resp) >= 2 else None
if resp_id != data_identifier_type:
2018-11-18 00:18:48 -07:00
raise ValueError('invalid response data identifier: {}'.format(hex(resp_id)))
return resp[2:]
2018-11-25 03:46:20 -07:00
def read_memory_by_address(address, memory_address, memory_size, memory_address_bytes=4, memory_size_bytes=1):
2018-11-18 00:18:48 -07:00
if memory_address_bytes < 1 or memory_address_bytes > 4:
raise ValueError('invalid memory_address_bytes: {}'.format(memory_address_bytes))
if memory_size_bytes < 1 or memory_size_bytes > 4:
raise ValueError('invalid memory_size_bytes: {}'.format(memory_size_bytes))
data = struct.pack('!BB', memory_size_bytes, memory_address_bytes)
if memory_address >= 1<<(memory_address_bytes*8)
raise ValueError('invalid memory_address: {}'.format(memory_address))
data += struct.pack('!I', memory_address)[4-memory_address_bytes:]
if memory_size >= 1<<(memory_size_bytes*8)
2018-11-25 03:46:20 -07:00
raise ValueError('invalid memory_size: {}'.format(memory_size))
2018-11-18 00:18:48 -07:00
data += struct.pack('!I', memory_size)[4-memory_size_bytes:]
2018-11-25 12:51:39 -07:00
resp = _request(address, service=SERVICE_TYPE.READ_MEMORY_BY_ADDRESS, subfunction=None, data=data)
2018-11-18 00:18:48 -07:00
return resp
2018-11-25 03:46:20 -07:00
def read_scaling_data_by_identifier(address, data_identifier_type):
data = struct.pack('!H', data_identifier_type)
2018-11-25 12:51:39 -07:00
resp = _request(address, service=SERVICE_TYPE.READ_SCALING_DATA_BY_IDENTIFIER, subfunction=None, data=data)
2018-11-25 03:46:20 -07:00
resp_id = struct.unpack('!H', resp[0:2])[0] if len(resp) >= 2 else None
if resp_id != data_identifier_type:
raise ValueError('invalid response data identifier: {}'.format(hex(resp_id)))
return resp[2:] # TODO: parse the response
2018-11-18 00:18:48 -07:00
2018-11-25 03:46:20 -07:00
class TRANSMISSION_MODE_TYPE(Enum):
SEND_AT_SLOW_RATE = 1
SEND_AT_MEDIUM_RATE = 2
SEND_AT_FAST_RATE = 3
STOP_SENDING = 4
2018-11-18 00:18:48 -07:00
2018-11-25 03:46:20 -07:00
def read_data_by_periodic_identifier(address, transmission_mode_type, periodic_data_identifier):
# TODO: support list of identifiers
data = chr(transmission_mode_type) + chr(periodic_data_identifier)
2018-11-25 12:51:39 -07:00
_request(address, service=SERVICE_TYPE.READ_DATA_BY_PERIODIC_IDENTIFIER, subfunction=None, data=data)
2018-11-18 00:18:48 -07:00
2018-11-25 03:46:20 -07:00
class DYNAMIC_DEFINITION_TYPE(Enum):
DEFINE_BY_IDENTIFIER = 1
DEFINE_BY_MEMORY_ADDRESS = 2
CLEAR_DYNAMICALLY_DEFINED_DATA_IDENTIFIER = 3
2018-11-18 00:18:48 -07:00
2018-11-25 03:46:20 -07:00
def dynamically_define_data_identifier(address, dynamic_definition_type, dynamic_data_identifier, source_definitions, memory_address_bytes=4, memory_size_bytes=1):
if memory_address_bytes < 1 or memory_address_bytes > 4:
raise ValueError('invalid memory_address_bytes: {}'.format(memory_address_bytes))
if memory_size_bytes < 1 or memory_size_bytes > 4:
raise ValueError('invalid memory_size_bytes: {}'.format(memory_size_bytes))
data = struct.pack('!BB', memory_size_bytes, memory_address_bytes)
2018-11-18 00:18:48 -07:00
2018-11-25 03:46:20 -07:00
data = struct.pack('!H', dynamic_data_identifier)
if dynamic_definition_type == DYNAMIC_DEFINITION_TYPE.DEFINE_BY_IDENTIFIER:
for s in source_definitions:
data += struct.pack('!H', s["data_identifier"]) + chr(s["position"]) + chr(s["memory_size"])
elif dynamic_definition_type == DYNAMIC_DEFINITION_TYPE.DEFINE_BY_MEMORY_ADDRESS:
data += struct.pack('!BB', memory_size_bytes, memory_address_bytes)
for s in source_definitions:
if s["memory_address"] >= 1<<(memory_address_bytes*8)
raise ValueError('invalid memory_address: {}'.format(s["memory_address"]))
data += struct.pack('!I', memory_address)[4-memory_address_bytes:]
if s["memory_size"] >= 1<<(memory_size_bytes*8)
raise ValueError('invalid memory_size: {}'.format(s["memory_size"]))
data += struct.pack('!I', s["memory_size"])[4-memory_size_bytes:]
elif dynamic_definition_type == DYNAMIC_DEFINITION_TYPE.CLEAR_DYNAMICALLY_DEFINED_DATA_IDENTIFIER:
pass
else:
raise ValueError('invalid dynamic identifier type: {}'.format(hex(dynamic_definition_type)))
2018-11-25 12:51:39 -07:00
_request(address, service=SERVICE_TYPE.DYNAMICALLY_DEFINE_DATA_IDENTIFIER, subfunction=dynamic_definition_type, data=data)
2018-11-25 03:46:20 -07:00
def write_data_by_identifier(address, data_identifier_type, data_record):
data = struct.pack('!H', data_identifier_type) + data_record
2018-11-25 12:51:39 -07:00
resp = _request(address, service=SERVICE_TYPE.WRITE_DATA_BY_IDENTIFIER, subfunction=None, data=data)
2018-11-25 03:46:20 -07:00
resp_id = struct.unpack('!H', resp[0:2])[0] if len(resp) >= 2 else None
if resp_id != data_identifier_type:
raise ValueError('invalid response data identifier: {}'.format(hex(resp_id)))
2018-11-18 00:18:48 -07:00
2018-11-25 03:46:20 -07:00
def write_memory_by_address(address, memory_address, memory_size, data_record, memory_address_bytes=4, memory_size_bytes=1):
if memory_address_bytes < 1 or memory_address_bytes > 4:
raise ValueError('invalid memory_address_bytes: {}'.format(memory_address_bytes))
if memory_size_bytes < 1 or memory_size_bytes > 4:
raise ValueError('invalid memory_size_bytes: {}'.format(memory_size_bytes))
data = struct.pack('!BB', memory_size_bytes, memory_address_bytes)
if memory_address >= 1<<(memory_address_bytes*8)
raise ValueError('invalid memory_address: {}'.format(memory_address))
data += struct.pack('!I', memory_address)[4-memory_address_bytes:]
if memory_size >= 1<<(memory_size_bytes*8)
raise ValueError('invalid memory_size: {}'.format(memory_size))
data += struct.pack('!I', memory_size)[4-memory_size_bytes:]
2018-11-18 00:18:48 -07:00
2018-11-25 03:46:20 -07:00
data += data_record
2018-11-25 12:51:39 -07:00
_request(address, service=SERVICE_TYPE.WRITE_MEMORY_BY_ADDRESS, subfunction=0x00, data=data)
2018-11-25 03:46:20 -07:00
class DTC_GROUP_TYPE(Enum):
EMISSIONS = 0x000000
ALL = 0xFFFFFF
def clear_diagnostic_information(address, dtc_group_type):
data = struct.pack('!I', dtc_group_type)[1:] # 3 bytes
2018-11-25 12:51:39 -07:00
_request(address, service=SERVICE_TYPE.CLEAR_DIAGNOSTIC_INFORMATION, subfunction=None, data=data)
2018-11-25 03:46:20 -07:00
class DTC_REPORT_TYPE(Enum):
NUMBER_OF_DTC_BY_STATUS_MASK = 0x01
DTC_BY_STATUS_MASK = 0x02
DTC_SNAPSHOT_IDENTIFICATION = 0x03
DTC_SNAPSHOT_RECORD_BY_DTC_NUMBER = 0x04
DTC_SNAPSHOT_RECORD_BY_RECORD_NUMBER = 0x05
DTC_EXTENDED_DATA_RECORD_BY_DTC_NUMBER = 0x06
NUMBER_OF_DTC_BY_SEVERITY_MASK_RECORD = 0x07
DTC_BY_SEVERITY_MASK_RECORD = 0x08
SEVERITY_INFORMATION_OF_DTC = 0x09
SUPPORTED_DTC = 0x0A
FIRST_TEST_FAILED_DTC = 0x0B
FIRST_CONFIRMED_DTC = 0x0C
MOST_RECENT_TEST_FAILED_DTC = 0x0D
MOST_RECENT_CONFIRMED_DTC = 0x0E
MIRROR_MEMORY_DTC_BY_STATUS_MASK = 0x0F
MIRROR_MEMORY_DTC_EXTENDED_DATA_RECORD_BY_DTC_NUMBER = 0x10
NUMBER_OF_MIRROR_MEMORY_DTC_BY_STATUS_MASK = 0x11
NUMBER_OF_EMISSIONS_RELATED_OBD_DTC_BY_STATUS_MASK = 0x12
EMISSIONS_RELATED_OBD_DTC_BY_STATUS_MASK = 0x13
DTC_FAULT_DETECTION_COUNTER = 0x14
DTC_WITH_PERMANENT_STATUS = 0x15
class DTC_STATUS_MASK_TYPE(Enum):
TEST_FAILED = 0x01
TEST_FAILED_THIS_OPERATION_CYCLE = 0x02
PENDING_DTC = 0x04
CONFIRMED_DTC = 0x08
TEST_NOT_COMPLETED_SINCE_LAST_CLEAR = 0x10
TEST_FAILED_SINCE_LAST_CLEAR = 0x20
TEST_NOT_COMPLETED_THIS_OPERATION_CYCLE = 0x40
WARNING_INDICATOR_REQUESTED = 0x80
ALL = 0xFF
class DTC_SEVERITY_MASK_TYPE(Enum):
MAINTENANCE_ONLY = 0x20
CHECK_AT_NEXT_HALT = 0x40
CHECK_IMMEDIATELY = 0x80
ALL = 0xE0
def read_dtc_information(address, dtc_report_type, dtc_status_mask_type=DTC_STATUS_MASK_TYPE.ALL, dtc_severity_mask_type=DTC_SEVERITY_MASK_TYPE.ALL, dtc_mask_record=0xFFFFFF, dtc_snapshot_record_num=0xFF, dtc_extended_record_num=0xFF):
data = ''
# dtc_status_mask_type
if dtc_report_type == DTC_REPORT_TYPE.NUMBER_OF_DTC_BY_STATUS_MASK or
dtc_report_type == DTC_REPORT_TYPE.DTC_BY_STATUS_MASK or
dtc_report_type == DTC_REPORT_TYPE.MIRROR_MEMORY_DTC_BY_STATUS_MASK or
dtc_report_type == DTC_REPORT_TYPE.NUMBER_OF_MIRROR_MEMORY_DTC_BY_STATUS_MASK or
dtc_report_type == DTC_REPORT_TYPE.NUMBER_OF_EMISSIONS_RELATED_OBD_DTC_BY_STATUS_MASK or
dtc_report_type == DTC_REPORT_TYPE.EMISSIONS_RELATED_OBD_DTC_BY_STATUS_MASK:
data += chr(dtc_status_mask_type)
# dtc_mask_record
if dtc_report_type == DTC_REPORT_TYPE.DTC_SNAPSHOT_IDENTIFICATION or
dtc_report_type == DTC_REPORT_TYPE.DTC_SNAPSHOT_RECORD_BY_DTC_NUMBER or
dtc_report_type == DTC_REPORT_TYPE.DTC_EXTENDED_DATA_RECORD_BY_DTC_NUMBER or
dtc_report_type == DTC_REPORT_TYPE.MIRROR_MEMORY_DTC_EXTENDED_DATA_RECORD_BY_DTC_NUMBER or
dtc_report_type == DTC_REPORT_TYPE.SEVERITY_INFORMATION_OF_DTC:
data += struct.pack('!I', dtc_mask_record)[1:] # 3 bytes
# dtc_snapshot_record_num
if dtc_report_type == DTC_REPORT_TYPE.DTC_SNAPSHOT_IDENTIFICATION or
dtc_report_type == DTC_REPORT_TYPE.DTC_SNAPSHOT_RECORD_BY_DTC_NUMBER or
dtc_report_type == DTC_REPORT_TYPE.DTC_SNAPSHOT_RECORD_BY_RECORD_NUMBER:
data += ord(dtc_snapshot_record_num)
# dtc_extended_record_num
if dtc_report_type == DTC_REPORT_TYPE.DTC_EXTENDED_DATA_RECORD_BY_DTC_NUMBER or
dtc_report_type == DTC_REPORT_TYPE.MIRROR_MEMORY_DTC_EXTENDED_DATA_RECORD_BY_DTC_NUMBER:
data += chr(dtc_extended_record_num)
# dtc_severity_mask_type
if dtc_report_type == DTC_REPORT_TYPE.NUMBER_OF_DTC_BY_SEVERITY_MASK_RECORD or
dtc_report_type == DTC_REPORT_TYPE.DTC_BY_SEVERITY_MASK_RECORD:
data += chr(dtc_severity_mask_type) + chr(dtc_status_mask_type)
2018-11-25 12:51:39 -07:00
resp = _request(address, service=SERVICE_TYPE.READ_DTC_INFORMATION, subfunction=dtc_report_type, data=data)
2018-11-25 03:46:20 -07:00
# TODO: parse response
return resp
class CONTROL_OPTION_TYPE(Enum):
2018-11-18 00:18:48 -07:00
RETURN_CONTROL_TO_ECU = 0
RESET_TO_DEFAULT = 1
FREEZE_CURRENT_STATE = 2
SHORT_TERM_ADJUSTMENT = 3
2018-11-25 03:46:20 -07:00
def input_output_control_by_identifier(address, data_identifier_type, control_option_record, control_enable_mask_record=''):
data = struct.pack('!H', data_identifier_type) + control_option_record + control_enable_mask_record
2018-11-25 12:51:39 -07:00
resp = _request(address, service=SERVICE_TYPE.INPUT_OUTPUT_CONTROL_BY_IDENTIFIER, subfunction=None, data=data)
2018-11-25 03:46:20 -07:00
resp_id = struct.unpack('!H', resp[0:2])[0] if len(resp) >= 2 else None
if resp_id != data_identifier_type:
raise ValueError('invalid response data identifier: {}'.format(hex(resp_id)))
return resp[2:]
2018-11-18 00:18:48 -07:00
class ROUTINE_CONTROL_TYPE(Enum):
2018-11-25 03:46:20 -07:00
START = 1
STOP = 2
REQUEST_RESULTS = 3
class ROUTINE_IDENTIFIER_TYPE(Enum):
2018-11-18 00:18:48 -07:00
ERASE_MEMORY = 0xFF00
CHECK_PROGRAMMING_DEPENDENCIES = 0xFF01
ERASE_MIRROR_MEMORY_DTCS = 0xFF02
2018-11-25 03:46:20 -07:00
def routine_control(address, routine_control_type, routine_identifier_type, routine_option_record=''):
data = struct.pack('!H', routine_identifier_type) + routine_option_record
2018-11-25 12:51:39 -07:00
_request(address, service=SERVICE_TYPE.ROUTINE_CONTROL, subfunction=routine_control_type, data=data)
2018-11-25 03:46:20 -07:00
resp = resp_id = struct.unpack('!H', resp[0:2])[0] if len(resp) >= 2 else None
if resp_id != routine_identifier_type:
raise ValueError('invalid response routine identifier: {}'.format(hex(resp_id)))
return resp[2:]
2018-11-18 00:18:48 -07:00
2018-11-25 03:46:20 -07:00
def request_download(address, memory_address, memory_size, memory_address_bytes=4, memory_size_bytes=4, data_format=0x00):
data = chr(data_format)
2018-11-18 00:18:48 -07:00
2018-11-25 03:46:20 -07:00
if memory_address_bytes < 1 or memory_address_bytes > 4:
raise ValueError('invalid memory_address_bytes: {}'.format(memory_address_bytes))
if memory_size_bytes < 1 or memory_size_bytes > 4:
raise ValueError('invalid memory_size_bytes: {}'.format(memory_size_bytes))
data += struct.pack('!BB', memory_size_bytes, memory_address_bytes)
if memory_address >= 1<<(memory_address_bytes*8)
raise ValueError('invalid memory_address: {}'.format(memory_address))
data += struct.pack('!I', memory_address)[4-memory_address_bytes:]
if memory_size >= 1<<(memory_size_bytes*8)
raise ValueError('invalid memory_size: {}'.format(memory_size))
data += struct.pack('!I', memory_size)[4-memory_size_bytes:]
2018-11-25 12:51:39 -07:00
resp = _request(address, service=SERVICE_TYPE.REQUEST_DOWNLOAD, subfunction=None, data=data)
2018-11-25 03:46:20 -07:00
max_num_bytes_len = ord(resp[0]) >> 4 if len(resp) > 0 else None
if max_num_bytes_len >= 1 and max_num_bytes_len <= 4:
max_num_bytes = struct.unpack('!I', ('\x00'*(4-max_num_bytes_len))+resp[1:max_num_bytes_len+1])[0]
else:
raise ValueError('invalid max_num_bytes_len: {}'.format(max_num_bytes_len))
return max_num_bytes # max number of bytes per transfer data request
def request_upload(address, memory_address, memory_size, memory_address_bytes=4, memory_size_bytes=4, data_format=0x00):
data = chr(data_format)
if memory_address_bytes < 1 or memory_address_bytes > 4:
raise ValueError('invalid memory_address_bytes: {}'.format(memory_address_bytes))
if memory_size_bytes < 1 or memory_size_bytes > 4:
raise ValueError('invalid memory_size_bytes: {}'.format(memory_size_bytes))
data += struct.pack('!BB', memory_size_bytes, memory_address_bytes)
if memory_address >= 1<<(memory_address_bytes*8)
raise ValueError('invalid memory_address: {}'.format(memory_address))
data += struct.pack('!I', memory_address)[4-memory_address_bytes:]
if memory_size >= 1<<(memory_size_bytes*8)
raise ValueError('invalid memory_size: {}'.format(memory_size))
data += struct.pack('!I', memory_size)[4-memory_size_bytes:]
2018-11-25 12:51:39 -07:00
resp = _request(address, service=SERVICE_TYPE.REQUEST_UPLOAD, subfunction=None, data=data)
2018-11-25 03:46:20 -07:00
max_num_bytes_len = ord(resp[0]) >> 4 if len(resp) > 0 else None
if max_num_bytes_len >= 1 and max_num_bytes_len <= 4:
max_num_bytes = struct.unpack('!I', ('\x00'*(4-max_num_bytes_len))+resp[1:max_num_bytes_len+1])[0]
else:
raise ValueError('invalid max_num_bytes_len: {}'.format(max_num_bytes_len))
return max_num_bytes # max number of bytes per transfer data request
def transfer_data(address, block_sequence_count, data=''):
2018-11-25 12:51:39 -07:00
resp = _request(address, service=SERVICE_TYPE.TRANSFER_DATA, subfunction=None, data=data)
2018-11-25 03:46:20 -07:00
resp_id = ord(resp[0]) if len(resp) > 0 else None
if resp_id != block_sequence_count:
raise ValueError('invalid block_sequence_count: {}'.format(resp_id))
return resp[1:]
2018-11-18 00:18:48 -07:00
def request_transfer_exit(address)
2018-11-25 12:51:39 -07:00
_request(address, service=SERVICE_TYPE.REQUEST_TRANSFER_EXIT, subfunction=None)
2018-11-18 00:18:48 -07:00
if __name__ == "__main__":
from . import uds
# examples
vin = uds.read_data_by_identifier(0x18da10f1, uds.DATA_IDENTIFIER.VIN)