fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-03 10:01:36 +08:00
Code Issues Packages Projects Releases Wiki Activity

replace camel case by snake case.

Browse Source 
Co-Authored-By: EliaTarasov <elias.tarasov@gmail.com>
This commit is contained in:
Matthias Grob
2019-03-21 10:07:12 +01:00
committed by Roman Bapst
co-authored by EliaTarasov
parent 84d9820baa
commit aa36fa2dfd
3 changed files with 22 additions and 20 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/ekf2/ekf2_main.cpp
+3 -1
View File
@@ -1253,10 +1253,12 @@ void Ekf2::run()
if (vehicle_land_detected_updated) { if (vehicle_land_detected_updated) {
if (orb_copy(ORB_ID(vehicle_land_detected), _vehicle_land_detected_sub, &vehicle_land_detected) == PX4_OK) { if (orb_copy(ORB_ID(vehicle_land_detected), _vehicle_land_detected_sub, &vehicle_land_detected) == PX4_OK) {
_ekf.set_in_air_status(!vehicle_land_detected.landed); _ekf.set_in_air_status(!vehicle_land_detected.landed);
if(_gnd_effect_deadzone.get() > 0.0f)
if (_gnd_effect_deadzone.get() > 0.0f) {
_ekf.set_gnd_effect_flag(vehicle_land_detected.in_ground_effect); _ekf.set_gnd_effect_flag(vehicle_land_detected.in_ground_effect);
} }
} }
}
// use the landing target pose estimate as another source of velocity data // use the landing target pose estimate as another source of velocity data
bool landing_target_pose_updated = false; bool landing_target_pose_updated = false;
src/modules/land_detector/MulticopterLandDetector.cpp
+3 -3
View File
@@ -179,7 +179,7 @@ bool MulticopterLandDetector::_get_ground_contact_state()
} }
// Check if we are moving horizontally. // Check if we are moving horizontally.
_horizontalMovement = sqrtf(_vehicleLocalPosition.vx * _vehicleLocalPosition.vx _horizontal_movement = sqrtf(_vehicleLocalPosition.vx * _vehicleLocalPosition.vx
+ _vehicleLocalPosition.vy * _vehicleLocalPosition.vy) > _params.maxVelocity; + _vehicleLocalPosition.vy * _vehicleLocalPosition.vy) > _params.maxVelocity;
// if we have a valid velocity setpoint and the vehicle is demanded to go down but no vertical movement present, // if we have a valid velocity setpoint and the vehicle is demanded to go down but no vertical movement present,
@@ -189,7 +189,7 @@ bool MulticopterLandDetector::_get_ground_contact_state()
bool hit_ground = _in_descend && !verticalMovement; bool hit_ground = _in_descend && !verticalMovement;
// TODO: we need an accelerometer based check for vertical movement for flying without GPS // TODO: we need an accelerometer based check for vertical movement for flying without GPS
if ((_has_low_thrust() || hit_ground) && (!_horizontalMovement || !_has_position_lock()) if ((_has_low_thrust() || hit_ground) && (!_horizontal_movement || !_has_position_lock())
&& (!verticalMovement || !_has_altitude_lock())) { && (!verticalMovement || !_has_altitude_lock())) {
return true; return true;
} }
@@ -336,7 +336,7 @@ bool MulticopterLandDetector::_has_minimal_thrust()
bool MulticopterLandDetector::_get_ground_effect_state() bool MulticopterLandDetector::_get_ground_effect_state()
{ {
if (_in_descend && !_horizontalMovement) { if (_in_descend && !_horizontal_movement) {
return true; return true;
} else { } else {
src/modules/land_detector/MulticopterLandDetector.h
+1 -1
View File
@@ -142,7 +142,7 @@ private:
hrt_abstime _landed_time{0}; hrt_abstime _landed_time{0};
bool _in_descend{false}; ///< vehicle is desending bool _in_descend{false}; ///< vehicle is desending
bool _horizontalMovement{false}; ///< vehicle is moving horizontally bool _horizontal_movement{false}; ///< vehicle is moving horizontally
/* get control mode dependent pilot throttle threshold with which we should quit landed state and take off */ /* get control mode dependent pilot throttle threshold with which we should quit landed state and take off */
float _get_takeoff_throttle(); float _get_takeoff_throttle();