Commit Graph

48339 Commits

Author SHA1 Message Date
Paul Riseborough 3da71c5de5 Copter: rework ekf_check to use the EKF vibration_affected status 2021-07-23 10:19:50 +09:00
Paul Riseborough edd75e3981 AP_NavEKF3: Increase lower state variance limit when vibration affected
This makes state corrections from GPS and baro observations more aggressive
2021-07-23 10:19:50 +09:00
Paul Riseborough 6166b666b6 AP_NavEKF3: Use sensor variance when checking for bad IMU 2021-07-23 10:19:50 +09:00
Paul Riseborough 835b97f5e8 AP_NavEKF3: Make bad IMU status more persistent 2021-07-23 10:19:50 +09:00
Paul Riseborough 3ce5633701 AP_AHRS: Add accessor function for vibration affected status
AP_AHRS: fix rebase build error
2021-07-23 10:19:50 +09:00
Paul Riseborough a220ca20a6 AP_NavEKF3: Add accessor function for vibration affected status 2021-07-23 10:19:50 +09:00
Paul Riseborough e7ff7f629d AP_NavEKF3: Don't update accel bias states if vibration affected 2021-07-23 10:19:50 +09:00
Paul Riseborough 82f585a515 AP_NavEKF3: Use large accel process noise when IMU data is bad 2021-07-23 10:19:50 +09:00
Paul Riseborough 7b40e89463 AP_NavEKF3: Adjust gyro bias process noise tuning
NEw value is a compromise between roll/pitch angle and horizontal state velocity estimation errors and the noise in the gyro bias estimate
2021-07-23 10:19:50 +09:00
Paul Riseborough b6bbaed0db Tools: relax navigation test accuracy 2021-07-23 10:19:50 +09:00
Paul Riseborough 082f8e42f6 AP_NavEKF3: Allow smaller dvel bias state variances for improved tuning 2021-07-23 10:19:50 +09:00
Paul Riseborough 315d9ef9d8 AP_NavEKF3: Retune IMU process noise
Required to achieve equivalent fusion noise and weighting on IMU vs other sources to previous param defaults with the old covariance prediction equations.
2021-07-23 10:19:50 +09:00
Paul Riseborough e13e888c31 Tools: Fix AIRSPEED_AUTOCAL test failure
The mission plan for this test causes a lot of overshoot when turning onto final approach with the result that there is still some lateral offset when passing the landing waypoint that is not a measure of estimator accuracy.
2021-07-23 10:19:50 +09:00
Paul Riseborough 344f2d0eb7 AP_NavEKF3: Make gyro bias learning less noisy 2021-07-23 10:19:50 +09:00
Paul Riseborough fcf7a7c8f7 AP_NavEKF3: Fix bug preventing learning of XY IMU dvel bias in flight 2021-07-23 10:19:49 +09:00
Paul Riseborough 4096e75b15 AP_NavEKF3: Change powf(x,2) to sq(x) 2021-07-23 10:19:49 +09:00
Paul Riseborough 5cb4cf870d AP_NavEKF3: Update covariance prediction equations 2021-07-23 10:19:49 +09:00
Paul Riseborough 14edac7e5c AP_NavEKF3: Use alternate form for quaternion to rotmat equations in derivation 2021-07-23 10:19:49 +09:00
Peter Barker a298480207 Tools: split yaw-vehicle-for-mount-roi test out 2021-07-23 10:19:49 +09:00
Andrew Tridgell c2e221dd09 AP_Math: fix uses of single precision 2021-07-23 10:19:49 +09:00
Randy Mackay e4684f65dc AR_WPNav: integrate PathPlanner returning path_planner_used
Rover does not need to handle the results differently based on the planner used
2021-07-23 10:19:49 +09:00
Randy Mackay 0c9fbf9456 AC_WPNav_OA: minor formatting and comment fixes 2021-07-23 10:19:49 +09:00
Randy Mackay b95c6b5e5d AC_WPNav_OA: separate handlers for results from Dijkstra's and BendyRuler
also bendy ruler uses pos controller
2021-07-23 10:19:49 +09:00
Randy Mackay c991ff4318 AC_Avoidance: BendyRuler returned destination are shortened 2021-07-23 10:19:49 +09:00
Randy Mackay 075c05baea AC_Avoidance: bendy ruler format fixes 2021-07-23 10:19:49 +09:00
Randy Mackay 0b26bace7f AC_Avoidance: OA_PathPlanner returns which planner was used
this replaces get_bendy_type
2021-07-23 10:19:49 +09:00
Randy Mackay 980909deb5 AC_Avoidance: BendyRuler returns which type was used
also make serach_xxx_path methods private
2021-07-23 10:19:49 +09:00
Randy Mackay 400731df1b AP_Common: add Location::linear_interpolate_alt 2021-07-23 10:19:49 +09:00
Andy Piper 74a8891099 AP_BLHeli: ensure correct rotation through telemetry ESCs 2021-07-23 10:19:49 +09:00
Pierre Kancir 3cee86e63f AC_WPNav: remove unused variable following https://github.com/ArduPilot/ardupilot/pull/18076 2021-07-23 10:19:49 +09:00
Leonard Hall 6f5d2008e3 AC_PosControl: Add MAX(bla,0) because safe_sqrt isn't safe 2021-07-23 10:19:49 +09:00
Leonard Hall 2e314a00b2 Copter: Guided and Loiter mode returns Crosstrack error 2021-07-23 10:19:49 +09:00
Leonard Hall 6f26ca6b65 WP_Nav: Return Crosstrack error 2021-07-23 10:19:49 +09:00
Leonard Hall d6df47fd06 AC_AttitudeControl: AC_PosControl: calculate cross track 2021-07-23 10:19:49 +09:00
Randy Mackay fce7db0d18 AC_WPNav: use get_terrain_margin instead of constant 2021-07-23 10:19:49 +09:00
Andrew Tridgell 61b72cd50d Copter: replace use of TERRAIN_MARGIN with WPNAV_TER_MARGIN
# Conflicts:
#	ArduCopter/Parameters.cpp
#	ArduCopter/Parameters.h
#	ArduCopter/terrain.cpp
2021-07-23 10:19:49 +09:00
Randy Mackay 33ec14ce70 AC_WPNav: add TER_MARGIN param 2021-07-23 10:19:49 +09:00
Leonard Hall 767281dc76 AC_AttitudeControl: AC_PosControl: Auto Terain following update 2021-07-23 10:19:49 +09:00
Leonard Hall 4bbc69ef6e AC_WPNav: Auto Terain following update 2021-07-23 10:19:49 +09:00
Andrew Tridgell f3f1e72b0b Copter: Fix guided yaw bug.
# Conflicts:
#	ArduCopter/GCS_Mavlink.cpp
2021-07-23 10:19:48 +09:00
Peter Barker aa05bdde0f Copter: simplify throttle-is-unlimited check
Now not the same pattern as the other checks - but it is much shorter
2021-07-23 10:19:48 +09:00
Peter Barker e120b75aa4 Copter: wait for motors to spool up before trying to upright vehicle
This stops us from progressing through the whole throw mode if the
vehicle just happens to be in the right state - which is can be for a
drop.
2021-07-23 10:19:48 +09:00
Peter Barker b52ec7978b Copter: constify some ModeThrow methods 2021-07-23 10:19:48 +09:00
Andy Piper f2e22cf8e5 iomcu: update for pulse width changes 2021-07-23 10:19:48 +09:00
Andy Piper a9187a50cf AP_HAL_ChibiOS: only control widest pulse for dshot and oneshot 2021-07-23 10:19:48 +09:00
Tal Bass f4abb80aaf Copter: reset land_repo_active flag in RTL mode 2021-07-23 10:19:48 +09:00
Leonard Hall a765e266f4 AC_AttitudeControl: Allow yaw rate reset to be de-selected 2021-07-23 10:19:48 +09:00
Leonard Hall a066e1fcb1 Copter: Don't reset yaw rate when disarmed or ground idle in Heli Stab and Acro 2021-07-23 10:19:48 +09:00
Hwurzburg 4664ed6d7d RC_Channel: fix ELRS systems spamming CRSF mode/rate messages 2021-07-23 10:19:48 +09:00
Hwurzburg a09f38b195 AP_RCTelemetry: fix ELRS systems spamming CRSF mode/rate messages 2021-07-23 10:19:48 +09:00