mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-06-07 17:35:22 +08:00
land_detector: set max height to 100
This commit is contained in:
committed by
Lorenz Meier
parent
6939583650
commit
7f54f891c1
@@ -127,12 +127,10 @@ void LandDetector::_cycle()
|
||||
float alt_max_prev = _altitude_max;
|
||||
_altitude_max = _get_max_altitude();
|
||||
|
||||
|
||||
bool freefallDetected = (_state == LandDetectionState::FREEFALL);
|
||||
bool landDetected = (_state == LandDetectionState::LANDED);
|
||||
bool ground_contactDetected = (_state == LandDetectionState::GROUND_CONTACT);
|
||||
|
||||
|
||||
// Only publish very first time or when the result has changed.
|
||||
if ((_landDetectedPub == nullptr) ||
|
||||
(_landDetected.freefall != freefallDetected) ||
|
||||
|
||||
@@ -288,7 +288,7 @@ float MulticopterLandDetector::_get_takeoff_throttle()
|
||||
|
||||
float MulticopterLandDetector::_get_max_altitude()
|
||||
{
|
||||
/* ToDo: add meaningful heights */
|
||||
/* ToDo: add a meaningful altitude */
|
||||
float valid_altitude_max = _params.altitude_max;
|
||||
|
||||
if (_battery.warning == battery_status_s::BATTERY_WARNING_LOW) {
|
||||
|
||||
@@ -224,4 +224,4 @@ PARAM_DEFINE_INT32(LND_FLIGHT_T_LO, 0);
|
||||
* @group Land Detector
|
||||
*
|
||||
*/
|
||||
PARAM_DEFINE_FLOAT(LNDMC_ALT_MAX, 15.0f);
|
||||
PARAM_DEFINE_FLOAT(LNDMC_ALT_MAX, 100.0f);
|
||||
|
||||
@@ -922,7 +922,6 @@ MulticopterPositionControl::reset_alt_sp()
|
||||
void
|
||||
MulticopterPositionControl::limit_altitude()
|
||||
{
|
||||
|
||||
/* in altitude control, limit setpoint */
|
||||
if (_run_alt_control && _pos_sp(2) <= -_vehicle_land_detected.alt_max) {
|
||||
_pos_sp(2) = -_vehicle_land_detected.alt_max;
|
||||
|
||||
Reference in New Issue
Block a user