deb_led_on(LEDB);
req = ((rx_msg.data[0]<<8) | (rx_msg.data[1]));
- if (req >= 0x140 && req <= 0x3f0) { /* TODO: Check the bounds */
+ if (req >= 0x150 && req <= 0x3e0) {
fsm_vidle.flags &= ~CAN_VIDLE_OUT_OF_BOUNDS;
fsm_vidle.can_req_position = req;// save new req position of lift
} else
if (IO0PIN & (1<<BUMPER_PIN))
{
- tx_msg.data[0] = 1;
- deb_led_on(LEDR);
+ tx_msg.data[0] = 0;
+ deb_led_off(LEDR);
}
else
{
- tx_msg.data[0] = 0;
- deb_led_off(LEDR);
+ tx_msg.data[0] = 1;
+ deb_led_on(LEDR);
}
can_tx_msg(&tx_msg);