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
Peter Barker
5ed0451f8b
AP_AHRS: include required AP_Vehicle_Type header
2022-11-02 18:35:48 +11:00
Randy Mackay
f2ed41f5cf
AP_AHRS: pre-arm msg loses extra AHRS prefix
2022-10-21 08:07:39 +11:00
Andrew Tridgell
d398e567a3
AP_AHRS: added ATSC logging
...
log scale factors for angle P scaling when not == 1.0
2022-10-18 07:38:39 +11:00
jackhong12
4a4f361a17
all: use CLASS_NO_COPY() macro
2022-10-04 11:23:04 +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
4139b7a548
AP_AHRS: rename OpticalFlow class to AP_OpticalFlow
...
Brings us in-line with other classes in ArduPilot.
Removes ambiguity with AP_HAL::OpticalFlow which can cause compilation errors as we start to make code more portable across targets
2022-08-18 14:24:01 +10: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
Iampete1
d423f483a6
AP_AHRS: params always use set method
2022-08-03 13:43:48 +01: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
aeb24d4978
AP_AHRS: remove method casting active EKF type for logging
...
logging is now done internally
2022-07-29 11:05:19 +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
Bailey K. Srimoungchanh
b6a089f90e
AP_AHRS: Fixed body_to_earth
...
body_to_earth was not implemented consistently with earth_to_body.
Changed the order of operation to be consistent and rotate reference
frame correctly.
2022-07-22 09:11:17 +10:00
Henry Wurzburg
51a21679be
AP_AHRS: expand description of custom orientation parameters
2022-07-21 15:45:28 +01:00
Iampete1
dc0491a8ff
AP_AHRS_view: add rotate method to move from AHRS to AHRS view referance frames
2022-06-21 10:01:30 +10: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
Peter Barker
34a7503c1e
AP_AHRS: tidy includes
2022-05-03 09:14:58 +10:00
Iampete1
d621910a59
AP_AHRS: remove unneeded get_position wrapper
2022-04-26 10:28:28 +10:00
Iampete1
6c24a5ff37
AP_AHRS: add method to get view
2022-04-26 10:03:30 +10:00
Iampete1
04fdfea74a
AP_AHRS_View: add method to get pitch trim and note on rotation
2022-04-26 10:03:30 +10:00
Joshua Henderson
7cc2382a78
AP_AHRS_DCM: NFC comment on check_matrix() normalization reset
2022-04-19 09:27:00 +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
Peter Barker
9229fb6f9d
AP_AHRS: add alias get_position to get_location
2022-02-18 21:23:06 +11:00
Iampete1
e56b6d2765
AP_AHRS: View: get_gyro_latest should include pitch trim.
2022-02-15 11:08:05 +11:00
Peter Barker
f72024fc63
AP_AHRS: move logging of LogEvent::SET_HOME up
2022-02-08 11:04:26 +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
murata
819b25d918
AP_AHRS: remove duplicated words from comments
2022-02-07 08:24:14 +09:00
RuffaloVM
bb1bd69172
AP_AHRS : remove duplicated words from comments
2022-02-04 08:36:35 +00:00
Peter Barker
5528159f31
AP_AHRS: add WARN_IF_UNUSED to several methods
2022-02-02 19:32:47 +11: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
Iampete1
efb04e7f30
AP_AHRS: add video stab log message
2022-01-05 19:56:03 +11:00
Iampete1
cee0503812
AP_Logger: add video stab log structure
2022-01-05 19:56:03 +11:00
Iampete1
9cace37b03
AHRS: RATE log: add missing ff terms
2021-12-14 10:14:28 +09:00
Peter Barker
69f4b25f81
AP_AHRS: mark type column in ORGN as instance
2021-12-08 08:31:21 +09: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
Peter Barker
66d8be825f
AP_Logger: move LogOriginType into AP_AHRS
...
only used to log the origins by the AHRS library
2021-12-07 11:31:44 +11:00
Peter Barker
1dd34d87e7
AP_AHRS: move LogOriginType into AP_AHRS
...
only used to log the origins by the AHRS library
2021-12-07 11:31:44 +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
43e83f18be
AP_AHRS: do not send EKF_STATUS_REPORT from DCM
...
This means that even if you configure DCM as your primary you won't get
its status.
Given the status was currently garbage, this isn't necessarily a bad
thing at the moment.
2021-10-06 19:10:36 +11:00
Peter Barker
2f69dcc085
AP_AHRS: cache some trig results for yaw in DCM backend
2021-10-06 19:10:36 +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
Gone4Dirt
94b97313be
AP_AHRS: Add APM_BUILD_Heli
2021-09-29 19:55:48 +10:00
Andrew Tridgell
3715ce6d1a
AP_AHRS: allow setting of AHRS_TRIM_Z
2021-09-17 14:07:14 +10:00
Andrew Tridgell
3f043dd933
AP_AHRS: added get_view_rotation()
2021-09-17 14:07:14 +10:00
Josh Henderson
38ead58df2
AP_AHRS: use vector.xy().length() instead of norm(x,y)
2021-09-14 10:43:46 +10:00
Peter Barker
29d2eed9e4
Sub: view update does not take skip_ins_update
2021-08-31 14:28:53 +10:00
Peter Barker
9dbd9d1e06
AP_AHRS: call INS update in AP_AHRS::update w/o holding data sem
...
We shouldn't be holding the data semaphore while waiting for the samples
- lots of things might be unnecessarily blocked
DCM's update function doesn't need to take the semaphore as it is
already taken by AP_AHRS
2021-08-31 14:28:53 +10:00
Peter Barker
cc514af158
AP_AHRS: eliminate AP::ahrs().get_location
2021-08-31 09:47:31 +10:00
Randy Mackay
1c08866342
AP_AHRS: add using_extnav_for_yaw
2021-08-31 09:20:17 +10:00
Randy Mackay
e7be608a4a
AP_AHRS: rename is_ext_nav_used_for_yaw to using_noncompass_for_yaw
2021-08-31 09:20:17 +10:00
Peter Barker
0792caab83
AP_AHRS: factor out an update_notify_from_filter_status
2021-08-28 23:11:09 +10:00
Peter Barker
ca6d214bb3
AP_AHRS: remove unused getGpsGlitchStatus method
2021-08-28 19:46:13 +10:00
Peter Barker
9114d4fc86
AP_AHRS: make home-relative functions AHRS-frontend only
2021-08-25 18:32:07 +10:00
Peter Barker
e8066aa993
AP_AHRS: constrain airspeed sensor airspeed using WIND_MAX
...
fixes regression from d1d790019c
2021-08-25 18:28:12 +10:00
Peter Barker
a933652950
AP_AHRS: return perfect airspeed estimate for EKF-type 10
...
... rather than the EKF3 estimate
2021-08-25 18:28:12 +10:00
Peter Barker
e2722c8e12
AP_AHRS: move active_accel_instance into DCM private header section
2021-08-24 10:23:36 +10:00
Peter Barker
d6c7c59199
AP_AHRS: remove custom_rotation matrix to frontend
...
Only one of these per vehicle
2021-08-24 10:23:36 +10:00
Peter Barker
645a5302d0
AP_AHRS: move DCM parameters into DCM header
2021-08-24 10:23:36 +10:00
Peter Barker
74709c6292
AP_AHRS: move groundspeed vector up to AP_AHRS_DCM
...
The other estimators all have their own implementation of this
2021-08-24 10:23:36 +10:00
Peter Barker
8169910866
AP_AHRS: move frontend parameters up / DCM parameters down
2021-08-24 10:23:36 +10:00
Andrew Tridgell
53e7436525
AP_AHRS: allow for fallback to DCM in quadplanes
...
this adds the necessary functions to allow for flying a quadplane on
DCM as an emergency fallback. It sets the NavGainScalar to 0.5 to
reduce the VTOL controller gains to allow planes to cope with the
higher lag of DCM
2021-08-19 14:42:28 +10:00
Peter Barker
5d49d29c27
AP_AHRS: move wind-estimation-enabled state to frontend
2021-08-18 18:37:39 +10:00
Peter Barker
8daa0a099c
AP_AHRS: rename yaw_initialised access method to dcm_yaw_initialised
...
This is what it really means.
Also put the relevant state within the DCM object
2021-08-18 18:37:39 +10:00
Peter Barker
608608f32f
AP_AHRS: internalise application of correct_centrifugal
...
This is a DCM-only option but that's not clear with the interface.
Internalise the variable and base it off build type.
2021-08-17 10:36:46 +10:00
Peter Barker
1cfd9f57ce
AP_AHRS: move VehicleClass handling to AHRS frontend
...
.... and renaming the enumeration while we're at it
2021-08-17 10:34:07 +10:00
Peter Barker
29aed55a74
AP_AHRS: remove pointless zeroing of gyro_estimate vector
...
This value is assigned to in the following "if" block in both the for
and against cases, and isn't used to determine the new value.
2021-08-12 08:52:24 +10:00
Peter Barker
73bad9fd2d
AP_AHRS: move fly_forward flag to front end
...
This same flag is requested by the DAL so AN_NavEKF2 and AP_NavEKF3 can
use it in their estimates - so AP_AHRS_DCM accessing it via the same
mechanism is not out-of-shape
2021-08-11 15:36:22 -07:00
Peter Barker
e9c56a2b0a
AP_AHRS: move takeoff/touchdown flags to frontend
2021-08-11 18:45:34 +10:00
Peter Barker
ecd488b3c3
AP_AHRS: move trim-related functionality to front end
2021-08-10 09:41:19 +10:00
Peter Barker
7f4a4a99d6
AP_AHRS: move home and origin methods to frontend
2021-08-05 10:37:47 +10:00
bugobliterator
62b6350af1
AP_AHRS: use typename SIM instead of SITL as it conflicts with namespace name
2021-08-05 07:25:31 +10:00
bugobliterator
114d7b22f4
AP_AHRS: change class name from SITL::SITL to SITL::SIM
2021-08-05 07:25:31 +10:00
Peter Barker
107e647d00
AP_AHRS: correct compilation under SITL with no EKF3
2021-08-04 18:15:55 +10:00
Andrew Tridgell
5dab362286
AP_AHRS: mark log messages as streaming
2021-08-03 10:23:36 +10:00
Peter Barker
383807e334
AP_AHRS: move AOA state to private in frontend
...
AP_AHRS: make update_AOA_SSA non-virtual
2021-08-02 20:55:04 +10:00
Peter Barker
d131cf01d3
AP_AHRS: use compass reference rather than pointer
2021-07-30 17:37:08 +10:00
Peter Barker
ca58aa9c5f
AP_AHRS: stop using AHRS as conduit for Compass pointer
2021-07-30 12:19:42 +10:00
Peter Barker
e4bceb2417
AP_AHRS: move AOA/SSA to AP_AHRS, don't recalc on fetch
2021-07-30 11:23:06 +10:00