Commit Graph

22584 Commits

Author SHA1 Message Date
Randy Mackay
dc2e0f328b AP_VisualOdom: fix handle_vision_position_delta_msg
position and angle deltas were swapped when passed into the EKF
time passed into the EKF was scaled as usec when it should be sec
2020-04-09 19:41:08 +09:00
Randy Mackay
c18fce6714 AP_Math: add quaternion rotation test 2020-04-09 19:41:08 +09:00
Randy Mackay
d1aa3858f0 AP_Vehicle: add visual odometry 2020-04-09 19:41:08 +09:00
Randy Mackay
1b1687f43d AP_Arming: integrate visual odometry pre_arm_check 2020-04-09 19:41:08 +09:00
Randy Mackay
2f5a8fd6b9 RC_Channel: add aux function for visodom-calibrate 2020-04-09 19:41:08 +09:00
Randy Mackay
9769f08fd9 GCS_MAVLink: visual odometry build fixes 2020-04-09 19:41:08 +09:00
Randy Mackay
a9c1eb5af4 GCS_MAVLink: fill in sys_status vision position bits 2020-04-09 19:41:08 +09:00
Randy Mackay
a1ddd55ea5 GCS_MAVlink: AP_integrate of rename to handle_vision_position_delta_msg 2020-04-09 19:41:08 +09:00
Randy Mackay
728e8b45a9 GCS_MAVLink: use AP_VisualOdom to handle vision-position-estimate messages 2020-04-09 19:41:08 +09:00
Randy Mackay
aa720b0ae6 AP_VisualOdom: pre-arm failure string prefix moved to AP_Arming 2020-04-09 19:41:08 +09:00
Randy Mackay
3d75dc7815 AP_VisualOdom: add HAL_VISUALODOM_ENABLED 2020-04-09 19:41:08 +09:00
Randy Mackay
8f94a0cfb0 AP_VisualOdom: integrate IntelT265 backend 2020-04-09 19:41:08 +09:00
Randy Mackay
f0e11d9a5c AP_VisualOdom: add IntelT265 backend 2020-04-09 19:41:08 +09:00
Randy Mackay
a41b169635 AP_VisualOdom: front-end implements handle_vision_position_estimate with eulers 2020-04-09 19:41:08 +09:00
Randy Mackay
3530d5b348 AP_VisualOdom: MAV driver implements handle_vision_position_estimate 2020-04-09 19:41:08 +09:00
Randy Mackay
c78b1ab3bf AP_VisualOdom: rename handle_vision_position_delta_msg 2020-04-09 19:41:08 +09:00
Randy Mackay
b519d285a6 AP_VisualOdom: get_orientation made public
also remove unnecessary friends
2020-04-09 19:41:08 +09:00
Randy Mackay
c36dfc448d AP_VisualOdom: handle_msg directly updates EKF 2020-04-09 19:41:08 +09:00
Randy Mackay
0eb1ef1f08 AP_VisualOdom: add handle_vision_position_estimate
also add pre_arm_check
2020-04-09 19:41:08 +09:00
Randy Mackay
1cf9655b4a AP_VisualOdom: TYPE param becomes enable flag and reboot required 2020-04-09 19:41:08 +09:00
Randy Mackay
61a06bbb04 AP_Math: add quaternion rotate, from_rotation and invert 2020-04-09 19:41:08 +09:00
Randy Mackay
338548c5eb AP_Math: move HALF_SQRT_2 def to rotation.h
This allows it to be used by the Quaternion class
2020-04-09 19:41:08 +09:00
Randy Mackay
b0b78e974b AP_AHRS: add get_quaternion 2020-04-09 19:41:08 +09:00
Randy Mackay
e1c623183e AP_AHRS: minor comment fix and move var_info lower 2020-04-09 19:41:08 +09:00
Randy Mackay
24bb4876a8 AP_AHRS: move is_ext_nav_used_for_yaw to parent 2020-04-09 19:41:08 +09:00
Randy Mackay
c0187fe05f AP_Logger: add log message description for VISO 2020-04-09 19:41:08 +09:00
Randy Mackay
f18be824ea AP_Logger: add VISP message 2020-04-09 19:41:08 +09:00
chobits
63320f140a AP_Logger: constraints time spend in header writing, more complete 2020-04-09 19:17:17 +10:00
chobits
b829384fdf AP_Logger: constraints time spended in header writing 2020-04-09 19:17:17 +10:00
Andrew Tridgell
dd4cf6ccdd AP_Compass: change RM3100 device ID
changed scale factor means users need to recalibrate
2020-04-08 11:21:51 +10:00
Andrew Tridgell
18c3efc377 AP_Compass: fixed scaling of RM3100
scale factor was off by 200/256, resulting in COMPASS_SCALE of about
1.28

