Commit Graph

235 Commits

Author SHA1 Message Date
Peter Barker c42754b691 AP_AHRS: create an AP_AHRS_SIM backend 2023-01-12 13:11:40 +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
Peter Barker 5ed0451f8b AP_AHRS: include required AP_Vehicle_Type header 2022-11-02 18:35:48 +11: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
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
Iampete1 d423f483a6 AP_AHRS: params always use set method 2022-08-03 13:43:48 +01:00
Joshua Henderson 7cc2382a78 AP_AHRS_DCM: NFC comment on check_matrix() normalization reset 2022-04-19 09:27:00 +10:00
Peter Barker 24099f9a2d AP_AHRS: include cleanups 2022-03-01 11:21:33 +11:00
Peter Barker f72024fc63 AP_AHRS: move logging of LogEvent::SET_HOME up 2022-02-08 11:04:26 +11:00
Peter Barker ff63b62b0c AP_AHRS: rename AP_AHRS::get_position to get_location 2022-01-25 10:47:22 +11:00
Joshua Henderson 8a6942a9df AP_AHRS: add define AP_AIRSPEED_ENABLED 2022-01-19 18:21:32 +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
Gone4Dirt 94b97313be AP_AHRS: Add APM_BUILD_Heli 2021-09-29 19:55:48 +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 9114d4fc86 AP_AHRS: make home-relative functions AHRS-frontend only 2021-08-25 18:32:07 +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 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
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
Peter Barker 5b372dae06 AP_AHRS: stop storing gyro drift rate as variable
This is constant and is just folded into whereever it is used.
2021-07-23 09:55:14 +10:00
Andrew Tridgell cd3ac639fe AP_AHRS: added AHRS_GPS_USE=2 for no baro
this allows DCM to use the GPS instead of the baro for height
2021-07-08 07:56:51 +10:00
CallanDaniel 76f5db93dc AP_AHRS: add semaphore around set_home()
added semaphore around set_home() to avoid thread racing
2021-06-23 10:11:02 +09:00
Peter Barker ee0a373b60 AP_AHRS: remove HIL support 2021-06-15 09:47:31 +10:00
Peter Barker 9eeec61cec AP_AHRS: new APIs for takeoff/touchdown expected
timeout handling now in AP_AHRS, and state stored in AHRS and
requested by AP_DAL
2021-06-02 11:13:16 +09:00
Peter Barker ea1884f491 AP_AHRS: remove separate calls to get delta-times for vel and ang 2021-03-13 11:29:29 +11:00
Randy Mackay 62932f884f AP_AHRS: pre_arm_check may skip position checks 2021-01-26 10:46:49 +11:00
Peter Barker 358069df24 AP_AHRS: use ground_course in preference to ground_course_cd 2021-01-26 10:22:28 +11:00
Peter Barker 55cb3e8ef0 AP_AHRS: get airspeed sensor from singleton not AHRS object 2020-12-07 15:57:28 -08:00
Andrew Tridgell dab091a801 AP_AHRS: cope with INS_MAX_INSTANCES below 3 2020-11-10 16:15:45 +11:00
Peter Barker 9d45669a58 AP_AHRS: reuse ins object for multiple calls, simplify delta_t variable 2020-10-20 11:24:34 +11:00
Randy Mackay 1d97416a51 AP_AHRS: replace prearm_healthy with pre_arm_check
Also removes prearm_failure_reason
2020-10-07 11:53:07 +11:00
Andrew Tridgell a4e7c72635 AP_AHRS: removed duplicate implementation of airspeed_estimate() 2020-08-27 20:20:51 +10:00
Harshit Kumar Sankhla b5b3298f0a AP_AHRS: get airspeed estimate from non-primary instances too
with multiple airspeed sensors and airspeed affinity in EKF3,
it is possible to have switched over to a lane not using the
primary airspeed sensor, so AHRS should know which airspeed
sensor to use, i.e, the one being used by the primary lane.
2020-08-27 20:20:51 +10:00
Peter Barker e55057ad5d AP_AHRS_DCM: limit measured airspeed according to WIND_MAX 2020-08-15 18:14:05 +10:00
Randy Mackay b0b78e974b AP_AHRS: add get_quaternion 2020-04-09 19:41:08 +09:00
Peter Hall f6897632f8 AP_AHRS: move to airspeed_estimate with pointer 2020-01-14 22:34:37 -07:00