Line | Branch | Exec | Source |
---|---|---|---|
1 | #pragma once | ||
2 | |||
3 | #include "safety_declarations.h" | ||
4 | |||
5 | // All common address checks except SCM_BUTTONS which isn't on one Nidec safety configuration | ||
6 | #define HONDA_COMMON_NO_SCM_FEEDBACK_RX_CHECKS(pt_bus) \ | ||
7 | {.msg = {{0x1A6, (pt_bus), 8, .check_checksum = true, .max_counter = 3U, .frequency = 25U}, /* SCM_BUTTONS */ \ | ||
8 | {0x296, (pt_bus), 4, .check_checksum = true, .max_counter = 3U, .frequency = 25U}, { 0 }}}, \ | ||
9 | {.msg = {{0x158, (pt_bus), 8, .check_checksum = true, .max_counter = 3U, .frequency = 100U}, { 0 }, { 0 }}}, /* ENGINE_DATA */ \ | ||
10 | {.msg = {{0x17C, (pt_bus), 8, .check_checksum = true, .max_counter = 3U, .frequency = 100U}, { 0 }, { 0 }}}, /* POWERTRAIN_DATA */ \ | ||
11 | |||
12 | #define HONDA_COMMON_RX_CHECKS(pt_bus) \ | ||
13 | HONDA_COMMON_NO_SCM_FEEDBACK_RX_CHECKS(pt_bus) \ | ||
14 | {.msg = {{0x326, (pt_bus), 8, .check_checksum = true, .max_counter = 3U, .frequency = 10U}, { 0 }, { 0 }}}, /* SCM_FEEDBACK */ \ | ||
15 | |||
16 | // Alternate brake message is used on some Honda Bosch, and Honda Bosch radarless (where PT bus is 0) | ||
17 | #define HONDA_ALT_BRAKE_ADDR_CHECK(pt_bus) \ | ||
18 | {.msg = {{0x1BE, (pt_bus), 3, .check_checksum = true, .max_counter = 3U, .frequency = 50U}, { 0 }, { 0 }}}, /* BRAKE_MODULE */ \ | ||
19 | |||
20 | |||
21 | // Nidec and bosch radarless has the powertrain bus on bus 0 | ||
22 | static RxCheck honda_common_rx_checks[] = { | ||
23 | HONDA_COMMON_RX_CHECKS(0) | ||
24 | }; | ||
25 | |||
26 | enum { | ||
27 | HONDA_BTN_NONE = 0, | ||
28 | HONDA_BTN_MAIN = 1, | ||
29 | HONDA_BTN_CANCEL = 2, | ||
30 | HONDA_BTN_SET = 3, | ||
31 | HONDA_BTN_RESUME = 4, | ||
32 | }; | ||
33 | |||
34 | static int honda_brake = 0; | ||
35 | static bool honda_brake_switch_prev = false; | ||
36 | static bool honda_alt_brake_msg = false; | ||
37 | static bool honda_fwd_brake = false; | ||
38 | static bool honda_bosch_long = false; | ||
39 | static bool honda_bosch_radarless = false; | ||
40 | typedef enum {HONDA_NIDEC, HONDA_BOSCH} HondaHw; | ||
41 | static HondaHw honda_hw = HONDA_NIDEC; | ||
42 | |||
43 | |||
44 | 179143 | static int honda_get_pt_bus(void) { | |
45 |
4/4✓ Branch 0 taken 56970 times.
✓ Branch 1 taken 122173 times.
✓ Branch 2 taken 29278 times.
✓ Branch 3 taken 27692 times.
|
179143 | return ((honda_hw == HONDA_BOSCH) && !honda_bosch_radarless) ? 1 : 0; |
46 | } | ||
47 | |||
48 | 3637 | static uint32_t honda_get_checksum(const CANPacket_t *to_push) { | |
49 | 3637 | int checksum_byte = GET_LEN(to_push) - 1U; | |
50 | 3637 | return (uint8_t)(GET_BYTE(to_push, checksum_byte)) & 0xFU; | |
51 | } | ||
52 | |||
53 | 3637 | static uint32_t honda_compute_checksum(const CANPacket_t *to_push) { | |
54 | 3637 | int len = GET_LEN(to_push); | |
55 | 3637 | uint8_t checksum = 0U; | |
56 | 3637 | unsigned int addr = GET_ADDR(to_push); | |
57 |
2/2✓ Branch 0 taken 10911 times.
✓ Branch 1 taken 3637 times.
|
14548 | while (addr > 0U) { |
58 | 10911 | checksum += (uint8_t)(addr & 0xFU); addr >>= 4; | |
59 | } | ||
60 |
2/2✓ Branch 0 taken 16158 times.
✓ Branch 1 taken 3637 times.
|
19795 | for (int j = 0; j < len; j++) { |
61 | 16158 | uint8_t byte = GET_BYTE(to_push, j); | |
62 | 16158 | checksum += (uint8_t)(byte & 0xFU) + (byte >> 4U); | |
63 |
2/2✓ Branch 0 taken 3637 times.
✓ Branch 1 taken 12521 times.
|
16158 | if (j == (len - 1)) { |
64 | 3637 | checksum -= (byte & 0xFU); // remove checksum in message | |
65 | } | ||
66 | } | ||
67 | 3637 | return (uint8_t)((8U - checksum) & 0xFU); | |
68 | } | ||
69 | |||
70 | 3637 | static uint8_t honda_get_counter(const CANPacket_t *to_push) { | |
71 | 3637 | int counter_byte = GET_LEN(to_push) - 1U; | |
72 | 3637 | return (GET_BYTE(to_push, counter_byte) >> 4U) & 0x3U; | |
73 | } | ||
74 | |||
75 | 72176 | static void honda_rx_hook(const CANPacket_t *to_push) { | |
76 |
6/6✓ Branch 0 taken 54133 times.
✓ Branch 1 taken 18043 times.
✓ Branch 2 taken 20091 times.
✓ Branch 3 taken 34042 times.
✓ Branch 4 taken 18043 times.
✓ Branch 5 taken 20091 times.
|
72176 | const bool pcm_cruise = ((honda_hw == HONDA_BOSCH) && !honda_bosch_long) || (honda_hw == HONDA_NIDEC); |
77 | 72176 | int pt_bus = honda_get_pt_bus(); | |
78 | |||
79 | 72176 | int addr = GET_ADDR(to_push); | |
80 | 72176 | int bus = GET_BUS(to_push); | |
81 | |||
82 | // sample speed | ||
83 |
2/2✓ Branch 0 taken 88 times.
✓ Branch 1 taken 72088 times.
|
72176 | if (addr == 0x158) { |
84 | // first 2 bytes | ||
85 | 88 | vehicle_moving = GET_BYTE(to_push, 0) | GET_BYTE(to_push, 1); | |
86 | } | ||
87 | |||
88 | // check ACC main state | ||
89 | // 0x326 for all Bosch and some Nidec, 0x1A6 for some Nidec | ||
90 |
4/4✓ Branch 0 taken 72100 times.
✓ Branch 1 taken 76 times.
✓ Branch 2 taken 43 times.
✓ Branch 3 taken 72057 times.
|
72176 | if ((addr == 0x326) || (addr == 0x1A6)) { |
91 |
4/4✓ Branch 0 taken 76 times.
✓ Branch 1 taken 43 times.
✓ Branch 2 taken 76 times.
✓ Branch 3 taken 43 times.
|
119 | acc_main_on = GET_BIT(to_push, ((addr == 0x326) ? 28U : 47U)); |
92 |
2/2✓ Branch 0 taken 67 times.
✓ Branch 1 taken 52 times.
|
119 | if (!acc_main_on) { |
93 | 67 | controls_allowed = false; | |
94 | } | ||
95 | } | ||
96 | |||
97 | // enter controls when PCM enters cruise state | ||
98 |
4/4✓ Branch 0 taken 52085 times.
✓ Branch 1 taken 20091 times.
✓ Branch 2 taken 164 times.
✓ Branch 3 taken 51921 times.
|
72176 | if (pcm_cruise && (addr == 0x17C)) { |
99 | 164 | const bool cruise_engaged = GET_BIT(to_push, 38U); | |
100 | // engage on rising edge | ||
101 |
4/4✓ Branch 0 taken 76 times.
✓ Branch 1 taken 88 times.
✓ Branch 2 taken 48 times.
✓ Branch 3 taken 28 times.
|
164 | if (cruise_engaged && !cruise_engaged_prev) { |
102 | 48 | controls_allowed = true; | |
103 | } | ||
104 | |||
105 | // Since some Nidec cars can brake down to 0 after the PCM disengages, | ||
106 | // we don't disengage when the PCM does. | ||
107 |
4/4✓ Branch 0 taken 88 times.
✓ Branch 1 taken 76 times.
✓ Branch 2 taken 56 times.
✓ Branch 3 taken 32 times.
|
164 | if (!cruise_engaged && (honda_hw != HONDA_NIDEC)) { |
108 | 56 | controls_allowed = false; | |
109 | } | ||
110 | 164 | cruise_engaged_prev = cruise_engaged; | |
111 | } | ||
112 | |||
113 | // state machine to enter and exit controls for button enabling | ||
114 | // 0x1A6 for the ILX, 0x296 for the Civic Touring | ||
115 |
6/6✓ Branch 0 taken 72133 times.
✓ Branch 1 taken 43 times.
✓ Branch 2 taken 3210 times.
✓ Branch 3 taken 68923 times.
✓ Branch 4 taken 3221 times.
✓ Branch 5 taken 32 times.
|
72176 | if (((addr == 0x1A6) || (addr == 0x296)) && (bus == pt_bus)) { |
116 | 3221 | int button = (GET_BYTE(to_push, 0) & 0xE0U) >> 5; | |
117 | |||
118 | // enter controls on the falling edge of set or resume | ||
119 |
4/4✓ Branch 0 taken 2835 times.
✓ Branch 1 taken 386 times.
✓ Branch 2 taken 80 times.
✓ Branch 3 taken 2755 times.
|
3221 | bool set = (button != HONDA_BTN_SET) && (cruise_button_prev == HONDA_BTN_SET); |
120 |
4/4✓ Branch 0 taken 2849 times.
✓ Branch 1 taken 372 times.
✓ Branch 2 taken 80 times.
✓ Branch 3 taken 2769 times.
|
3221 | bool res = (button != HONDA_BTN_RESUME) && (cruise_button_prev == HONDA_BTN_RESUME); |
121 |
8/8✓ Branch 0 taken 1614 times.
✓ Branch 1 taken 1607 times.
✓ Branch 2 taken 1536 times.
✓ Branch 3 taken 78 times.
✓ Branch 4 taken 1506 times.
✓ Branch 5 taken 30 times.
✓ Branch 6 taken 30 times.
✓ Branch 7 taken 1476 times.
|
3221 | if (acc_main_on && !pcm_cruise && (set || res)) { |
122 | 60 | controls_allowed = true; | |
123 | } | ||
124 | |||
125 | // exit controls once main or cancel are pressed | ||
126 |
4/4✓ Branch 0 taken 2867 times.
✓ Branch 1 taken 354 times.
✓ Branch 2 taken 374 times.
✓ Branch 3 taken 2493 times.
|
3221 | if ((button == HONDA_BTN_MAIN) || (button == HONDA_BTN_CANCEL)) { |
127 | 728 | controls_allowed = false; | |
128 | } | ||
129 | 3221 | cruise_button_prev = button; | |
130 | } | ||
131 | |||
132 | // user brake signal on 0x17C reports applied brake from computer brake on accord | ||
133 | // and crv, which prevents the usual brake safety from working correctly. these | ||
134 | // cars have a signal on 0x1BE which only detects user's brake being applied so | ||
135 | // in these cases, this is used instead. | ||
136 | // most hondas: 0x17C | ||
137 | // accord, crv: 0x1BE | ||
138 |
2/2✓ Branch 0 taken 17024 times.
✓ Branch 1 taken 55152 times.
|
72176 | if (honda_alt_brake_msg) { |
139 |
2/2✓ Branch 0 taken 40 times.
✓ Branch 1 taken 16984 times.
|
17024 | if (addr == 0x1BE) { |
140 | 40 | brake_pressed = GET_BIT(to_push, 4U); | |
141 | } | ||
142 | } else { | ||
143 |
2/2✓ Branch 0 taken 189 times.
✓ Branch 1 taken 54963 times.
|
55152 | if (addr == 0x17C) { |
144 | // also if brake switch is 1 for two CAN frames, as brake pressed is delayed | ||
145 | 189 | const bool brake_switch = GET_BIT(to_push, 32U); | |
146 |
3/6✓ Branch 0 taken 135 times.
✓ Branch 1 taken 54 times.
✗ Branch 2 not taken.
✓ Branch 3 taken 135 times.
✗ Branch 4 not taken.
✗ Branch 5 not taken.
|
189 | brake_pressed = (GET_BIT(to_push, 53U)) || (brake_switch && honda_brake_switch_prev); |
147 | 189 | honda_brake_switch_prev = brake_switch; | |
148 | } | ||
149 | } | ||
150 | |||
151 |
2/2✓ Branch 0 taken 227 times.
✓ Branch 1 taken 71949 times.
|
72176 | if (addr == 0x17C) { |
152 | 227 | gas_pressed = GET_BYTE(to_push, 0) != 0U; | |
153 | } | ||
154 | |||
155 | // disable stock Honda AEB in alternative experience | ||
156 |
1/2✓ Branch 0 taken 72176 times.
✗ Branch 1 not taken.
|
72176 | if (!(alternative_experience & ALT_EXP_DISABLE_STOCK_AEB)) { |
157 |
4/4✓ Branch 0 taken 23556 times.
✓ Branch 1 taken 48620 times.
✓ Branch 2 taken 1036 times.
✓ Branch 3 taken 22520 times.
|
72176 | if ((bus == 2) && (addr == 0x1FA)) { |
158 | 1036 | bool honda_stock_aeb = GET_BIT(to_push, 29U); | |
159 | 1036 | int honda_stock_brake = (GET_BYTE(to_push, 0) << 2) | (GET_BYTE(to_push, 1) >> 6); | |
160 | |||
161 | // Forward AEB when stock braking is higher than openpilot braking | ||
162 | // only stop forwarding when AEB event is over | ||
163 |
2/2✓ Branch 0 taken 12 times.
✓ Branch 1 taken 1024 times.
|
1036 | if (!honda_stock_aeb) { |
164 | 12 | honda_fwd_brake = false; | |
165 |
2/2✓ Branch 0 taken 512 times.
✓ Branch 1 taken 512 times.
|
1024 | } else if (honda_stock_brake >= honda_brake) { |
166 | 512 | honda_fwd_brake = true; | |
167 | } else { | ||
168 | // Leave Honda forward brake as is | ||
169 | } | ||
170 | } | ||
171 | } | ||
172 | |||
173 |
2/2✓ Branch 0 taken 54133 times.
✓ Branch 1 taken 18043 times.
|
72176 | int bus_rdr_car = (honda_hw == HONDA_BOSCH) ? 0 : 2; // radar bus, car side |
174 | 72176 | bool stock_ecu_detected = false; | |
175 | |||
176 | // If steering controls messages are received on the destination bus, it's an indication | ||
177 | // that the relay might be malfunctioning | ||
178 |
4/4✓ Branch 0 taken 72152 times.
✓ Branch 1 taken 24 times.
✓ Branch 2 taken 24 times.
✓ Branch 3 taken 72128 times.
|
72176 | if ((addr == 0xE4) || (addr == 0x194)) { |
179 |
8/8✓ Branch 0 taken 36 times.
✓ Branch 1 taken 12 times.
✓ Branch 2 taken 24 times.
✓ Branch 3 taken 12 times.
✓ Branch 4 taken 12 times.
✓ Branch 5 taken 24 times.
✓ Branch 6 taken 4 times.
✓ Branch 7 taken 8 times.
|
48 | if (((honda_hw != HONDA_NIDEC) && (bus == bus_rdr_car)) || ((honda_hw == HONDA_NIDEC) && (bus == 0))) { |
180 | 16 | stock_ecu_detected = true; | |
181 | } | ||
182 | } | ||
183 | // If Honda Bosch longitudinal mode is selected we need to ensure the radar is turned off | ||
184 | // Verify this by ensuring ACC_CONTROL (0x1DF) is not received on the PT bus | ||
185 |
8/8✓ Branch 0 taken 20091 times.
✓ Branch 1 taken 52085 times.
✓ Branch 2 taken 10047 times.
✓ Branch 3 taken 10044 times.
✓ Branch 4 taken 4415 times.
✓ Branch 5 taken 5632 times.
✓ Branch 6 taken 1 times.
✓ Branch 7 taken 4414 times.
|
72176 | if (honda_bosch_long && !honda_bosch_radarless && (bus == pt_bus) && (addr == 0x1DF)) { |
186 | 1 | stock_ecu_detected = true; | |
187 | } | ||
188 | |||
189 | 72176 | generic_rx_checks(stock_ecu_detected); | |
190 | |||
191 | 72176 | } | |
192 | |||
193 | 106967 | static bool honda_tx_hook(const CANPacket_t *to_send) { | |
194 | |||
195 | const LongitudinalLimits HONDA_BOSCH_LONG_LIMITS = { | ||
196 | .max_accel = 200, // accel is used for brakes | ||
197 | .min_accel = -350, | ||
198 | |||
199 | .max_gas = 2000, | ||
200 | .inactive_gas = -30000, | ||
201 | }; | ||
202 | |||
203 | const LongitudinalLimits HONDA_NIDEC_LONG_LIMITS = { | ||
204 | .max_gas = 198, // 0xc6 | ||
205 | .max_brake = 255, | ||
206 | |||
207 | .inactive_speed = 0, | ||
208 | }; | ||
209 | |||
210 | 106967 | bool tx = true; | |
211 | 106967 | int addr = GET_ADDR(to_send); | |
212 | 106967 | int bus = GET_BUS(to_send); | |
213 | |||
214 | 106967 | int bus_pt = honda_get_pt_bus(); | |
215 |
2/2✓ Branch 0 taken 627 times.
✓ Branch 1 taken 106340 times.
|
106967 | int bus_buttons = (honda_bosch_radarless) ? 2 : bus_pt; // the camera controls ACC on radarless Bosch cars |
216 | |||
217 | // ACC_HUD: safety check (nidec w/o pedal) | ||
218 |
3/4✓ Branch 0 taken 102004 times.
✓ Branch 1 taken 4963 times.
✓ Branch 2 taken 102004 times.
✗ Branch 3 not taken.
|
106967 | if ((addr == 0x30C) && (bus == bus_pt)) { |
219 | 102004 | int pcm_speed = (GET_BYTE(to_send, 0) << 8) | GET_BYTE(to_send, 1); | |
220 | 102004 | int pcm_gas = GET_BYTE(to_send, 2); | |
221 | |||
222 | 102004 | bool violation = false; | |
223 | 102004 | violation |= longitudinal_speed_checks(pcm_speed, HONDA_NIDEC_LONG_LIMITS); | |
224 | 102004 | violation |= longitudinal_gas_checks(pcm_gas, HONDA_NIDEC_LONG_LIMITS); | |
225 |
2/2✓ Branch 0 taken 62198 times.
✓ Branch 1 taken 39806 times.
|
102004 | if (violation) { |
226 | 62198 | tx = false; | |
227 | } | ||
228 | } | ||
229 | |||
230 | // BRAKE: safety check (nidec) | ||
231 |
3/4✓ Branch 0 taken 2125 times.
✓ Branch 1 taken 104842 times.
✓ Branch 2 taken 2125 times.
✗ Branch 3 not taken.
|
106967 | if ((addr == 0x1FA) && (bus == bus_pt)) { |
232 | 2125 | honda_brake = (GET_BYTE(to_send, 0) << 2) + ((GET_BYTE(to_send, 1) >> 6) & 0x3U); | |
233 |
2/2✓ Branch 1 taken 1092 times.
✓ Branch 2 taken 1033 times.
|
2125 | if (longitudinal_brake_checks(honda_brake, HONDA_NIDEC_LONG_LIMITS)) { |
234 | 1092 | tx = false; | |
235 | } | ||
236 |
2/2✓ Branch 0 taken 1060 times.
✓ Branch 1 taken 1065 times.
|
2125 | if (honda_fwd_brake) { |
237 | 1060 | tx = false; | |
238 | } | ||
239 | } | ||
240 | |||
241 | // BRAKE/GAS: safety check (bosch) | ||
242 |
3/4✓ Branch 0 taken 2181 times.
✓ Branch 1 taken 104786 times.
✓ Branch 2 taken 2181 times.
✗ Branch 3 not taken.
|
106967 | if ((addr == 0x1DF) && (bus == bus_pt)) { |
243 | 2181 | int accel = (GET_BYTE(to_send, 3) << 3) | ((GET_BYTE(to_send, 4) >> 5) & 0x7U); | |
244 | 2181 | accel = to_signed(accel, 11); | |
245 | |||
246 | 2181 | int gas = (GET_BYTE(to_send, 0) << 8) | GET_BYTE(to_send, 1); | |
247 | 2181 | gas = to_signed(gas, 16); | |
248 | |||
249 | 2181 | bool violation = false; | |
250 | 2181 | violation |= longitudinal_accel_checks(accel, HONDA_BOSCH_LONG_LIMITS); | |
251 | 2181 | violation |= longitudinal_gas_checks(gas, HONDA_BOSCH_LONG_LIMITS); | |
252 |
2/2✓ Branch 0 taken 1606 times.
✓ Branch 1 taken 575 times.
|
2181 | if (violation) { |
253 | 1606 | tx = false; | |
254 | } | ||
255 | } | ||
256 | |||
257 | // ACCEL: safety check (radarless) | ||
258 |
3/4✓ Branch 0 taken 609 times.
✓ Branch 1 taken 106358 times.
✓ Branch 2 taken 609 times.
✗ Branch 3 not taken.
|
106967 | if ((addr == 0x1C8) && (bus == bus_pt)) { |
259 | 609 | int accel = (GET_BYTE(to_send, 0) << 4) | (GET_BYTE(to_send, 1) >> 4); | |
260 | 609 | accel = to_signed(accel, 12); | |
261 | |||
262 | 609 | bool violation = false; | |
263 | 609 | violation |= longitudinal_accel_checks(accel, HONDA_BOSCH_LONG_LIMITS); | |
264 |
2/2✓ Branch 0 taken 376 times.
✓ Branch 1 taken 233 times.
|
609 | if (violation) { |
265 | 376 | tx = false; | |
266 | } | ||
267 | } | ||
268 | |||
269 | // STEER: safety check | ||
270 |
3/4✓ Branch 0 taken 106951 times.
✓ Branch 1 taken 16 times.
✗ Branch 2 not taken.
✓ Branch 3 taken 106951 times.
|
106967 | if ((addr == 0xE4) || (addr == 0x194)) { |
271 |
1/2✓ Branch 0 taken 16 times.
✗ Branch 1 not taken.
|
16 | if (!controls_allowed) { |
272 | 16 | bool steer_applied = GET_BYTE(to_send, 0) | GET_BYTE(to_send, 1); | |
273 |
2/2✓ Branch 0 taken 8 times.
✓ Branch 1 taken 8 times.
|
16 | if (steer_applied) { |
274 | 8 | tx = false; | |
275 | } | ||
276 | } | ||
277 | } | ||
278 | |||
279 | // Bosch supplemental control check | ||
280 |
2/2✓ Branch 0 taken 4 times.
✓ Branch 1 taken 106963 times.
|
106967 | if (addr == 0xE5) { |
281 |
1/4✗ Branch 1 not taken.
✓ Branch 2 taken 4 times.
✗ Branch 4 not taken.
✗ Branch 5 not taken.
|
4 | if ((GET_BYTES(to_send, 0, 4) != 0x10800004U) || ((GET_BYTES(to_send, 4, 4) & 0x00FFFFFFU) != 0x0U)) { |
282 | 4 | tx = false; | |
283 | } | ||
284 | } | ||
285 | |||
286 | // FORCE CANCEL: safety check only relevant when spamming the cancel button in Bosch HW | ||
287 | // ensuring that only the cancel button press is sent (VAL 2) when controls are off. | ||
288 | // This avoids unintended engagements while still allowing resume spam | ||
289 |
5/6✓ Branch 0 taken 16 times.
✓ Branch 1 taken 106951 times.
✓ Branch 2 taken 12 times.
✓ Branch 3 taken 4 times.
✓ Branch 4 taken 12 times.
✗ Branch 5 not taken.
|
106967 | if ((addr == 0x296) && !controls_allowed && (bus == bus_buttons)) { |
290 |
2/2✓ Branch 0 taken 8 times.
✓ Branch 1 taken 4 times.
|
12 | if (((GET_BYTE(to_send, 0) >> 5) & 0x7U) != 2U) { |
291 | 8 | tx = false; | |
292 | } | ||
293 | } | ||
294 | |||
295 | // Only tester present ("\x02\x3E\x80\x00\x00\x00\x00\x00") allowed on diagnostics address | ||
296 |
2/2✓ Branch 0 taken 4 times.
✓ Branch 1 taken 106963 times.
|
106967 | if (addr == 0x18DAB0F1) { |
297 |
3/4✓ Branch 1 taken 1 times.
✓ Branch 2 taken 3 times.
✗ Branch 4 not taken.
✓ Branch 5 taken 1 times.
|
4 | if ((GET_BYTES(to_send, 0, 4) != 0x00803E02U) || (GET_BYTES(to_send, 4, 4) != 0x0U)) { |
298 | 3 | tx = false; | |
299 | } | ||
300 | } | ||
301 | |||
302 | 106967 | return tx; | |
303 | } | ||
304 | |||
305 | 56 | static safety_config honda_nidec_init(uint16_t param) { | |
306 | static CanMsg HONDA_N_TX_MSGS[] = {{0xE4, 0, 5}, {0x194, 0, 4}, {0x1FA, 0, 8}, {0x30C, 0, 8}, {0x33D, 0, 5}}; | ||
307 | |||
308 | 56 | const uint16_t HONDA_PARAM_NIDEC_ALT = 4; | |
309 | |||
310 | 56 | honda_hw = HONDA_NIDEC; | |
311 | 56 | honda_brake = 0; | |
312 | 56 | honda_brake_switch_prev = false; | |
313 | 56 | honda_fwd_brake = false; | |
314 | 56 | honda_alt_brake_msg = false; | |
315 | 56 | honda_bosch_long = false; | |
316 | 56 | honda_bosch_radarless = false; | |
317 | |||
318 | safety_config ret; | ||
319 | |||
320 | 56 | bool enable_nidec_alt = GET_FLAG(param, HONDA_PARAM_NIDEC_ALT); | |
321 | |||
322 |
2/2✓ Branch 0 taken 28 times.
✓ Branch 1 taken 28 times.
|
56 | if (enable_nidec_alt) { |
323 | // For Nidecs with main on signal on an alternate msg (missing 0x326) | ||
324 | static RxCheck honda_nidec_alt_rx_checks[] = { | ||
325 | HONDA_COMMON_NO_SCM_FEEDBACK_RX_CHECKS(0) | ||
326 | }; | ||
327 | |||
328 | 28 | SET_RX_CHECKS(honda_nidec_alt_rx_checks, ret); | |
329 | } else { | ||
330 | 28 | SET_RX_CHECKS(honda_common_rx_checks, ret); | |
331 | } | ||
332 | |||
333 | 56 | SET_TX_MSGS(HONDA_N_TX_MSGS, ret); | |
334 | |||
335 | 56 | return ret; | |
336 | } | ||
337 | |||
338 | 177 | static safety_config honda_bosch_init(uint16_t param) { | |
339 | static CanMsg HONDA_BOSCH_TX_MSGS[] = {{0xE4, 0, 5}, {0xE5, 0, 8}, {0x296, 1, 4}, {0x33D, 0, 5}, {0x33DA, 0, 5}, {0x33DB, 0, 8}}; // Bosch | ||
340 | static CanMsg HONDA_BOSCH_LONG_TX_MSGS[] = {{0xE4, 1, 5}, {0x1DF, 1, 8}, {0x1EF, 1, 8}, {0x1FA, 1, 8}, {0x30C, 1, 8}, {0x33D, 1, 5}, {0x33DA, 1, 5}, {0x33DB, 1, 8}, {0x39F, 1, 8}, {0x18DAB0F1, 1, 8}}; // Bosch w/ gas and brakes | ||
341 | static CanMsg HONDA_RADARLESS_TX_MSGS[] = {{0xE4, 0, 5}, {0x296, 2, 4}, {0x33D, 0, 8}}; // Bosch radarless | ||
342 | static CanMsg HONDA_RADARLESS_LONG_TX_MSGS[] = {{0xE4, 0, 5}, {0x33D, 0, 8}, {0x1C8, 0, 8}, {0x30C, 0, 8}}; // Bosch radarless w/ gas and brakes | ||
343 | |||
344 | 177 | const uint16_t HONDA_PARAM_ALT_BRAKE = 1; | |
345 | 177 | const uint16_t HONDA_PARAM_RADARLESS = 8; | |
346 | |||
347 | static RxCheck honda_common_alt_brake_rx_checks[] = { | ||
348 | HONDA_COMMON_RX_CHECKS(0) | ||
349 | HONDA_ALT_BRAKE_ADDR_CHECK(0) | ||
350 | }; | ||
351 | |||
352 | static RxCheck honda_bosch_alt_brake_rx_checks[] = { | ||
353 | HONDA_COMMON_RX_CHECKS(1) | ||
354 | HONDA_ALT_BRAKE_ADDR_CHECK(1) | ||
355 | }; | ||
356 | |||
357 | // Bosch has pt on bus 1, verified 0x1A6 does not exist | ||
358 | static RxCheck honda_bosch_rx_checks[] = { | ||
359 | HONDA_COMMON_RX_CHECKS(1) | ||
360 | }; | ||
361 | |||
362 | 177 | honda_hw = HONDA_BOSCH; | |
363 | 177 | honda_brake_switch_prev = false; | |
364 | 177 | honda_bosch_radarless = GET_FLAG(param, HONDA_PARAM_RADARLESS); | |
365 | // Checking for alternate brake override from safety parameter | ||
366 | 177 | honda_alt_brake_msg = GET_FLAG(param, HONDA_PARAM_ALT_BRAKE); | |
367 | |||
368 | // radar disabled so allow gas/brakes | ||
369 | #ifdef ALLOW_DEBUG | ||
370 | 177 | const uint16_t HONDA_PARAM_BOSCH_LONG = 2; | |
371 | 177 | honda_bosch_long = GET_FLAG(param, HONDA_PARAM_BOSCH_LONG); | |
372 | #endif | ||
373 | |||
374 | safety_config ret; | ||
375 |
4/4✓ Branch 0 taken 88 times.
✓ Branch 1 taken 89 times.
✓ Branch 2 taken 28 times.
✓ Branch 3 taken 60 times.
|
177 | if (honda_bosch_radarless && honda_alt_brake_msg) { |
376 | 28 | SET_RX_CHECKS(honda_common_alt_brake_rx_checks, ret); | |
377 |
2/2✓ Branch 0 taken 60 times.
✓ Branch 1 taken 89 times.
|
149 | } else if (honda_bosch_radarless) { |
378 | 60 | SET_RX_CHECKS(honda_common_rx_checks, ret); | |
379 |
2/2✓ Branch 0 taken 28 times.
✓ Branch 1 taken 61 times.
|
89 | } else if (honda_alt_brake_msg) { |
380 | 28 | SET_RX_CHECKS(honda_bosch_alt_brake_rx_checks, ret); | |
381 | } else { | ||
382 | 61 | SET_RX_CHECKS(honda_bosch_rx_checks, ret); | |
383 | } | ||
384 | |||
385 |
2/2✓ Branch 0 taken 88 times.
✓ Branch 1 taken 89 times.
|
177 | if (honda_bosch_radarless) { |
386 |
2/2✓ Branch 0 taken 33 times.
✓ Branch 1 taken 55 times.
|
88 | if (honda_bosch_long) { |
387 | 33 | SET_TX_MSGS(HONDA_RADARLESS_LONG_TX_MSGS, ret); | |
388 | } else { | ||
389 | 55 | SET_TX_MSGS(HONDA_RADARLESS_TX_MSGS, ret); | |
390 | } | ||
391 | } else { | ||
392 |
2/2✓ Branch 0 taken 34 times.
✓ Branch 1 taken 55 times.
|
89 | if (honda_bosch_long) { |
393 | 34 | SET_TX_MSGS(HONDA_BOSCH_LONG_TX_MSGS, ret); | |
394 | } else { | ||
395 | 55 | SET_TX_MSGS(HONDA_BOSCH_TX_MSGS, ret); | |
396 | } | ||
397 | } | ||
398 | 177 | return ret; | |
399 | } | ||
400 | |||
401 | 33792 | static int honda_nidec_fwd_hook(int bus_num, int addr) { | |
402 | // fwd from car to camera. also fwd certain msgs from camera to car | ||
403 | // 0xE4 is steering on all cars except CRV and RDX, 0x194 for CRV and RDX, | ||
404 | // 0x1FA is brake control, 0x30C is acc hud, 0x33D is lkas hud | ||
405 | 33792 | int bus_fwd = -1; | |
406 | |||
407 |
2/2✓ Branch 0 taken 11264 times.
✓ Branch 1 taken 22528 times.
|
33792 | if (bus_num == 0) { |
408 | 11264 | bus_fwd = 2; | |
409 | } | ||
410 | |||
411 |
2/2✓ Branch 0 taken 11264 times.
✓ Branch 1 taken 22528 times.
|
33792 | if (bus_num == 2) { |
412 | // block stock lkas messages and stock acc messages (if OP is doing ACC) | ||
413 |
6/6✓ Branch 0 taken 11260 times.
✓ Branch 1 taken 4 times.
✓ Branch 2 taken 11256 times.
✓ Branch 3 taken 4 times.
✓ Branch 4 taken 4 times.
✓ Branch 5 taken 11252 times.
|
11264 | bool is_lkas_msg = (addr == 0xE4) || (addr == 0x194) || (addr == 0x33D); |
414 | 11264 | bool is_acc_hud_msg = addr == 0x30C; | |
415 | 11264 | bool is_brake_msg = addr == 0x1FA; | |
416 |
8/8✓ Branch 0 taken 11252 times.
✓ Branch 1 taken 12 times.
✓ Branch 2 taken 11248 times.
✓ Branch 3 taken 4 times.
✓ Branch 4 taken 4 times.
✓ Branch 5 taken 11244 times.
✓ Branch 6 taken 2 times.
✓ Branch 7 taken 2 times.
|
11264 | bool block_fwd = is_lkas_msg || is_acc_hud_msg || (is_brake_msg && !honda_fwd_brake); |
417 |
2/2✓ Branch 0 taken 11246 times.
✓ Branch 1 taken 18 times.
|
11264 | if (!block_fwd) { |
418 | 11246 | bus_fwd = 0; | |
419 | } | ||
420 | } | ||
421 | |||
422 | 33792 | return bus_fwd; | |
423 | } | ||
424 | |||
425 | 50688 | static int honda_bosch_fwd_hook(int bus_num, int addr) { | |
426 | 50688 | int bus_fwd = -1; | |
427 | |||
428 |
2/2✓ Branch 0 taken 16896 times.
✓ Branch 1 taken 33792 times.
|
50688 | if (bus_num == 0) { |
429 | 16896 | bus_fwd = 2; | |
430 | } | ||
431 |
2/2✓ Branch 0 taken 16896 times.
✓ Branch 1 taken 33792 times.
|
50688 | if (bus_num == 2) { |
432 |
10/10✓ Branch 0 taken 16890 times.
✓ Branch 1 taken 6 times.
✓ Branch 2 taken 16884 times.
✓ Branch 3 taken 6 times.
✓ Branch 4 taken 16878 times.
✓ Branch 5 taken 6 times.
✓ Branch 6 taken 16872 times.
✓ Branch 7 taken 6 times.
✓ Branch 8 taken 6 times.
✓ Branch 9 taken 16866 times.
|
16896 | bool is_lkas_msg = (addr == 0xE4) || (addr == 0xE5) || (addr == 0x33D) || (addr == 0x33DA) || (addr == 0x33DB); |
433 |
8/8✓ Branch 0 taken 16890 times.
✓ Branch 1 taken 6 times.
✓ Branch 2 taken 6 times.
✓ Branch 3 taken 16884 times.
✓ Branch 4 taken 6 times.
✓ Branch 5 taken 6 times.
✓ Branch 6 taken 2 times.
✓ Branch 7 taken 4 times.
|
16896 | bool is_acc_msg = ((addr == 0x1C8) || (addr == 0x30C)) && honda_bosch_radarless && honda_bosch_long; |
434 |
4/4✓ Branch 0 taken 16866 times.
✓ Branch 1 taken 30 times.
✓ Branch 2 taken 2 times.
✓ Branch 3 taken 16864 times.
|
16896 | bool block_msg = is_lkas_msg || is_acc_msg; |
435 |
2/2✓ Branch 0 taken 16864 times.
✓ Branch 1 taken 32 times.
|
16896 | if (!block_msg) { |
436 | 16864 | bus_fwd = 0; | |
437 | } | ||
438 | } | ||
439 | |||
440 | 50688 | return bus_fwd; | |
441 | } | ||
442 | |||
443 | const safety_hooks honda_nidec_hooks = { | ||
444 | .init = honda_nidec_init, | ||
445 | .rx = honda_rx_hook, | ||
446 | .tx = honda_tx_hook, | ||
447 | .fwd = honda_nidec_fwd_hook, | ||
448 | .get_counter = honda_get_counter, | ||
449 | .get_checksum = honda_get_checksum, | ||
450 | .compute_checksum = honda_compute_checksum, | ||
451 | }; | ||
452 | |||
453 | const safety_hooks honda_bosch_hooks = { | ||
454 | .init = honda_bosch_init, | ||
455 | .rx = honda_rx_hook, | ||
456 | .tx = honda_tx_hook, | ||
457 | .fwd = honda_bosch_fwd_hook, | ||
458 | .get_counter = honda_get_counter, | ||
459 | .get_checksum = honda_get_checksum, | ||
460 | .compute_checksum = honda_compute_checksum, | ||
461 | }; | ||
462 |