-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathmpx-data.cpp
138 lines (138 loc) · 3.81 KB
/
mpx-data.cpp
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
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
//-----------------------------------------------------------------------------
#include "avr-debug/debug.h"
#include "mpx-data.h"
#include "data.h"
#include "options.h"
#include "tripComp.h"
#include "body.h"
//-----------------------------------------------------------------------------
extern BYTE_DATA ignition;
extern BYTE_DATA climateEnabled;
extern BYTE_DATA insideTemp;
extern BYTE_DATA outsideTemp;
extern BYTE_DATA blowerSpeed;
extern WORD_DATA blowMode;
WORD_DATA distance = 0;
//-----------------------------------------------------------------------------
#define msg_id mpx_buf[2]
#define byte0 mpx_buf[3]
#define byte1 mpx_buf[4]
#define byte2 mpx_buf[5]
//-----------------------------------------------------------------------------
void mpxReceiver(__unused BYTE size, const BYTE* mpx_buf)
{
switch(msg_id)
{
case 0x15:
if(byte0 & 0x01)
{
// temporary switch
tripModeChange();
}
break;
case 0x20:
fuelRateTime = byte0 << 8 | byte1;
break;
case 0x24:
speed = byte0;
break;
case 0x25:
// averageSpeed = byte0 << 8 | byte1;
if(size > 7)
{
// the packet has an extra byte with units
switch(byte2)
{
case 0x40:
options.speedUnits = units.MPH;
options.convertKm2Miles = true;
break;
default:
options.speedUnits = units.KMPH;
}
}
break;
case 0x40:
selectorAT = byte0;
break;
case 0x6A:
switch(byte0)
{
case 0x10:
options.distUnits = units.MILES;
options.fuelRateUnits = units.MPG;
options.fuelRatePerTimeUnits = units.GPH;
options.convertKm2Miles = true;
options.convertLitres2GalonsUSA = true;
break;
case 0x11:
options.invertFuelRate = false;
}
break;
case 0x76:
tripDistance = byte0 << 8 | byte1;
distance = tripDistance;
if(distance.changed() && distance.value)
{
dayDistance++;
if(selectorAT & 0x1F)
{
totalDriveDistance++;
}
}
if(size > 7)
{
// the packet has an extra byte with units
options.distUnits = (byte2 == 0x40) ? units.MILES : units.KM;
}
break;
case 0x90:
fuelRateDist = byte0 << 8 | byte1;
if(size > 7)
{
// the packet has an extra byte with units
switch(byte2)
{
case 0x40:
options.invertFuelRate = false;
case 0x80:
options.fuelRateUnits = units.L100KM;
break;
case 0x20:
options.fuelRateUnits = units.MPG;
options.fuelRatePerTimeUnits = units.GPH;
options.convertLitres2GalonsUSA = true;
break;
case 0x10:
options.fuelRateUnits = units.MPG;
options.fuelRatePerTimeUnits = units.GPH;
options.convertLitres2GalonsENG = true;
break;
}
}
break;
case 0xA3:
averageFuelRate = byte0 << 8 | byte1;
break;
case 0xCD:
outsideTemp = byte0;
break;
case 0x1B:
blowerSpeed = byte0;
climateEnabled = (byte0 & 0x10) ? 1 : 0;
break;
case 0xFC:
blowMode = byte0 << 8 | byte1;
break;
case 0xDF:
ignition = byte0 & 0x40;
break;
case 0xFD:
if(byte0 < 0x38)
{
insideTemp = byte0;
}
break;
}
}
//-----------------------------------------------------------------------------