|
1
|
|
|
from obdlib.obd.protocols.base import Base |
|
2
|
|
|
from obdlib.logging import logger |
|
3
|
|
|
|
|
4
|
|
|
|
|
5
|
|
|
class Protocols(Base): |
|
6
|
|
|
""" |
|
7
|
|
|
Supports next protocols - PWM, VPW, KWP (from 0 to 5) |
|
8
|
|
|
""" |
|
9
|
|
|
|
|
10
|
|
|
def __init__(self, head=True): |
|
11
|
|
|
Base.__init__(self) |
|
12
|
|
|
self.header = head |
|
13
|
|
|
self.check_sum = -2 |
|
14
|
|
|
|
|
15
|
|
|
def create_data(self, raw_data): |
|
16
|
|
|
""" |
|
17
|
|
|
Analyzes raw data |
|
18
|
|
|
:param raw_data - OBDII response |
|
19
|
|
|
:return dict |
|
20
|
|
|
""" |
|
21
|
|
|
data = {} |
|
22
|
|
|
if raw_data: |
|
23
|
|
|
ecu_messages = self.remove_searching(raw_data) |
|
24
|
|
|
|
|
25
|
|
|
if self.check_message(ecu_messages): |
|
26
|
|
|
if self.header: |
|
27
|
|
|
data = self.process_data(ecu_messages) |
|
28
|
|
|
return data |
|
29
|
|
|
|
|
30
|
|
|
def process_data(self, ecu_messages): |
|
31
|
|
|
data = {} |
|
32
|
|
|
self.check_sum = -2 |
|
33
|
|
|
# sorts ECU's messages |
|
34
|
|
|
ecu_messages = sorted(ecu_messages) |
|
35
|
|
|
service_data = self._parse_headers(ecu_messages) |
|
36
|
|
|
for message in ecu_messages: |
|
37
|
|
|
# if one ECU returns multi line |
|
38
|
|
|
# multi line includes line number byte |
|
39
|
|
|
ecu_number, response_mode = self._get_frame_params(message) |
|
40
|
|
|
|
|
41
|
|
|
# check if response trouble codes |
|
42
|
|
|
if response_mode == 43: |
|
43
|
|
|
# add fake byte after the mode one |
|
44
|
|
|
message = self._add_additional_byte(message) |
|
45
|
|
|
self.check_sum = None |
|
46
|
|
|
|
|
47
|
|
|
self._process(data, message, ecu_number, service_data[ecu_number]) |
|
48
|
|
|
return data |
|
49
|
|
|
|
|
50
|
|
|
def _process(self, data, message, ecu_number, multi): |
|
51
|
|
|
if multi > 1: |
|
52
|
|
|
# multi line response - ELM spec page 42 |
|
53
|
|
|
# response format priority:receiver:transmitter:mode:pid:line_number:data:checksum |
|
54
|
|
|
# >0902 - (ex: get VIN) |
|
55
|
|
|
# 86 F1 10 49 02 01 00 00 00 31 FC |
|
56
|
|
|
# 86 F1 10 49 02 02 44 34 47 50 FC |
|
57
|
|
|
# 86 F1 10 49 02 03 30 30 52 35 FC |
|
58
|
|
|
# 86 F1 10 49 02 04 35 42 31 32 FC |
|
59
|
|
|
# 86 F1 10 49 02 05 33 34 35 36 FC |
|
60
|
|
|
# 6 * 2: means that we are removed |
|
61
|
|
|
# "mode:pid:line" info from the record |
|
62
|
|
|
try: |
|
63
|
|
|
data[ecu_number] += self._get_multi_data(message) |
|
64
|
|
|
except KeyError: |
|
65
|
|
|
data[ecu_number] = self._get_multi_data(message) |
|
66
|
|
|
# frame without line number byte |
|
67
|
|
|
# removes header and checksum |
|
68
|
|
|
# format priority:receiver:transmitter:mode:pid:data:checksum |
|
69
|
|
|
# [ header][serv][ data ][CS] |
|
70
|
|
|
# 86 F1 10 41 00 FF FF FF FF FC - ELM spec page 38 |
|
71
|
|
|
else: |
|
72
|
|
|
data[ecu_number] = self.get_data(message) |
|
73
|
|
|
|
|
74
|
|
|
def _get_multi_data(self, record): |
|
75
|
|
|
""" |
|
76
|
|
|
Retrieves the necessary content |
|
77
|
|
|
""" |
|
78
|
|
|
return record[12:self.check_sum] |
|
79
|
|
|
|
|
80
|
|
|
@staticmethod |
|
81
|
|
|
def _get_frame_params(frame): |
|
82
|
|
|
""" |
|
83
|
|
|
Retrieves some params from the frame |
|
84
|
|
|
:param frame - the OBD frame |
|
85
|
|
|
:return tuple of ecu_number, response_mode |
|
86
|
|
|
""" |
|
87
|
|
|
return ( |
|
88
|
|
|
frame[4:6], |
|
89
|
|
|
int(frame[6:8]) |
|
90
|
|
|
) |
|
91
|
|
|
|
|
92
|
|
|
@staticmethod |
|
93
|
|
|
def _add_additional_byte(record): |
|
94
|
|
|
""" |
|
95
|
|
|
Adds fake byte after the mode one (byte is 00) |
|
96
|
|
|
""" |
|
97
|
|
|
return record[:8] + '00' + record[8:] |
|
98
|
|
|
|
|
99
|
|
|
@staticmethod |
|
100
|
|
|
def _parse_headers(frames): |
|
101
|
|
|
""" |
|
102
|
|
|
Collects info, how many times ECU met |
|
103
|
|
|
:param frames - OBDII response |
|
104
|
|
|
:return dict |
|
105
|
|
|
""" |
|
106
|
|
|
ecu_headers = {} |
|
107
|
|
|
for mess in frames: |
|
108
|
|
|
try: |
|
109
|
|
|
ecu_headers[mess[4:6]] += 1 |
|
110
|
|
|
except KeyError: |
|
111
|
|
|
ecu_headers[mess[4:6]] = 1 |
|
112
|
|
|
|
|
113
|
|
|
return ecu_headers |
|
114
|
|
|
|
|
115
|
|
|
def get_data(self, record): |
|
116
|
|
|
record = record[6:self.check_sum] |
|
117
|
|
|
if len(record) >= 6 and len(record) <= 16: |
|
118
|
|
|
# remove first 4 characters. This are service bytes from ELM |
|
119
|
|
|
# format mode:pid:data |
|
120
|
|
|
# ex: 4100FFFFFFFF - ELM spec page 38 |
|
121
|
|
|
record = record[4:] |
|
122
|
|
|
else: |
|
123
|
|
|
mess = "The frame size is not suitable." |
|
124
|
|
|
logger.error(mess) |
|
125
|
|
|
raise Exception(mess) |
|
126
|
|
|
|
|
127
|
|
|
return record |
|
128
|
|
|
|
s-s-boika /
obdlib