thanks to Arace for noticing
2020-04-08 11:21:51 +10:00
Peter Barker
5e4cbb0a3f AP_EFI: correct duplicate-label problem in EFI2 log message 2020-04-08 11:17:41 +10:00
Samuel Tabor
4a39a43c10 AP_Soaring: Add log documentation. 2020-04-08 09:11:54 +10:00
Samuel Tabor
b9daae062c AP_Soaring: Use enum class rather than typedef enum for states and hide details of these. 2020-04-08 09:11:54 +10:00
Samuel Tabor
3228cc3309 AP_TECS: Update descriptions of pitch feed-forward parameters. 2020-04-08 09:11:54 +10:00
Samuel Tabor
6e75890bd9 AP_Soaring: Add a low pass of target position from EKF before using it. 2020-04-08 09:11:54 +10:00
Samuel Tabor
f23efdd13b AP_Soaring: Make vario time constant public. 2020-04-08 09:11:54 +10:00
Samuel Tabor
d04c6cb02e TECS: Don't override the speedweight to 0 if synthetic airspeed is in use. 2020-04-08 09:11:54 +10:00
Samuel Tabor
56649fa8eb AP_Soaring: Fix too-long status message. 2020-04-08 09:11:54 +10:00
Samuel Tabor
d54c7f1b7a AP_Soaring: Fix bug when no soaring activation RC channel set. 2020-04-08 09:11:54 +10:00
Samuel Tabor
fbd0df81a7 AP_Soaring: Report changes in active status. 2020-04-08 09:11:54 +10:00
Samuel Tabor
e1f7122566 AP_Soaring: Improve tracking of enabled/disabled status. 2020-04-08 09:11:54 +10:00
Samuel Tabor
5ac801b2ac AP_Soaring: Use 64 bit variable for time to avoid overflow. 2020-04-08 09:11:54 +10:00
Samuel Tabor
2260fda4ec AP_Soaring: Detect changes in active parameter/switch position. 2020-04-08 09:11:54 +10:00
Samuel Tabor
fdf7eae01c AP_Soaring: Adjust initial EKF values and limit R to 40.0m. 2020-04-08 09:11:54 +10:00
Samuel Tabor
ff1725b549 AP_Soaring: Make enable channel 3 position. PWM above 1400us allows most soaring features, but above 1700us is required before any automatic switch to LOITER mode. 2020-04-08 09:11:54 +10:00
Samuel Tabor
1160c59a89 AP_Soaring: Remove dsp bias and log this. 2020-04-08 09:11:54 +10:00
Samuel Tabor
c28c573da1 AP_Soaring: Also log acceleration. 2020-04-08 09:11:54 +10:00
Samuel Tabor
7555f5abf8 AP_Soaring: Fix incorrect trig function and log the expected sink. 2020-04-08 09:11:54 +10:00
Samuel Tabor
17f1fa9600 AP_Soaring: Fix use of double precision sqrt. 2020-04-08 09:11:54 +10:00
Samuel Tabor
7d3ff28974 AP_Soaring: Correct bug with reversed arguments. 2020-04-08 09:11:54 +10:00
Samuel Tabor
16b7de4029 AP_Soaring: Cleanup variometer. 2020-04-08 09:11:54 +10:00
Samuel Tabor
62a34e0f8d AP_Soaring: Calculate filter time constant based on airspeed and loiter radius, using 3x circline rate. 2020-04-08 09:11:54 +10:00
Samuel Tabor
2b40182b34 AP_Soaring: Reduce drift feed-forward by ratio of climb rate to thermal core strength. This is consistent with assumption that each packet of air, rising at core strength, is convected with the ambient wind speed. 2020-04-08 09:11:54 +10:00
Samuel Tabor
15cef55e97 SITL: Make thermal drift relative to 100m alt to avoid so much change with wind speed and direction." 2020-04-08 09:11:54 +10:00
Samuel Tabor
8072f6b858 AP_Soaring: Make the trigger VSPEED take account of thermalling sink. 2020-04-08 09:11:54 +10:00
Samuel Tabor
650b464831 AP_Soaring: Move drift check to separate function and check drift with reference to mission segment, allowing drift in right direction. LOITER target, not current position, is now used. 2020-04-08 09:11:54 +10:00
Samuel Tabor
45cb663d73 AP_Math: Add template for Vector2f::projected. 2020-04-08 09:11:54 +10:00
Samuel Tabor
fab74f8927 AP_Soaring: Calculate expected thermalling sink live and avoid divide by zero by limiting airspeed to that corresponding to CL max (generously assumed 1.5 for glider). 2020-04-08 09:11:54 +10:00
Samuel Tabor
75f772b269 AP_Soaring: Add SOAR_MAX_RADIUS parameter, that defines when a RTL will be used when exiting LOITER. 2020-04-08 09:11:54 +10:00
Samuel Tabor
684ee11fc3 AP_TECS: Add flags to indicate gliding flight, and use these with AP_Soaring. 2020-04-08 09:11:54 +10:00
Samuel Tabor
dc8c062fbe AP_TECS: Correct an error in the SEBdot FF term. 2020-04-08 09:11:54 +10:00
Samuel Tabor
247738518e AP_TECS: Add a feed-forward term from adjusted demanded airspeed to nav pitch. 2020-04-08 09:11:54 +10:00
Samuel Tabor
a27c99fab9 AP_TECS: Return the adjusted demanded airspeed. The aspd_error mavlink message now shows the rate-limited airspeed. 2020-04-08 09:11:54 +10:00
Samuel Tabor
ae27f96361 SITL: Make soaring thermals slanted. 2020-04-08 09:11:54 +10:00
Samuel Tabor
013628bd1d Plane: Soaring - better reporting of exit due to drift. 2020-04-08 09:11:54 +10:00
Samuel Tabor
e1b2360781 AP_Soaring: Add a maximum allowable drift distance when thermalling. 2020-04-08 09:11:54 +10:00
Samuel Tabor
936d4232c9 AP_Soaring: Add a 60s first order filter on climb rate. If this becomes negative exit thermalling. 2020-04-08 09:11:54 +10:00
Samuel Tabor
30249e8006 AP_Soaring: Add a check of whether altitude has been lost overall when thermalling. 2020-04-08 09:11:54 +10:00
Samuel Tabor
5082c9be8b SITL: Add plane-soaring type, including parameters, mission, simulated thermals and glider sim settings. 2020-04-08 09:11:54 +10:00
Tom Pittenger
f24095e9ed AP_Soaring: inhibit msg spam when lingering in loiter waiting for heading to line up 2020-04-08 09:11:54 +10:00
Samuel Tabor
3211c03f58 AP_Soaring: Remove unused methods, clean up and log position in N/E rather than Lat/Lng.
Fix
2020-04-08 09:11:54 +10:00
Samuel Tabor
152c1507e0 AP_Soaring: Make the EKF states the actual NE position of the thermal, rather than the position relative to aircraft. 2020-04-08 09:11:54 +10:00
Samuel Tabor
d7abd296ef AP_Soaring: Avoid calculations in lat/lng. 2020-04-08 09:11:54 +10:00
Samuel Tabor
0cccc8dc29 AP_Soaring: Fix issue with loiter radius being saved as zero due to initialisation order. This caused incorrect calculation of thermal climb potential and cases of staying in thermals that should have been abandoned. 2020-04-08 09:11:54 +10:00
Samuel Tabor
c135b00b7b AP_Soaring: Remove redundant check for new vario data. 2020-04-08 09:11:54 +10:00
Samuel Tabor
64460be0d0 AP_Soaring: Implement vario based on acceleration rather than differentiated airspeed. 2020-04-08 09:11:54 +10:00
Tom Pittenger
f6396d7a6d Plane: add reason to exit Thermal loiter and adjust LOW alt reaon to cause RTL 2020-04-08 09:11:54 +10:00
Tom Pittenger
52ae093a97 AP_Soaring: add reason to exit Thermal loiter 2020-04-08 09:11:54 +10:00
Michael du Breuil
73c5c2e1bb AP_Arming: Check that sticks are neutral 2020-04-07 14:01:12 -07:00
Michael du Breuil
2b9aa9bc21 RC_Channel: Add option bit for arming checking the throttle input (opt-in)
Also adds interface to find out what channel is used for rudder arming
2020-04-07 14:01:12 -07:00
murata
7ec0cb47a5 AP_Compass: const extern hal reference 2020-04-07 20:45:51 +09:00
murata
f83f6c71e4 AP_Logger: const extern hal reference 2020-04-07 20:45:51 +09:00
murata
264a90bb45 AP_Logger: Change to coding style (NFC)
AP_Logger: Change to coding style (NFC)
2020-04-07 20:37:33 +09:00
Rishabh
76b4e42bca AP_Logger: Logger documentation TimeUS and typo fix 2020-04-07 18:57:01 +10:00
Rishabh
fe4d1f9316 AC_AutoTune: Logger documentation TimeUS fix 2020-04-07 18:57:01 +10:00
Rishabh
b0134460e5 AP_NavEKF:Logger documentation TimeUS fix 2020-04-07 18:57:01 +10:00
Rishabh
eeb55f8b16 TECS: Logger documentation TimeUS fix 2020-04-07 18:57:01 +10:00
Peter Barker
59dfaad749 SITL: provide method to retrieve desired speedup 2020-04-07 14:51:32 +10:00
Peter Barker
78e432af0c AP_HAL_SITL: do not let outbound queue length to grow too far
This basically limits our loop rate to whatever is listening on uartA
can handle in terms of mavlink traffic.
2020-04-07 14:51:32 +10:00
Peter Barker
7028eb8d24 AP_HAL_SITL: provide method to get amount of data still pending in outbound system queues 2020-04-07 14:51:32 +10:00
bugobliterator
9d7022514e HAL_SITL: ensure that unique id string end in null char 2020-04-07 09:40:05 +10:00
Andy Piper
b8878380d6 AP_Camera: add RunCam device type 2 documentation 2020-04-06 20:27:32 +10:00
Andy Piper
e3d22b9d27 AP_Camera: if exiting a RunCam submenu reset the submenu index to the top 2020-04-06 20:15:38 +10:00
Andrew Tridgell
be674fc36c AP_NavEKF3: make mag variance reporting consistent
logged scaled variance should match the value used in MAVLink
EKF_STATUS_REPORT
2020-04-06 17:30:29 +10:00
Andrew Tridgell
c9755cf9e6 AP_NavEKF2: make mag variance reporting consistent
logged scaled variance should match the value used in MAVLink
EKF_STATUS_REPORT
2020-04-06 17:30:29 +10:00
Peter Barker
2ed550966d AP_Logger: correct units for velocity on OF log message 2020-04-06 10:46:45 +10:00
Peter Barker
64c973b592 SITL: add documentation for AirSim ASM1,ASM2 log messages 2020-04-06 10:46:45 +10:00
Peter Barker
e477f6c840 AC_PosControl: add documentation for PSC log message 2020-04-06 10:46:45 +10:00
Peter Barker
33f17d7739 AP_Logger: document ARSP,ASP2,CAM,TRIG,POWR,TERR,CSV,CMD,OF,AHR2 2020-04-06 10:46:45 +10:00