Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-03 06:28:27 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_TECS: set target airspeed, not min/max airspeed, on landing

Browse Source 
this seems to prevent ballooning of the altitude when we are in the
landing approach, and gives a much smoother landing
This commit is contained in:
Andrew Tridgell 2014-03-20 07:59:10 +11:00
parent 98530928b5
commit a55c4e2296
2 changed files with 13 additions and 9 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

19
libraries/AP_TECS/AP_TECS.cpp
View File

@ -111,7 +111,7 @@ const AP_Param::GroupInfo AP_TECS::var_info[] PROGMEM = {
// @Param: LAND_ARSPD
// @DisplayName: Airspeed during landing approach (m/s)
// @Description: When performing an autonomus landing, this value is used as the goal airspeed during approach. Note that this parameter is not useful if your platform does not have an airspeed sensor (use TECS_LAND_THR instead). If set to -1 or less then this value is not used during landing.
// @Description: When performing an autonomus landing, this value is used as the goal airspeed during approach. Note that this parameter is not useful if your platform does not have an airspeed sensor (use TECS_LAND_THR instead). If negative then this value is not used during landing.
// @Range: -1 to 127
// @Increment: 1
// @User: User
@ -119,7 +119,7 @@ const AP_Param::GroupInfo AP_TECS::var_info[] PROGMEM = {
// @Param; LAND_THR
// @DisplayName: Cruise throttle during landing approach (percentage)
// @Description: Use this parameter instead of LAND_ASPD if your platform does not have an airspeed sensor. It is the cruise throttle during landing approach. If set to -1 or less or if TECS_LAND_ASPD is in use then this value is not used during landing.
// @Description: Use this parameter instead of LAND_ASPD if your platform does not have an airspeed sensor. It is the cruise throttle during landing approach. If it is negative if TECS_LAND_ASPD is in use then this value is not used during landing.
// @Range: -1 to 100
// @Increment: 0.1
// @User: User
@ -213,13 +213,14 @@ void AP_TECS::_update_speed(void)
float EAS2TAS = _ahrs.get_EAS2TAS();
_TAS_dem = _EAS_dem * EAS2TAS;
if (_landAirspeed > -1 && _ahrs.airspeed_sensor_enabled() &&
_TASmax = aparm.airspeed_max * EAS2TAS;
_TASmin = aparm.airspeed_min * EAS2TAS;
if (_landAirspeed >= 0 && _ahrs.airspeed_sensor_enabled() &&
(_flight_stage == FLIGHT_LAND_APPROACH || _flight_stage== FLIGHT_LAND_FINAL)) {
_TASmax = _landAirspeed * EAS2TAS;
_TASmin = _landAirspeed * EAS2TAS;
} else { //not landing, or not using TECS_LAND_ASPD parameter
_TASmax = aparm.airspeed_max * EAS2TAS;
_TASmin = aparm.airspeed_min * EAS2TAS;
_TAS_dem = _landAirspeed * EAS2TAS;
if (_TASmin > _TAS_dem) {
_TASmin = _TAS_dem;
}
}
// Reset states of time since last update is too large
@ -455,7 +456,7 @@ void AP_TECS::_update_throttle_option(int16_t throttle_nudge)
//If landing and we don't have an airspeed sensor and we have a non-zero
//TECS_LAND_THR param then use it
if ((_flight_stage == FLIGHT_LAND_APPROACH || _flight_stage== FLIGHT_LAND_FINAL) &&
_landThrottle > -1) {
_landThrottle >= 0) {
nomThr = (_landThrottle + throttle_nudge) * 0.01f;
} else { //not landing or not using TECS_LAND_THR parameter
nomThr = (aparm.throttle_cruise + throttle_nudge)* 0.01f;

3
libraries/AP_TECS/AP_TECS.h
View File

@ -66,6 +66,9 @@ public:
// log data on internal state of the controller. Called at 10Hz
void log_data(DataFlash_Class &dataflash, uint8_t msgid);
// return current target airspeed
float get_target_airspeed(void) const { return _TAS_dem / _ahrs.get_EAS2TAS(); }
// this supports the TECS_* user settable parameters
static const struct AP_Param::GroupInfo var_info[];