From a4826998a30f9d1e10fe1361791801c7f0ba8c20 Mon Sep 17 00:00:00 2001 From: Silvan Fuhrer Date: Tue, 10 Jan 2023 11:13:00 +0100 Subject: [PATCH] Land detector docs sync (#2233) * land detector docs: sync FW parameters and logic Signed-off-by: Silvan Fuhrer * sync MC land detection docs with PX4 logic Signed-off-by: Silvan Fuhrer * move all MC land detector info into same block Signed-off-by: Silvan Fuhrer * land detector: add small section for VTOL Signed-off-by: Silvan Fuhrer * Apply suggestions from code review * Update en/advanced_config/land_detector.md * fix link to states section * Update en/advanced_config/land_detector.md Co-authored-by: Matthias Grob * Update en/advanced_config/land_detector.md Co-authored-by: Matthias Grob Signed-off-by: Silvan Fuhrer Co-authored-by: Hamish Willee Co-authored-by: Matthias Grob --- en/advanced_config/land_detector.md | 64 +++++++++++++++++------------ 1 file changed, 38 insertions(+), 26 deletions(-) diff --git a/en/advanced_config/land_detector.md b/en/advanced_config/land_detector.md index ff6dadffbbe6..b24c4fd5f2a1 100644 --- a/en/advanced_config/land_detector.md +++ b/en/advanced_config/land_detector.md @@ -14,7 +14,7 @@ You can set [COM_DISARM_LAND](../advanced_config/parameter_reference.md#COM_DISA The complete set of relevant landing detector parameters are listed in the parameter reference with the prefix [LNDMC](../advanced_config/parameter_reference.md#land-detector) (these can be edited in QGroundControl via the [parameter editor](../advanced_config/parameters.md)). :::tip -Information about how the parameters affect landing can be found below in [Land Detector States](#states). +Information about how the parameters affect landing can be found below in [Land Detector States](#mc-land-detector-states). ::: Other key parameters that you may need to tune in order to improve landing behaviour on particular airframes are: @@ -30,40 +30,29 @@ Other key parameters that you may need to tune in order to improve landing behav * [MPC_THR_MIN](../advanced_config/parameter_reference.md#MPC_THR_MIN) - the overall minimum throttle of the system. This should be set to enable a controlled descent. +* [MPC_LAND_CRWL](../advanced_config/parameter_reference.md#MPC_LAND_CRWL) - the vertical speed applied in the last stage of autonomous landing if the system has a distance sensor and it is present and working. Has to be set larger than LNDMC_Z_VEL_MAX. -## Fixed Wing Configuration - -The complete set of relevant parameters is available under the [LNDFW](../advanced_config/parameter_reference.md#land-detector) prefix. -These two parameters are sometimes worth tuning: - -* [LNDFW_AIRSPD_MAX](../advanced_config/parameter_reference.md#LNDFW_AIRSPD_MAX) - the maximum airspeed allowed for the system still to be considered landed. - The default of 8 m/s is a reliable tradeoff between airspeed sensing accuracy and triggering fast enough. - Better airspeed sensors should allow lower values of this parameter. -* [LNDFW_VEL_XY_MAX ](../advanced_config/parameter_reference.md#LNDFW_VEL_XY_MAX) - the maximum horizontal velocity for the system to be still be considered landed. -* [LNDFW_VEL_Z_MAX](../advanced_config/parameter_reference.md#LNDFW_VEL_XY_MAX) - the maximum vertical velocity for the system to be still be considered landed. - This parameter can be adjusted to ensure land detection triggers earlier or later on throwing the airframe for hand-launches. - - - -## Land Detector States - -### Multicopter Land Detection +### MC Land Detector States In order to detect landing, the multicopter first has to go through three different states, where each state contains the conditions from the previous states plus tighter constraints. If a condition cannot be reached because of missing sensors, then the condition is true by default. For instance, in [Acro mode](../flight_modes/acro_mc.md) and no sensor is active except for the gyro sensor, then the detection solely relies on thrust output and time. -In order to proceed to the next state, each condition has to be true for some predefined time. -If one condition fails, the land detector drops out of the current state immediately. +In order to proceed to the next state, each condition has to be true for a third of the configured total land detector trigger time [LNDMC_TRIG_TIME](../advanced_config/parameter_reference.md#LNDMC_TRIG_TIME). +If the vehicle is equipped with a distance sensor, but the distance to ground is currently not measurable (usually because it is too large), the trigger time is increased by a factor of 3. + +If one condition fails, the land detector drops out of the current state immediately. #### Ground Contact -This state is reached if following conditions are true for 0.35 seconds: +Conditions for this state: - no vertical movement ([LNDMC_Z_VEL_MAX](../advanced_config/parameter_reference.md#LNDMC_Z_VEL_MAX)) - no horizontal movement ([LNDMC_XY_VEL_MAX](../advanced_config/parameter_reference.md#LNDMC_XY_VEL_MAX)) -- lower thrust than [MPC_THR_MIN](../advanced_config/parameter_reference.md#MPC_THR_MIN) + ([MPC_THR_HOVER](../advanced_config/parameter_reference.md#MPC_THR_HOVER) - [MPC_THR_MIN](../advanced_config/parameter_reference.md#MPC_THR_MIN)) * (0.3, unless a hover thrust estimate is available, then 0.6), or velocity setpoint is 0.9 of land speed but vehicle has no vertical movement. +- lower thrust than [MPC_THR_MIN](../advanced_config/parameter_reference.md#MPC_THR_MIN) + (hover throttle - [MPC_THR_MIN](../advanced_config/parameter_reference.md#MPC_THR_MIN)) * (0.3, unless a hover thrust estimate is available, then 0.6), +- additional check if vehicle is currently in a height-rate controlled flight mode: the vehicle has to have the intent to descend (vertical velocity setpoint above LNDMC_Z_VEL_MAX). +- additional check for vehicles with a distance sensor: current distance to ground is below 1m. If the vehicle is in position- or velocity-control and ground contact was detected, the position controller will set the thrust vector along the body x-y-axis to zero. @@ -71,11 +60,12 @@ the position controller will set the thrust vector along the body x-y-axis to ze #### Maybe Landed -This state is reached if following conditions are true for 0.25 seconds: +Conditions for this state: -- all conditions of ground contact are true +- all conditions of the [ground contact](#ground-contact) state are true - is not rotating ([LNDMC_ROT_MAX](../advanced_config/parameter_reference.md#LNDMC_ROT_MAX)) - has low thrust `MPC_THR_MIN + (MPC_THR_HOVER - MPC_THR_MIN) * 0.1` +- no freefall detected If the vehicle only has knowledge of thrust and angular rate, in order to proceed to the next state the vehicle has to have low thrust and no rotation for 8.0 seconds. @@ -86,5 +76,27 @@ the position controller will set the thrust vector to zero. #### Landed -This state is reached if following conditions are true for 0.3 seconds: -- all conditions of maybe landed are true +Conditions for this state: +- all conditions of the [maybe landed](#maybe-landed) state are true + + +## Fixed-wing Configuration + +Tuning parameters for fixed-wing land detection: + +* [LNDFW_AIRSPD_MAX](../advanced_config/parameter_reference.md#LNDFW_AIRSPD_MAX) - the maximum airspeed allowed for the system still to be considered landed. + Has to be a tradeoff between airspeed sensing accuracy and triggering fast enough. + Better airspeed sensors should allow lower values of this parameter. +* [LNDFW_VEL_XY_MAX ](../advanced_config/parameter_reference.md#LNDFW_VEL_XY_MAX) - the maximum horizontal velocity for the system to be still be considered landed. +* [LNDFW_VEL_Z_MAX](../advanced_config/parameter_reference.md#LNDFW_VEL_XY_MAX) - the maximum vertical velocity for the system to be still be considered landed. +* [LNDFW_XYACC_MAX](../advanced_config/parameter_reference.md#LNDFW_XYACC_MAX) - the maximal horizontal acceleration for the system to still be considered landed. +* [LNDFW_TRIG_TIME](../advanced_config/parameter_reference.md#LNDFW_TRIG_TIME) - Trigger time during which the conditions above have to be fulfilled to declare a landing. + +:::note +When FW launch detection is enabled ([FW_LAUN_DETCN_ON](../advanced_config/parameter_reference.md#FW_LAUN_DETCN_ON)), the vehicle will stay in "landed" state until takeoff is detected (which is purely based on acceleration and not velocity). +::: + + +## VTOL Land Detector + +The VTOL land detector is 1:1 the same as the MC land detector if the system is in hover mode. In FW mode, land detection is disabled.