Commit Graph

26528 Commits

Author SHA1 Message Date
Randy Mackay
3242bd0ee8 AC_WPNav_OA: separate handlers for results from Dijkstra's and BendyRuler
also bendy ruler uses pos controller
2021-07-22 16:01:01 +10:00
Randy Mackay
6cbc62744b AC_Avoidance: BendyRuler returned destination are shortened 2021-07-22 16:01:01 +10:00
Randy Mackay
3177759a1d AC_Avoidance: bendy ruler format fixes 2021-07-22 16:01:01 +10:00
Randy Mackay
8d641e1bb3 AC_Avoidance: OA_PathPlanner returns which planner was used
this replaces get_bendy_type
2021-07-22 16:01:01 +10:00
Randy Mackay
6b74dd2ab4 AC_Avoidance: BendyRuler returns which type was used
also make serach_xxx_path methods private
2021-07-22 16:01:01 +10:00
Randy Mackay
7084009454 AP_Common: add Location::linear_interpolate_alt 2021-07-22 16:01:01 +10:00
Andy Piper
8cd3ae12a7 AP_BLHeli: ensure correct rotation through telemetry ESCs 2021-07-22 16:01:01 +10:00
Pierre Kancir
62be72d3ba AC_WPNav: remove unused variable following https://github.com/ArduPilot/ardupilot/pull/18076 2021-07-22 16:01:01 +10:00
Leonard Hall
730ac9cb20 AC_PosControl: Add MAX(bla,0) because safe_sqrt isn't safe 2021-07-22 16:01:01 +10:00
Leonard Hall
5001f47313 WP_Nav: Return Crosstrack error 2021-07-22 16:01:01 +10:00
Leonard Hall
3d6dd8cff8 AC_AttitudeControl: AC_PosControl: calculate cross track 2021-07-22 16:01:01 +10:00
Randy Mackay
b916f7742e AC_WPNav: use get_terrain_margin instead of constant 2021-07-22 16:01:01 +10:00
Randy Mackay
7a09ac1aa6 AC_WPNav: add TER_MARGIN param 2021-07-22 16:01:01 +10:00
Leonard Hall
2dea0fa966 AC_AttitudeControl: AC_PosControl: Auto Terain following update 2021-07-22 16:01:01 +10:00
Leonard Hall
fc8242db68 AC_WPNav: Auto Terain following update 2021-07-22 16:01:01 +10:00
Andy Piper
19ae04f1b0 AP_HAL_ChibiOS: only control widest pulse for dshot and oneshot 2021-07-22 16:01:01 +10:00
Leonard Hall
902560953b AC_AttitudeControl: Allow yaw rate reset to be de-selected 2021-07-22 16:01:01 +10:00
Hwurzburg
b59f5ec7a1 RC_Channel: fix ELRS systems spamming CRSF mode/rate messages 2021-07-22 16:01:01 +10:00
Hwurzburg
319cc7a199 AP_RCTelemetry: fix ELRS systems spamming CRSF mode/rate messages 2021-07-22 16:01:01 +10:00
Andy Piper
4540244e2a AP_RCTelemetry: correct firmware string length for CRSF 2021-07-22 16:01:01 +10:00
Leonard Hall
14cfcf18c2 AC_WPNav: Remove unused function 2021-07-22 16:01:01 +10:00
Leonard Hall
fcca42410a AC_AttitudeControl: Add accessor for yaw slew limit 2021-07-22 16:01:01 +10:00
Leonard Hall
c3c3a47e9a AC_AttitudeControl: AC_PosControl: support accel only input in the vertical 2021-07-22 16:01:01 +10:00
Leonard Hall
ebd8401652 AC_AttitudeControl: AC_PosControl: support terrain following 2021-07-22 16:01:01 +10:00
Leonard Hall
30aa636ba1 AC_WPNav: seperate kinimatic shaping from pid limit setting 2021-07-22 16:01:01 +10:00
Leonard Hall
c1484f4b31 AC_AttitudeControl: AC_PosControl: seperate kinimatic shaping from pid limit setting 2021-07-22 16:01:00 +10:00
Leonard Hall
9d8fdf3e85 AC_AttitudeControl: Add terain following to guided 2021-07-22 16:01:00 +10:00
Randy Mackay
3e2949ce98 AC_WPNav: get_terrain_offset and get_vector_NEU made public 2021-07-22 16:01:00 +10:00
Leonard Hall
0269c49c14 AC_WPNav: move code to generate terrain following kinematic path 2021-07-22 16:01:00 +10:00
Leonard Hall
d5d7e3d5d3 AC_AttitudeControl: AC_PosControl: Support Accel only input 2021-07-22 16:01:00 +10:00
Leonard Hall
a546a9ac14 AC_AttitudeControl: AC_PosControl: Change input_pos_xyz name 2021-07-22 16:01:00 +10:00
Andrew Tridgell
3fd0bf734b AP_Math: added test for SCurve::calculate_path
this was the values shown in the core dump for failing guided mode
test in CI
2021-07-22 16:01:00 +10:00
Andy Piper
560a5ea225 AP_HAL_ChibiOS: re-enable LEDs on MatekF405-bdshot 2021-07-22 16:01:00 +10:00
Randy Mackay
5697e5616c AP_NavEKF3: EK3_RNG_USE_HGT param references EK3_SRCx_POSZ 2021-07-22 16:01:00 +10:00
Andrew Tridgell
8165a81256 AP_Common: update tests for 4.1 2021-07-22 16:01:00 +10:00
Andrew Tridgell
d128c1a86f HAL_ChibiOS: raise DMA contention threshold for H7 2021-07-22 16:01:00 +10:00
Andrew Tridgell
52e4b522f9 AP_SerialManager: document DisableFIFO bit 2021-07-22 16:01:00 +10:00
Andrew Tridgell
18d90f76b5 AP_SerialManager: call set_options() before first UART use
this ensures options are set before the first begin() call
2021-07-22 16:01:00 +10:00
Andrew Tridgell
c2b310ad86 HAL_ChibiOS: implement NOFIFO option for uarts 2021-07-22 16:01:00 +10:00
Andrew Tridgell
c37310b966 AP_HAL: added serial option for disabling FIFO on uarts 2021-07-22 16:01:00 +10:00
Andrew Tridgell
0579870593 AP_Math: fixed build 2021-07-22 16:01:00 +10:00
Andrew Tridgell
97da800b67 HAL_SITL: update for changed SITL API 2021-07-22 16:01:00 +10:00
Andrew Tridgell
8fc7f661e8 SITL: added SIM2 message
useful for EKF debugging

