Andrew Tridgell
6f5d3a0dfd
AP_AHRS: don't reject airspeed using EKF if dead-reckoning
...
when dead-reckoning the EKF wind estimate can diverge from reality,
leading to us rejecting a valid airspeed sensor. We are best off
trusting airspeed if we are dead-reckoning
2023-06-08 09:29:59 +10:00
Andrew Tridgell
f7be18755e
AP_AHRS: fixed earth frame accel for EKF3 with significant trim
2023-02-28 17:16:39 +11:00
Tom Pittenger
9ac0514e8e
AP_AHRS: move AP_NMEA_OUTPUT to a first class library
2023-02-07 21:12:07 +11:00
Peter Barker
7fa0b75d48
AP_AHRS: avoid using struct Location
...
clang reports this could be a problem when compiling under some EABIs. Remove it from most places as it is just noise, replace with class where we want to avoid including Location.h
2023-02-04 22:51:54 +11:00
Peter Barker
aa7ab28969
AP_AHRS: add a bool wind_estimate(...)
...
NavEKF3 can fail to return a wind estimate, and we lose that value
2023-01-18 11:20:32 +11:00
Peter Barker
d78ea08d24
AP_AHRS: move AP_AHRS_SIM::get_results into backend file
2023-01-17 10:49:56 +11:00
Peter Barker
c42754b691
AP_AHRS: create an AP_AHRS_SIM backend
2023-01-12 13:11:40 +11:00
Peter Barker
3854e4a99d
AP_AHRS: get_relative_position_D_home: don't use home until set
2023-01-04 18:11:01 +11:00
Iampete1
f933f148ed
AP_AHRS: always run external AHRS arming check if enabled
2023-01-03 10:32:20 +11:00
Andrew Tridgell
87b4b031bf
AP_AHRS: if DCM has no yaw source then don't fallback when hovering
...
this copes with quadplanes with no compass. With a compass we are
better off using EKF when not in fly-forward as it will give better
height control.
This makes QHOVER for takeoff in quadplanes with no compass a lot more
flyable
2022-12-20 10:34:22 +11:00
Andrew Tridgell
56c8cffc07
AP_AHRS: auto-enable EKF3 for misconfiguration
...
this fixes a "climb away" in quadplanes when AHRS_EKF_TYPE=2 and
EK2_ENABLE=0. The user has ARMING_CHECK=5390 to disable key arming
checks, and the plane flew on DCM as the configured EKF wasn't
enabled.
This resulted in AHRS::get_origin() returning false as it couldn't ask
EKF2 for the origin (as EKF2 was not enabled or instantiated)
The result was an incorrect calculation for target height during the
descent stage of QRTL, resulting in a climb away until the user took
over
2022-12-20 10:34:22 +11:00
Andrew Tridgell
81b519056b
AP_AHRS: implement timing jitter in SITL
...
make the AHRS update take a random amount of extra CPU time
2022-12-06 11:03:50 +11:00
Stephen Dade
5d3e636d71
AP_AHRS: Add support for fixed height optical flow
2022-12-01 08:03:47 +09:00
Peter Barker
141074d07a
AP_AHRS: use Vector3f.xy() to avoid creating a fresh Vector2f
2022-11-16 17:59:29 +11:00
Randy Mackay
f2ed41f5cf
AP_AHRS: pre-arm msg loses extra AHRS prefix
2022-10-21 08:07:39 +11:00
Paul Riseborough
6a328c5d3b
AP_AHRS: Add accessor function for airspeed health monitoring
2022-09-26 14:17:53 +10:00
Andrew Tridgell
f80ba734c8
AP_AHRS: removed use of "blended" accel values
...
calculate a single EF accel based on primary IMU
2022-08-21 18:51:59 +10:00
Andrew Tridgell
924759510d
AP_AHRS: fixed use of filtered gyro with DCM active
...
we need to overwrite _omega with the filtered gyro value, so we get
both the low pass filter and the notch filters. Otherwise we will fly
with very high noise gyro data
this also fixes the accel_ef_blended to use the filtered accel. It is
not blended, and removing "_blended" from the API will be worthwhile
as a followup
2022-08-21 18:51:59 +10:00
nrt
c3d8f0fa45
AP_AHRS: added a getter function to get active source set once the ekf3 filter is started
2022-08-18 02:05:27 -04:00
Peter Barker
cfb391dc2c
AP_AHRS: stop using GCS_MAVLINK.h in header files
...
... by passing through a reference to a link object instead
2022-08-16 09:45:51 +10:00
Henry Wurzburg
a5b373e912
AP_AHRS: modify AHRS type check for compass-less setups
2022-08-09 11:02:24 +10:00
Andrew Tridgell
0ededd7c62
AP_AHRS: use wind from simulation if available with EKF type 10
2022-08-02 07:49:34 +10:00
Peter Barker
4909866dd9
AP_AHRS: add prearm check that we are using configured AHRS type
2022-07-28 15:53:13 +10:00
Henry Wurzburg
51a21679be
AP_AHRS: expand description of custom orientation parameters
2022-07-21 15:45:28 +01:00
Peter Barker
5a1d4f3bf5
AP_AHRS: update rotation based on board_orient parameter
2022-06-12 17:32:11 +10:00
Andrew Tridgell
5a1a87cc60
AP_AHRS: fixed bug in blended EKF bias
...
The bug fix in #20431 was incomplete, and ended up with the wrong
blended accel bias. This fixes it
2022-05-04 06:49:34 +10:00
Iampete1
6c24a5ff37
AP_AHRS: add method to get view
2022-04-26 10:03:30 +10:00
Peter Barker
c1c18331f9
AP_AHRS: remove instance id from EK2 external interface
...
Removes passing of instance id in interfaces where -1 was the only value
ever passed in
2022-04-12 10:25:29 +10:00
Peter Barker
b762aac6ce
AP_AHRS: remove instance id from EK3 external interface
...
Removes passing of instance id in interfaces where -1 was the only value
ever passed in
2022-04-06 17:36:05 +10:00
Peter Barker
fd666dc4f1
AP_AHRS: subtract accel bias from correct ins accel instance
...
In the case that you have INS_USE indicating IMUs should be used, but
EK3_IMU_MASK leaving some IMUs unused, we subtract the bias from the
wrong INS data
2022-04-03 11:41:09 +10:00
Peter Barker
7ad9609fb7
AP_AHRS: split AP_HAL_SITL and HAL_SIM_ENABLED
2022-03-17 14:39:55 +11:00
Peter Barker
4896f8a6d7
AP_AHRS: rename SITL backend to SIM
2022-03-17 14:39:55 +11:00
Iampete1
480cc3fa46
AP_AHRS: convert param to new custom rotation
2022-03-02 18:16:42 +11:00
Iampete1
1cc2e082e0
AP_AHRS: remove custom rotations
2022-03-02 18:16:42 +11:00
Peter Barker
24099f9a2d
AP_AHRS: include cleanups
2022-03-01 11:21:33 +11:00
Andrew Tridgell
01ac314837
AP_AHRS: use EKF rejecting_airspeed flag
...
stop using airspeed sensor when EKF is rejecting the sensor
2022-02-07 14:13:49 +11:00
RuffaloVM
bb1bd69172
AP_AHRS : remove duplicated words from comments
2022-02-04 08:36:35 +00:00
Randy Mackay
9126e14c9c
AP_AHRS: getOptFlowSample returns latest correct flow data for use in calibration
2022-01-29 08:26:12 +09:00
Peter Barker
bd069cc5e9
AP_AHRS: move logging of SIMSTATE, AHRS2 and POS into AP_AHRS library
2022-01-25 10:59:17 +11:00
Peter Barker
ff63b62b0c
AP_AHRS: rename AP_AHRS::get_position to get_location
2022-01-25 10:47:22 +11:00
Peter Barker
a6099acd5c
AP_AHRS: return failure in pre_arm_check if unhealthy
2022-01-19 18:33:07 +11:00
Joshua Henderson
8a6942a9df
AP_AHRS: add define AP_AIRSPEED_ENABLED
2022-01-19 18:21:32 +11:00
Peter Barker
a31ff08f23
AP_AHRS: create and use AP_AHRS_SIM_ENABLED
2022-01-17 19:12:56 +11:00
Andrew Tridgell
304b7df8c2
AP_AHRS: make the EKF accel bias accessible
...
needed for fixed wing yaw damper
2021-12-07 17:05:54 +11:00
Andrew Tridgell
0141ec5be7
AP_AHRS: fixed switching airspeed sensor based on EKF3 affinity
...
we need to use the EKF selected airspeed sensor when the EKF is setup
to run a different sensor on each lane
2021-11-24 13:52:13 +11:00
Andrew Tridgell
01fb16b3b0
AP_AHRS: relax arming checks for inactive AHRS types
...
When using an EKF as ride-along we should not fail arming if it has
inconsistent yaw between its lanes. This is especially important when
using external yaw or GPS yaw with EKF3, where yaw is expected to be
bad with EKF2.
The check on DCM is based on the existance of an AHRS view. This is so
that tailsitters do not get arming failures due to the inability of
DCM to cope with being nose up
2021-11-04 17:44:29 +11:00
Andrew Tridgell
bdf903b862
AP_AHRS: add accessor for GSF yaw estimator
2021-11-01 09:00:27 +11:00
Andy Piper
e1dd0fd70d
AP_AHRS: convert APM_BUILD_COPTER_OR_HELI() to APM_BUILD_COPTER_OR_HELI
2021-10-26 11:42:12 +11:00
Peter Barker
44d56854be
AP_AHRS: make AP_AHRS_DCM an AP_AHRS backend
2021-10-06 19:10:36 +11:00
Hwurzburg
873097c030
AP_AHRS: Change orientation labels to march order of rotation
2021-10-05 11:21:48 +11:00