-
Notifications
You must be signed in to change notification settings - Fork 0
/
carpcp_can.py
74 lines (65 loc) · 1.94 KB
/
carpcp_can.py
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
#!/usr/bin/env python
# -*- coding: utf-8 -*-
#
# CAN Message Parse Lib-ish thinggy
#
# TODO: Fix all try/execpt
import re
__name__ = 'carpcp_can'
__version__ = '0.999a'
__license__ = 'GPLv3'
__author__ = 'georgi.kolev[at]gmail.com'
# Expected message syntax:
# ID HEX (11bit long value)
# RTR Integer (0 or 1)
# Len Integer (message len)
# Data HEX (Up to 8 bytes)
#
# ID RTR Len Data
# ID: fff -0- Data: [8] ff ff ff ff ff ff ff ff
# ID: fff -0- Data: [3] ff ff ff
#
# msg_match = r'ID: (\w+) -(\d{1})- Data: \[(\d{1})\] (.+)'
msg_match = r'ID: (\w+) \[(\d{1})\] (.+)'
class CanMsg(object):
def __init__(self):
self.mid = 0
self.rtr = 0
self.mlen = 0
self.message = []
def check_id(self, mid, maxv=0xFFF):
""" Check message ID integrity """
if isinstance(mid, int):
if (mid > 0) and (mid < (maxv + 1)):
return True
return False
def check_msg(self, m):
""" Check message data integrity """
try:
msg = m.split()
for x in xrange(0, len(msg)):
msg[x] = int(msg[x], 16)
except:
return False
return msg
def parse(self, m):
""" Parse CAN message
Syntax: ID: (%ARBID) [%LEN] %MESSAGE
Example: ID: FFF [3] ff ff ff
"""
matchObj = re.match(msg_match, m, re.I)
if matchObj:
match_array = matchObj.groups()
# Check Message ID
if self.check_id(int(match_array[0], 16)):
self.mid = int(match_array[0], 16)
# Check Message Lenght
if self.check_id(match_array[1], maxv=7):
self.mlen = int(match_array[1])
# Check Message Data
self.message = self.check_msg(match_array[2])
# All good?
if self.mid and self.mlen and self.message:
return True
return False
# EOF