Mirrors_Framework/ardupilot
1
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot.git synced 2026-10-06 19:00:27 +08:00
Code Issues Packages Projects Releases Wiki Activity

Copter: constify some ModeThrow methods

Browse Source
This commit is contained in:
Peter Barker
2021-07-14 16:38:36 +09:00
committed by Randy Mackay
parent 53e980bada
commit 21f8ff4a4e
2 changed files with 6 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files
ArduCopter/mode.h
+3 -3
View File
@@ -1465,9 +1465,9 @@ protected:
private:
bool throw_detected();
bool throw_position_good();
bool throw_height_good();
bool throw_attitude_good();
bool throw_position_good() const;
bool throw_height_good() const;
bool throw_attitude_good() const;
// Throw stages
enum ThrowModeStage {
ArduCopter/mode_throw.cpp
+3 -3
View File
@@ -276,20 +276,20 @@ bool ModeThrow::throw_detected()
return throw_condition_confirmed;
}
bool ModeThrow::throw_attitude_good()
bool ModeThrow::throw_attitude_good() const
{
// Check that we have uprighted the copter
const Matrix3f &rotMat = ahrs.get_rotation_body_to_ned();
return (rotMat.c.z > 0.866f); // is_upright
}
bool ModeThrow::throw_height_good()
bool ModeThrow::throw_height_good() const
{
// Check that we are within 0.5m of the demanded height
return (pos_control->get_pos_error_z_cm() < 50.0f);
}
bool ModeThrow::throw_position_good()
bool ModeThrow::throw_position_good() const
{
// check that our horizontal position error is within 50cm
return (pos_control->get_pos_error_xy_cm() < 50.0f);