# Conflicts:
#	libraries/SITL/SIM_Aircraft.cpp
2021-07-22 16:01:00 +10:00
Andrew Tridgell
29f694ffdd SITL: separate origin and home in SITL
this allows for accurate sensor data when flying a very long distance
from the takeoff location
2021-07-22 16:01:00 +10:00
Andrew Tridgell
f8e315fc65 AP_DAL: update GPS yaw API to add timestamp 2021-07-22 16:01:00 +10:00
Andrew Tridgell
4b2c766857 AP_GPS: change handling of moving baseline yaw
this changes yaw handling in a few ways:

 - GPS yaw now has a timestamp associated with the yaw separate from
   the timestamp associated with the GPS fix

 - we no longer force the primary to change to the UBLOX MB rover when
   it has a GPS yaw. This means we don't change GPS primary due to GPS
   loss, which keeps the GPS more stable. It also increases accuracy
   as the rover is always less accurate in position and velocity than
   the base

 - now we force the primary to be the MB base if the other GPS is a
   rover and the base has GPS lock
2021-07-22 16:01:00 +10:00
Andrew Tridgell
de254d59f1 AP_NavEKF: sync for 4.1.0beta 2021-07-22 16:01:00 +10:00
Andrew Tridgell
dd2995af5d AP_Math: sync for 4.1.0beta releases 2021-07-22 16:01:00 +10:00
Andrew Tridgell
1d46e77942 AP_Common: make longitude_scale() a static
this changes the use of longitude_scale() to use the average latitude
instead of the lattitude at one end of the line when calculating
positions and distances. It means we obey the basic geometry rule
that:

 pos1 + offs = pos2
 pos2 - offs == pos1
2021-07-22 16:01:00 +10:00
Andrew Tridgell
f0bc4bca84 HAL_ChibiOS: run storage writes at 1kHz not 100Hz
The 100Hz update rate means there is a significant chance of an arming
failure after mission upload if you try to arm shortly after the
update.

