|
|
|
@ -607,7 +607,8 @@ void APMSensorsComponentController::nextClicked(void)
@@ -607,7 +607,8 @@ void APMSensorsComponentController::nextClicked(void)
|
|
|
|
|
_vehicle->priorityLink()->mavlinkChannel(), |
|
|
|
|
&msg, |
|
|
|
|
0, // command
|
|
|
|
|
1); // result
|
|
|
|
|
1, // result
|
|
|
|
|
0); // progress
|
|
|
|
|
|
|
|
|
|
_vehicle->sendMessageOnLink(_vehicle->priorityLink(), msg); |
|
|
|
|
|
|
|
|
@ -677,7 +678,7 @@ void APMSensorsComponentController::_handleMagCalProgress(mavlink_message_t& mes
@@ -677,7 +678,7 @@ void APMSensorsComponentController::_handleMagCalProgress(mavlink_message_t& mes
|
|
|
|
|
mavlink_msg_mag_cal_progress_decode(&message, &magCalProgress); |
|
|
|
|
|
|
|
|
|
qCDebug(APMSensorsComponentControllerVerboseLog) << "_handleMagCalProgress id:mask:pct" |
|
|
|
|
<< magCalProgress.compass_id << magCalProgress.cal_mask << magCalProgress.completion_pct; |
|
|
|
|
<< magCalProgress.compass_id << magCalProgress.cal_mask << magCalProgress.completion_pct; |
|
|
|
|
|
|
|
|
|
// How many compasses are we calibrating?
|
|
|
|
|
int compassCalCount = 0; |
|
|
|
@ -705,7 +706,7 @@ void APMSensorsComponentController::_handleMagCalReport(mavlink_message_t& messa
@@ -705,7 +706,7 @@ void APMSensorsComponentController::_handleMagCalReport(mavlink_message_t& messa
|
|
|
|
|
mavlink_msg_mag_cal_report_decode(&message, &magCalReport); |
|
|
|
|
|
|
|
|
|
qCDebug(APMSensorsComponentControllerVerboseLog) << "_handleMagCalReport id:mask:status:fitness" |
|
|
|
|
<< magCalReport.compass_id << magCalReport.cal_mask << magCalReport.cal_status << magCalReport.fitness; |
|
|
|
|
<< magCalReport.compass_id << magCalReport.cal_mask << magCalReport.cal_status << magCalReport.fitness; |
|
|
|
|
|
|
|
|
|
bool additionalCompassCompleted = false; |
|
|
|
|
if (magCalReport.compass_id < 3 && !_rgCompassCalComplete[magCalReport.compass_id]) { |
|
|
|
|