Return supported versions

src/comm/MockLink.cc

@@ -794,15 +794,25 @@ void MockLink::_respondWithAutopilotVersion(void)
 {
     mavlink_message_t msg;
 
-    uint8_t customVersion[8];
-    memset(customVersion, 0, sizeof(customVersion));
+    uint8_t customVersion[8] = { };
+    uint32_t flightVersion = 0;
+    if (_firmwareType == MAV_AUTOPILOT_ARDUPILOTMEGA) {
+        flightVersion |= 3 << (8*3);
+        flightVersion |= 3 << (8*2);
+        flightVersion |= 0 << (8*1);
+        flightVersion |= FIRMWARE_VERSION_TYPE_DEV << (8*0);
+    } else if (_firmwareType == MAV_AUTOPILOT_PX4) {
+        flightVersion |= 1 << (8*3);
+        flightVersion |= 4 << (8*2);
+        flightVersion |= 1 << (8*1);
+        flightVersion |= FIRMWARE_VERSION_TYPE_DEV << (8*0);
+    }
 
-    // Only flight_sw_version is supported a this point
     mavlink_msg_autopilot_version_pack(_vehicleSystemId,
                                        _vehicleComponentId,
                                        &msg,
                                        0,                               // capabilities,
-                                       (1 << (8*3)) | FIRMWARE_VERSION_TYPE_DEV,    // flight_sw_version,
+                                       flightVersion,                   // flight_sw_version,
                                        0,                               // middleware_sw_version,
                                        0,                               // os_sw_version,
                                        0,                               // board_version,