Each mission item is 15 bytes, so with a 1200 item mission we need to
write 18000 bytes to storage. At 100Hz, with 8 bytes per storage line,
that takes over 22 seconds.
2021-07-22 16:01:00 +10:00
Peter Barker
156a220d5b AP_NavEKF3: pass NavEKF failures back up to callers 2021-07-22 16:01:00 +10:00
Andrew Tridgell
9f03f5a9a9 AP_NavEKF3: process GPS yaw independently of GPS fix
this processes GPS yaw with its own timestamp and as a separated step
from fusing position and velocity. This makes the yaw time handling
more accurate as yaw for moving baseline GPS comes in as a separate
piece of data from the position and velocity
2021-07-22 16:01:00 +10:00
Andrew Tridgell
4408eecb18 AP_NavEKF3: fixed indentation in readGpsData() 2021-07-22 16:01:00 +10:00
Andrew Tridgell
cc03255245 AP_NavEKF3: implement moving origin
this shifts EKF_origin to the current location at 1Hz, while leaving
public_origin alone. All output APIs and logging are relative to
public_origin.

The effect of this change is to remove the distortion caused by a
spherical earth, which allows the EKF to operate without errors at
very long distances from the public_origin.
2021-07-22 16:01:00 +10:00
Andrew Tridgell
8c9663e47c AP_NavEKF3: moved checkUpdateEarthField to be called less often 2021-07-22 16:01:00 +10:00
Andrew Tridgell
c05e93e51e AP_NavEKF3: update earth field at 1Hz
this prevents large mag errors on long distance flights
2021-07-22 16:01:00 +10:00
Andrew Tridgell
f2668f8e8e AP_Common: added ftype precision offset call
# Conflicts:
#	libraries/AP_Common/Location.cpp
#	libraries/AP_Common/Location.h
2021-07-22 16:01:00 +10:00
Andrew Tridgell
edb11d4d71 AP_NavEKF3: convert code_gen.py to ftype 2021-07-22 16:01:00 +10:00
Andrew Tridgell
823ed4c309 AP_NavEKF3: convert powF(xx,2) calls to sq(xx) 2021-07-22 16:01:00 +10:00
Andrew Tridgell
b6fb7383e7 AP_NavEKF3: convert EKF3 derivation to ftype 2021-07-22 16:01:00 +10:00
Andrew Tridgell
fa3f3dd218 HAL_ChibiOS: define HAL_HAVE_HARDWARE_DOUBLE on F765, F777 and H7 2021-07-22 16:01:00 +10:00
Andrew Tridgell
a6c5b65f4a AP_NavEKF3: allow for double EKF build 2021-07-22 16:01:00 +10:00
Andrew Tridgell
380b9b39ed AP_NavEKF2: allow for double EKF build 2021-07-22 16:01:00 +10:00
Andrew Tridgell
10facfc519 AP_NavEKF: allow for double EKF build 2021-07-22 16:01:00 +10:00
Andrew Tridgell
4dfa6258d9 AP_Mount: use ZERO_FARRAY() 2021-07-22 16:01:00 +10:00
Andrew Tridgell
26820c3a8c AP_Motors: fixup build for ftype conflict 2021-07-22 16:01:00 +10:00
Andrew Tridgell
425c8aafb1 AP_Common: added double methods for SITL 2021-07-22 16:01:00 +10:00
Andrew Tridgell
d698987070 SITL: fixup offset calls 2021-07-22 16:01:00 +10:00
Andrew Tridgell
e7afa628d1 AP_Math: allow for double EKF build 2021-07-22 16:01:00 +10:00
Andrew Tridgell
c6c197d4fb HAL_ChibiOS: use SRAM1 as first ram segment on H7
this is needed to give the linker more than 128k for static variables
with double precision maths.
2021-07-22 16:01:00 +10:00
Andrew Tridgell
309500c84f AP_HAL: allow for double EKF build 2021-07-22 16:01:00 +10:00
Andrew Tridgell
ae013dd5e6 APM_Control: adjust fixed wing filter defaults
adjust defaults based on discussions with Paul, and initialise the
FLTT value based on the controller time constant
2021-07-05 16:09:34 +10:00
Andrew Tridgell
2ac01f207a AP_Notify: disable DShot buzzer by default 2021-07-04 18:28:20 +10:00
Andy Piper
b5bb401b97 AP_Notify: re-enable display on 1Mb boards 2021-07-04 08:24:40 +10:00
Andrew Tridgell
2d4e77e9b1 HAL_ChibiOS: always send zero DShot when disarmed
this prevents a misconfigured system (for example SERVOn_REVERSED=1)
from running a motor while disarmed.

