Browse Source

AP_Soaring: eliminate GCS_MAVLINK::send_statustext_all

master
Peter Barker 8 years ago committed by Francisco Ferreira
parent
commit
196f94aaae
  1. 8
      libraries/AP_Soaring/AP_Soaring.cpp
  2. 2
      libraries/AP_Soaring/Variometer.cpp

8
libraries/AP_Soaring/AP_Soaring.cpp

@ -182,10 +182,10 @@ bool SoaringController::check_cruise_criteria() @@ -182,10 +182,10 @@ bool SoaringController::check_cruise_criteria()
float alt = _vario.alt;
if (soar_active && (AP_HAL::micros64() - _thermal_start_time_us) > ((unsigned)min_thermal_s * 1e6) && thermalability < McCready(alt)) {
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_INFO, "Thermal weak, recommend quitting: W %f R %f th %f alt %f Mc %f\n", (double)_ekf.X[0], (double)_ekf.X[1], (double)thermalability, (double)alt, (double)McCready(alt));
gcs().send_text(MAV_SEVERITY_INFO, "Thermal weak, recommend quitting: W %f R %f th %f alt %f Mc %f\n", (double)_ekf.X[0], (double)_ekf.X[1], (double)thermalability, (double)alt, (double)McCready(alt));
return true;
} else if (soar_active && (alt>alt_max || alt<alt_min)) {
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_ALERT, "Out of allowable altitude range, beginning cruise. Alt = %f\n", (double)alt);
gcs().send_text(MAV_SEVERITY_ALERT, "Out of allowable altitude range, beginning cruise. Alt = %f\n", (double)alt);
return true;
}
@ -272,10 +272,10 @@ void SoaringController::update_thermalling() @@ -272,10 +272,10 @@ void SoaringController::update_thermalling()
// Print32_t filter info for debugging
int32_t i;
for (i = 0; i < 4; i++) {
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_INFO, "%e ", (double)_ekf.P[i][i]);
gcs().send_text(MAV_SEVERITY_INFO, "%e ", (double)_ekf.P[i][i]);
}
for (i = 0; i < 4; i++) {
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_INFO, "%e ", (double)_ekf.X[i]);
gcs().send_text(MAV_SEVERITY_INFO, "%e ", (double)_ekf.X[i]);
}
#endif

2
libraries/AP_Soaring/Variometer.cpp

@ -75,6 +75,6 @@ float Variometer::correct_netto_rate(float climb_rate, @@ -75,6 +75,6 @@ float Variometer::correct_netto_rate(float climb_rate,
//float temp_netto = netto_rate;
//float dVdt = SpdHgt_Controller->get_VXdot();
//netto_rate = netto_rate + aspd*dVdt/GRAVITY_MSS;
//GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_INFO, "%f %f %f %f\n",temp_netto,dVdt,netto_rate,barometer.get_altitude());
//gcs().send_text(MAV_SEVERITY_INFO, "%f %f %f %f\n",temp_netto,dVdt,netto_rate,barometer.get_altitude());
return netto_rate;
}

Loading…
Cancel
Save