Skip to content

Commit

Permalink
VO1-304: QAssist Messages show up on HUD
Browse files Browse the repository at this point in the history
Changing the severity of QAssist messages so they display on Mission planner HUD and also adding a QAssist message for Airspeed QAssist
  • Loading branch information
LachlanConn committed Nov 17, 2023
1 parent 76143f4 commit 6814e52
Showing 1 changed file with 3 additions and 2 deletions.
5 changes: 3 additions & 2 deletions ArduPlane/quadplane.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -1356,6 +1356,7 @@ bool QuadPlane::should_assist(float aspeed, bool have_airspeed)
if ((have_airspeed && aspeed < assist_speed) &&
(((options & OPTION_DISABLE_SYNTHETIC_AIRSPEED_ASSIST) == 0) || ahrs.airspeed_sensor_enabled())) {
in_angle_assist = false;
gcs().send_text(MAV_SEVERITY_WARNING, "Airspeed Q_assist %.1fm/s", aspeed);
angle_error_start_ms = 0;
return true;
}
Expand All @@ -1375,7 +1376,7 @@ bool QuadPlane::should_assist(float aspeed, bool have_airspeed)
// we've been below assistant alt for Q_ASSIST_DELAY seconds
if (!in_alt_assist) {
in_alt_assist = true;
gcs().send_text(MAV_SEVERITY_INFO, "Alt assist %.1fm", height_above_ground);
gcs().send_text(MAV_SEVERITY_WARNING, "Alt assist %.1fm", height_above_ground);
}
return true;
}
Expand Down Expand Up @@ -1420,7 +1421,7 @@ bool QuadPlane::should_assist(float aspeed, bool have_airspeed)
bool ret = (now - angle_error_start_ms) >= assist_delay*1000;
if (ret && !in_angle_assist) {
in_angle_assist = true;
gcs().send_text(MAV_SEVERITY_INFO, "Angle assist r=%d p=%d",
gcs().send_text(MAV_SEVERITY_WARNING, "Angle assist r=%d p=%d",
(int)(ahrs.roll_sensor/100),
(int)(ahrs.pitch_sensor/100));
}
Expand Down

0 comments on commit 6814e52

Please sign in to comment.