diff --git a/ArduSub/GCS_Mavlink.cpp b/ArduSub/GCS_Mavlink.cpp index bd945f258d..6dcda8749e 100644 --- a/ArduSub/GCS_Mavlink.cpp +++ b/ArduSub/GCS_Mavlink.cpp @@ -1090,6 +1090,10 @@ void GCS_MAVLINK_Sub::handleMessage(mavlink_message_t* msg) result = MAV_RESULT_ACCEPTED; } } else { + // ensure param1 is zero + if (!is_zero(packet.param1)) { + break; + } // sanity check location if (!check_latlng(packet.param5, packet.param6)) { break;