diff --git a/src/comm/MockLink.cc b/src/comm/MockLink.cc index e01fd9e1c16f23f4ea97fe169990adf1b8163e98..0564ea1e1fce2546b27cacc7f2fb17039c628688 100644 --- a/src/comm/MockLink.cc +++ b/src/comm/MockLink.cc @@ -799,29 +799,24 @@ void MockLink::setMissionItemFailureMode(MockLinkMissionItemHandler::FailureMode void MockLink::_sendHomePosition(void) { - // APM stack does not yet support HOME_POSITION - - if (_firmwareType != MAV_AUTOPILOT_ARDUPILOTMEGA) { - - mavlink_message_t msg; + mavlink_message_t msg; - float bogus[4]; - bogus[0] = 0.0f; - bogus[1] = 0.0f; - bogus[2] = 0.0f; - bogus[3] = 0.0f; - - mavlink_msg_home_position_pack(_vehicleSystemId, - _vehicleComponentId, - &msg, - (int32_t)(_vehicleLatitude * 1E7), - (int32_t)(_vehicleLongitude * 1E7), - (int32_t)(_vehicleAltitude * 1000), - 0.0f, 0.0f, 0.0f, - &bogus[0], - 0.0f, 0.0f, 0.0f); - respondWithMavlinkMessage(msg); - } + float bogus[4]; + bogus[0] = 0.0f; + bogus[1] = 0.0f; + bogus[2] = 0.0f; + bogus[3] = 0.0f; + + mavlink_msg_home_position_pack(_vehicleSystemId, + _vehicleComponentId, + &msg, + (int32_t)(_vehicleLatitude * 1E7), + (int32_t)(_vehicleLongitude * 1E7), + (int32_t)(_vehicleAltitude * 1000), + 0.0f, 0.0f, 0.0f, + &bogus[0], + 0.0f, 0.0f, 0.0f); + respondWithMavlinkMessage(msg); } void MockLink::_sendGpsRawInt(void)