Commit Graph

249 Commits

Author SHA1 Message Date
Peter Barker 61de480f62 AP_AHRS: log DCM errrp and erryaw into DCM message 2024-09-09 15:17:15 +10:00
Andrii Fil 3344dba627 AP_AHRS: support MAV_CMD_EXTERNAL_WIND_ESTIMATE 2024-09-04 10:14:45 +10:00
patrick.wiltshire956@gmail.com bdab1054d6 AP_AHRS: added set_ekf_type() and DCM logging 2023-12-17 09:47:30 +11:00
Bob Long 6eed40dec1 AP_InertialNav: add fallback vertical velocity 2023-12-05 10:44:37 +11:00
Mykhailo Kuznietsov 28e4f78ebb AP_AHRS: Fix some typos
Fixed some typos found in the code.
2023-10-12 18:30:42 +11:00
Peter Barker 486ed2965e AP_AHRS: add AP_AHRS_DCM_ENABLED
preliminary commit to add the bulk of the changes which are not problematic
2023-09-27 08:00:54 +10:00
Peter Barker 8e57d66a0d AP_AHRS: move AP_AHRS_DCM::groundspeed_vector into correct file 2023-09-20 19:06:10 +10:00
Peter Barker 9bcd9df7dd AP_AHRS: move load_watchdog_home into correct cpp file
NFC, just moving the code out of the DCM backend file
2023-09-19 11:35:45 +10:00
Peter Barker 622b83da9e AP_AHRS: move set_home method into correct .cpp file
NFC, just moving the code in prepration for allowing DCM to be compiled out
2023-09-19 11:35:45 +10:00
Peter Barker c30bceb2a0 AP_AHRS: return location inside backend_results structure
with the change to cache results inside AP::ahrs().state we no longer need to worry about the backend's attempts to project the last-known-location forwards according to amount of time elapsed since that last-known-location was calculated.
2023-09-19 11:25:49 +10:00
Peter Barker 73a09f3dc5 AP_AHRS: allow more libraries to compile with no HAL_GCS_ENABLED 2023-09-05 22:23:51 +10:00
Andrew Tridgell 5d4bf9fc14 AP_AHRS: fixed build for SITL periph 2023-08-24 13:06:40 +10:00
Peter Barker 904707de15 AP_AHRS: clarify get_vert_pos_rate AHRS method name to include 'D' 2023-06-06 20:09:28 +10: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 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