|
|
@ -118,6 +118,7 @@ void LinkManager::_addLink(LinkInterface* link) |
|
|
|
// Find a mavlink channel to use for this link
|
|
|
|
// Find a mavlink channel to use for this link
|
|
|
|
for (int i=0; i<32; i++) { |
|
|
|
for (int i=0; i<32; i++) { |
|
|
|
if (!(_mavlinkChannelsUsedBitMask && 1 << i)) { |
|
|
|
if (!(_mavlinkChannelsUsedBitMask && 1 << i)) { |
|
|
|
|
|
|
|
mavlink_reset_channel_status(i); |
|
|
|
link->_setMavlinkChannel(i); |
|
|
|
link->_setMavlinkChannel(i); |
|
|
|
_mavlinkChannelsUsedBitMask |= i << i; |
|
|
|
_mavlinkChannelsUsedBitMask |= i << i; |
|
|
|
break; |
|
|
|
break; |
|
|
|