See https://discuss.ardupilot.org/t/plane-4-1-0-beta/72434/34?u=tridge
2021-07-04 08:24:17 +10:00
Andrew Tridgell
bf867fb792 AP_Logger: fixed log creation on forced arm
when we force arm we need to ask the IO thread to create the log, not
create it ourselves
2021-07-04 08:23:29 +10:00
Randy Mackay
8722bb7ff9 GCS_MAVLink: send water depth and temp 2021-07-04 08:19:11 +10:00
Andrew Tridgell
937f316d14 AP_Common: use longitude scaling from definitions.h 2021-07-04 08:19:11 +10:00
Andrew Tridgell
0e37a44942 AP_Math: fixed the value LATLON_TO_CM
it didn't have enough digits of precision, and was inconsistent with
LOCATION_SCALING_FACTOR
2021-07-04 08:19:11 +10:00
Peter Barker
3134e15c77 AP_BattMonitor: correct static_assert call 2021-07-04 08:19:11 +10:00
Peter Barker
6de7d1d1df AP_HAL_SITL: reduce scope of loop variable 2021-07-04 08:19:11 +10:00
Leonard Hall
e21b8a5b29 AC_WPNav: use shaping_tc_z_s for terrain following time constant. 2021-07-04 08:19:11 +10:00
Leonard Hall
68b882d404 AC_AttitudeControl: Add shaping_tc_z_s accessor 2021-07-04 08:19:11 +10:00
Andrew Tridgell
86e8731fc5 AP_Mount: fixed longitude subtraction 2021-07-04 08:19:11 +10:00
Peter Barker
b7b7c7d86b AP_Common: add test for longitude wrapping 2021-07-04 08:19:11 +10:00
Andrew Tridgell
17193d3175 AP_Common: fixed Location class for wrap at 180 degrees longitude
this allows us to fly missions across the date line
2021-07-04 08:19:11 +10:00
Leonard Hall
83b4616a7b AC_PosControl: fixup ekf reset 2021-07-04 08:19:11 +10:00
Andrew Tridgell
92e407a0bc AP_IRLock: convert SITL backends to double precision position 2021-07-04 08:19:11 +10:00
Andrew Tridgell
a82890c0db AC_PrecLand: convert SITL backends to double precision position 2021-07-04 08:19:11 +10:00
Andrew Tridgell
f45ef772f3 AP_Math: added matrix3 tofloat and todouble 2021-07-04 08:19:11 +10:00
Andrew Tridgell
214d9ad0f8 AP_Common: added double methods for SITL 2021-07-04 08:19:11 +10:00
Andrew Tridgell
b0f2545a9f SITL: convert to double precision for positions 2021-07-04 08:19:11 +10:00
Andrew Tridgell
d2e94a49b7 AC_WPNav: convert circle, loiter and WPNav to double position 2021-07-04 08:19:11 +10:00
Andrew Tridgell
0af57de50c AC_AttitudeControl: convert poscontrol to use double position 2021-07-04 08:19:11 +10:00
Andrew Tridgell
e6a1cee08f AC_PID: convert AC_P_2D to double 2021-07-04 08:19:11 +10:00
Andrew Tridgell
c2211db91d AP_Math: implement double versions of some position control methods 2021-07-04 08:19:11 +10:00
Andrew Tridgell
d40475cf7b AP_Math: define postype_t and vectors 2021-07-04 08:19:11 +10:00
Andrew Tridgell
683f7949fd HAL_SITL: implement initial GPS position offsets 2021-07-04 08:19:11 +10:00
Andrew Tridgell
2f2d1c985a AP_Math: added tofloat() and todouble() methods to Vector2 and Vector3 2021-07-04 08:19:11 +10:00
Andrew Tridgell
f73564f593 SITL: added SIM_INIT_LAT_OFS and SIM_INIT_LON_OFS
these give an initial lat/lon offset to the GPS in SITL so we can end
up with an origin a long way from the final position
2021-07-04 08:19:11 +10:00