Allow RADIO_STATUS message to pass through to vehicle

src/Vehicle/Vehicle.cc

@@ -464,10 +464,12 @@ void Vehicle::resetCounters()
 
 void Vehicle::_mavlinkMessageReceived(LinkInterface* link, mavlink_message_t message)
 {
-
     if (message.sysid != _id && message.sysid != 0) {
+        // We allow RADIO_STATUS messages which come from a link the vehicle is using to pass through and be handled
+        if (!(message.msgid == MAVLINK_MSG_ID_RADIO_STATUS && _containsLink(link))) {
             return;
         }
+    }
 
     if (!_containsLink(link)) {
         _addLink(link);