Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_PiccoloCAN: Prevent thread from getting stuck in an infinite loop 

- Previous code would get stuck in the CAN Tx loop
- New approach is to simply increase the timeout on frame transmission
This commit is contained in:
Oliver Walters 2020-09-25 11:33:54 +10:00 committed by Andrew Tridgell
parent 6786e832a1
commit 479df2e20b
1 changed files with 11 additions and 12 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
libraries/AP_PiccoloCAN/AP_PiccoloCAN.cpp
View File

@ -157,7 +157,7 @@ void AP_PiccoloCAN::loop()
continue;
}
timeout = AP_HAL::micros64() + 250;
timeout = AP_HAL::micros() + 250;
// 1ms loop delay
hal.scheduler->delay_microseconds(1 * 1000);
@ -171,6 +171,8 @@ void AP_PiccoloCAN::loop()
// Look for any message responses on the CAN bus
while (read_frame(rxFrame, timeout)) {
// Extract group and device ID values from the frame identifier
frame_id_group = (rxFrame.id >> 24) & 0x1F;
frame_id_device = (rxFrame.id >> 8) & 0xFF;
@ -212,13 +214,12 @@ bool AP_PiccoloCAN::write_frame(AP_HAL::CANFrame &out_frame, uint64_t timeout)
bool read_select = false;
bool write_select = true;
bool ret;
do {
ret = _can_iface->select(read_select, write_select, &out_frame, timeout);
if (!ret || !write_select) {
hal.scheduler->delay_microseconds(50);
}
} while (!ret || !write_select);
bool ret = _can_iface->select(read_select, write_select, &out_frame, timeout);
if (!ret || !write_select) {
return false;
}
return (_can_iface->send(out_frame, timeout, AP_HAL::CANIface::AbortOnError) == 1);
}
@ -233,6 +234,7 @@ bool AP_PiccoloCAN::read_frame(AP_HAL::CANFrame &recv_frame, uint64_t timeout)
bool read_select = true;
bool write_select = false;
bool ret = _can_iface->select(read_select, write_select, nullptr, timeout);
if (!ret || !read_select) {
// No frame available
return false;
@ -370,10 +372,7 @@ void AP_PiccoloCAN::send_esc_messages(void)
{
AP_HAL::CANFrame txFrame;
uint64_t timeout = AP_HAL::micros64() + 250;
// TODO - How to buffer CAN messages properly?
// Sending more than 2 messages at each loop instance means that sometimes messages are dropped
uint64_t timeout = AP_HAL::micros() + 1000;
// No ESCs are selected? Don't send anything
if (_esc_bm == 0x00) {