Browse Source

failure_detector: allow disabling attitude failure (as already documented)

main
Beat Küng 3 years ago
parent
commit
82eb71d70b
  1. 4
      src/modules/commander/failure_detector/FailureDetector.cpp
  2. 4
      src/modules/commander/failure_detector/failure_detector_params.c

4
src/modules/commander/failure_detector/FailureDetector.cpp

@ -221,8 +221,8 @@ void FailureDetector::updateAttitudeStatus() @@ -221,8 +221,8 @@ void FailureDetector::updateAttitudeStatus()
const float max_roll(fabsf(math::radians(max_roll_deg)));
const float max_pitch(fabsf(math::radians(max_pitch_deg)));
const bool roll_status = (max_roll > 0.0f) && (fabsf(roll) > max_roll);
const bool pitch_status = (max_pitch > 0.0f) && (fabsf(pitch) > max_pitch);
const bool roll_status = (max_roll > FLT_EPSILON) && (fabsf(roll) > max_roll);
const bool pitch_status = (max_pitch > FLT_EPSILON) && (fabsf(pitch) > max_pitch);
hrt_abstime time_now = hrt_absolute_time();

4
src/modules/commander/failure_detector/failure_detector_params.c

@ -53,7 +53,7 @@ @@ -53,7 +53,7 @@
*
* Setting this parameter to 0 disables the check
*
* @min 60
* @min 0
* @max 180
* @unit deg
* @group Failure Detector
@ -71,7 +71,7 @@ PARAM_DEFINE_INT32(FD_FAIL_R, 60); @@ -71,7 +71,7 @@ PARAM_DEFINE_INT32(FD_FAIL_R, 60);
*
* Setting this parameter to 0 disables the check
*
* @min 60
* @min 0
* @max 180
* @unit deg
* @group Failure Detector

Loading…
Cancel
Save