Andrew Tridgell
1f5d16bff8
SITL: added SIM2 message
...
useful for EKF debugging
# Conflicts:
# libraries/SITL/SIM_Aircraft.cpp
2021-07-22 19:07:36 +09:00
Andrew Tridgell
34eb9f7328
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 19:07:36 +09:00
Andrew Tridgell
da2b69d521
AP_DAL: update GPS yaw API to add timestamp
2021-07-22 19:07:36 +09:00
Andrew Tridgell
d7dea5c28c
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 19:07:36 +09:00
Andrew Tridgell
966deb1148
AP_NavEKF: sync for 4.1.0beta
2021-07-22 19:07:36 +09:00
Andrew Tridgell
5660d31ca2
AP_Math: sync for 4.1.0beta releases
2021-07-22 19:07:36 +09:00
Andrew Tridgell
6ee9e445a9
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 19:07:36 +09:00
Andrew Tridgell
0a04bb4b05
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 19:07:36 +09:00
Peter Barker
c4dbbfcc07
AP_NavEKF3: pass NavEKF failures back up to callers
2021-07-22 19:07:36 +09:00
Andrew Tridgell
aadf179286
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 19:07:36 +09:00
Andrew Tridgell
93e1bd0160
AP_NavEKF3: fixed indentation in readGpsData()
2021-07-22 19:07:36 +09:00
Andrew Tridgell
9acb16acca
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 19:07:36 +09:00
Andrew Tridgell
3df7c1a7c7
AP_NavEKF3: moved checkUpdateEarthField to be called less often
2021-07-22 19:07:36 +09:00
Andrew Tridgell
5543706626
AP_NavEKF3: update earth field at 1Hz
...
this prevents large mag errors on long distance flights
2021-07-22 19:07:36 +09:00
Andrew Tridgell
a8844a8428
AP_Common: added ftype precision offset call
...
# Conflicts:
# libraries/AP_Common/Location.cpp
# libraries/AP_Common/Location.h
2021-07-22 19:07:36 +09:00
Andrew Tridgell
87b4ca47e8
AP_NavEKF3: convert code_gen.py to ftype
2021-07-22 19:07:36 +09:00
Andrew Tridgell
7bb971f07d
AP_NavEKF3: convert powF(xx,2) calls to sq(xx)
2021-07-22 19:07:36 +09:00
Andrew Tridgell
395d2f1f7e
AP_NavEKF3: convert EKF3 derivation to ftype
2021-07-22 19:07:36 +09:00
Andrew Tridgell
63de37341c
HAL_ChibiOS: define HAL_HAVE_HARDWARE_DOUBLE on F765, F777 and H7
2021-07-22 19:07:36 +09:00
Andrew Tridgell
4f0f4608b9
AP_NavEKF3: allow for double EKF build
2021-07-22 19:07:36 +09:00
Andrew Tridgell
601eb12efb
AP_NavEKF2: allow for double EKF build
2021-07-22 19:07:36 +09:00
Andrew Tridgell
78e87b32d6
AP_NavEKF: allow for double EKF build
2021-07-22 19:07:36 +09:00
Andrew Tridgell
557fee7add
AP_Mount: use ZERO_FARRAY()
2021-07-22 19:07:36 +09:00
Andrew Tridgell
045f8f2299
AP_Motors: fixup build for ftype conflict
2021-07-22 19:07:36 +09:00
Andrew Tridgell
9246442482
AP_Common: added double methods for SITL
2021-07-22 19:07:36 +09:00
Andrew Tridgell
c1012d69ab
SITL: fixup offset calls
2021-07-22 19:07:36 +09:00
Andrew Tridgell
dddd78daf7
AP_Math: allow for double EKF build
2021-07-22 19:07:36 +09:00
Andrew Tridgell
3239caf852
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 19:07:36 +09:00
Andrew Tridgell
4e4646d9d7
AP_HAL: allow for double EKF build
2021-07-22 19:07:36 +09:00
Andrew Tridgell
3b64d41408
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-22 19:07:36 +09:00
Andrew Tridgell
07acfd49b2
AP_Notify: disable DShot buzzer by default
2021-07-22 19:07:36 +09:00
Andy Piper
1f324d7cbf
AP_Notify: re-enable display on 1Mb boards
2021-07-22 19:07:36 +09:00
Andrew Tridgell
7cd3c29ab2
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-22 19:07:36 +09:00
Andrew Tridgell
1b44375eea
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-22 19:07:36 +09:00
Randy Mackay
3900a4f14a
GCS_MAVLink: send water depth and temp
2021-06-30 12:05:09 +09:00
Andrew Tridgell
a7f31929ea
AP_Common: use longitude scaling from definitions.h
2021-06-29 17:26:34 +09:00
Andrew Tridgell
978ea307b0
AP_Math: fixed the value LATLON_TO_CM
...
it didn't have enough digits of precision, and was inconsistent with
LOCATION_SCALING_FACTOR
2021-06-29 17:26:34 +09:00
Peter Barker
819c331acd
AP_BattMonitor: correct static_assert call
2021-06-28 11:05:00 +09:00
Peter Barker
67ebdc300b
AP_HAL_SITL: reduce scope of loop variable
2021-06-27 10:57:07 +10:00
Leonard Hall
fcde1e7370
AC_WPNav: use shaping_tc_z_s for terrain following time constant.
2021-06-25 16:54:05 +09:00
Leonard Hall
8f493e3021
AC_AttitudeControl: Add shaping_tc_z_s accessor
2021-06-25 16:54:05 +09:00
Andrew Tridgell
f12a7dd04b
AP_Mount: fixed longitude subtraction
2021-06-25 15:33:55 +10:00
Peter Barker
f69e2a49f6
AP_Common: add test for longitude wrapping
2021-06-25 15:33:55 +10:00
Andrew Tridgell
77d83b9c77
AP_Common: fixed Location class for wrap at 180 degrees longitude
...
this allows us to fly missions across the date line
2021-06-25 15:33:55 +10:00
Leonard Hall
5475d1153c
AC_PosControl: fixup ekf reset
2021-06-25 10:01:49 +09:00
Andrew Tridgell
4895a08ab2
AP_IRLock: convert SITL backends to double precision position
2021-06-24 21:34:30 +10:00
Andrew Tridgell
f209504a12
AC_PrecLand: convert SITL backends to double precision position
2021-06-24 21:34:30 +10:00
Andrew Tridgell
aa03afafa7
AP_Math: added matrix3 tofloat and todouble
2021-06-24 21:34:30 +10:00
Andrew Tridgell
61faeb2d7f
AP_Common: added double methods for SITL
2021-06-24 21:34:30 +10:00
Andrew Tridgell
fb275c9874
SITL: convert to double precision for positions
2021-06-24 21:34:30 +10:00