Commit b88cd44d authored by Don Gagne's avatar Don Gagne

Reset mavlink channel before we use it

parent c5d25d25
......@@ -118,6 +118,7 @@ void LinkManager::_addLink(LinkInterface* link)
// Find a mavlink channel to use for this link
for (int i=0; i<32; i++) {
if (!(_mavlinkChannelsUsedBitMask && 1 << i)) {
mavlink_reset_channel_status(i);
link->_setMavlinkChannel(i);
_mavlinkChannelsUsedBitMask |= i << i;
break;
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment