Commit Graph

26501 Commits

Author SHA1 Message Date
Randy Mackay f3c25397c7 AC_WPNav: get_terrain_offset and get_vector_NEU made public 2021-07-22 19:07:36 +09:00
Leonard Hall ec53ea7f8e AC_WPNav: move code to generate terrain following kinematic path 2021-07-22 19:07:36 +09:00
Leonard Hall b6b4d9869c AC_AttitudeControl: AC_PosControl: Support Accel only input 2021-07-22 19:07:36 +09:00
Leonard Hall 91e22680a5 AC_AttitudeControl: AC_PosControl: Change input_pos_xyz name 2021-07-22 19:07:36 +09:00
Andrew Tridgell aa4bbdfce1 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 19:07:36 +09:00
Andy Piper e0bd344582 AP_HAL_ChibiOS: re-enable LEDs on MatekF405-bdshot 2021-07-22 19:07:36 +09:00
Randy Mackay e139bfa1b8 AP_NavEKF3: EK3_RNG_USE_HGT param references EK3_SRCx_POSZ 2021-07-22 19:07:36 +09:00
Andrew Tridgell f8e23f5d3d AP_Common: update tests for 4.1 2021-07-22 19:07:36 +09:00
Andrew Tridgell 7e069b40eb HAL_ChibiOS: raise DMA contention threshold for H7 2021-07-22 19:07:36 +09:00
Andrew Tridgell a81ef9c272 AP_SerialManager: document DisableFIFO bit 2021-07-22 19:07:36 +09:00
Andrew Tridgell fcc9e4627c AP_SerialManager: call set_options() before first UART use
this ensures options are set before the first begin() call
2021-07-22 19:07:36 +09:00
Andrew Tridgell 126d5a8d23 HAL_ChibiOS: implement NOFIFO option for uarts 2021-07-22 19:07:36 +09:00
Andrew Tridgell ae3b21b28a AP_HAL: added serial option for disabling FIFO on uarts 2021-07-22 19:07:36 +09:00
Andrew Tridgell 9a469bdaa9 AP_Math: fixed build 2021-07-22 19:07:36 +09:00
Andrew Tridgell d3163c8f48 HAL_SITL: update for changed SITL API 2021-07-22 19:07:36 +09:00
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
Andrew Tridgell 1d00cab9e6 AC_WPNav: convert circle, loiter and WPNav to double position 2021-06-24 21:34:30 +10:00
Andrew Tridgell 66186e5221 AC_AttitudeControl: convert poscontrol to use double position 2021-06-24 21:34:30 +10:00
Andrew Tridgell c8079a318c AC_PID: convert AC_P_2D to double 2021-06-24 21:34:30 +10:00
Andrew Tridgell 9b91cfe4ee AP_Math: implement double versions of some position control methods 2021-06-24 21:34:30 +10:00
Andrew Tridgell 3a3a30ab22 AP_Math: define postype_t and vectors 2021-06-24 21:34:30 +10:00
Andrew Tridgell 3fc88b19b8 HAL_SITL: implement initial GPS position offsets 2021-06-24 21:34:30 +10:00
Andrew Tridgell 3315ec5acc AP_Math: added tofloat() and todouble() methods to Vector2 and Vector3 2021-06-24 21:34:30 +10:00
Andrew Tridgell cf149a9d18 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-06-24 21:34:30 +10:00
Andrew Tridgell 7819cc6400 AC_AttitudeControl: cleanup poscontrol comments with input from Leonard 2021-06-24 20:28:45 +10:00
Andrew Tridgell 639570505b AP_Math: cleanups from Leonards feedback 2021-06-24 20:28:45 +10:00
Andrew Tridgell 5f053bd53a AC_AttitudeControl: fixed comment 2021-06-24 20:28:45 +10:00
Andrew Tridgell 566dd8ca8b AP_Math: cleanup API comments on control code 2021-06-24 20:28:45 +10:00
Andrew Tridgell bf91168cd6 AC_WPNav: cleanup position control APIs
use Vector2 for xy, float for z
2021-06-24 20:28:45 +10:00
Andrew Tridgell fd68233fed AC_AttitudeControl: cleanup position control APIs
use Vector2 for xy, float for z
2021-06-24 20:28:45 +10:00
Andrew Tridgell 86f09cad09 AP_Math: cleanup position control APIs
use Vector2 for xy, float for z
2021-06-24 20:28:45 +10:00
Andrew Tridgell fe4abc521a AP_Math: make vector3 xy() method return a reference 2021-06-24 20:28:45 +10:00
Siddharth Purohit 43bb543aff AP_PiccoloCAN: fix missing _telem_sem 2021-06-24 17:15:08 +10:00
Oliver 9aba85dadc AP_PiccoloCAN: Explicit initialization of AP_HAL::CANFrame instances 2021-06-24 15:51:21 +10:00
Oliver dade859ff9 AP_PiccoloCAN: Remove unncessary floating point operations 2021-06-24 15:51:21 +10:00
Oliver 06eb844ede AP_PiccoloCAN: Update code to match new esc telemetry / logging architecture 2021-06-24 15:51:21 +10:00
Oliver Walters de3c4cc9da AP_PiccoloCAN: Increase number of supported channels from 12 -> 16 2021-06-24 15:51:21 +10:00
Oliver Walters fb16b085c0 AP_PiccoloCAN: Record servo telemetry information to log
- Servo position
- Servo speed
- Servo force / torque
- Servo duty cycle

Updated servo protocol file to accommodate extra variable data
2021-06-24 15:51:21 +10:00
Oliver Walters 115c1224de AP_PiccoloCAN: Send servo commands for active channels
- For each channel, check if a non-motor function is assigned
- If so, send the function value out to the servo
2021-06-24 15:51:21 +10:00
Oliver Walters 7b0da02a18 AP_PiccoloCAN: Framework for CAN servo outputs 2021-06-24 15:51:21 +10:00
Oliver Walters 43b7b4eb3b AP_PiccoloCAN: Add support for CBS servo protocol
- Adds protocol files for the servo protocol
- Generated using Protogen tool
2021-06-24 15:51:21 +10:00
Siddharth Purohit 9494a439ec AP_UAVCAN: Use HAL_ENABLE_LIBUAVCAN_DRIVERS instead of HAL_MAX_CAN_PROTOCOL_DRIVERS 2021-06-24 09:02:42 +10:00
Siddharth Purohit 69cc0b4615 SRV_Channel: Use HAL_CANMANAGER_ENABLED instead of HAL_ENABLE_LIBUAVCAN_DRIVERS 2021-06-24 09:02:42 +10:00
Siddharth Purohit 02c74a8fa1 GCS_MAVLink: Use HAL_CANMANAGER_ENABLED instead of HAL_ENABLE_LIBUAVCAN_DRIVERS 2021-06-24 09:02:42 +10:00
Siddharth Purohit 5d8a6d167f AP_ToshibaCAN: Use HAL_CANMANAGER_ENABLED instead of HAL_ENABLE_LIBUAVCAN_DRIVERS 2021-06-24 09:02:42 +10:00
Siddharth Purohit 0795225475 AP_RangeFinder: Use HAL_CANMANAGER_ENABLED instead of HAL_ENABLE_LIBUAVCAN_DRIVERS 2021-06-24 09:02:42 +10:00
Siddharth Purohit 6d8972e63b AP_PiccoloCAN: Use HAL_CANMANAGER_ENABLED instead of HAL_ENABLE_LIBUAVCAN_DRIVERS 2021-06-24 09:02:42 +10:00
Siddharth Purohit 895039cdce AP_Notify: Use HAL_CANMANAGER_ENABLED instead of HAL_ENABLE_LIBUAVCAN_DRIVERS 2021-06-24 09:02:42 +10:00
Siddharth Purohit 1a2c51d6df AP_KDECAN: Use HAL_CANMANAGER_ENABLED instead of HAL_ENABLE_LIBUAVCAN_DRIVERS 2021-06-24 09:02:42 +10:00
Siddharth Purohit 81f6e3c585 AP_HAL_SITL: Use HAL_CANMANAGER_ENABLED instead of HAL_ENABLE_LIBUAVCAN_DRIVERS 2021-06-24 09:02:42 +10:00
Siddharth Purohit 35344d1aef AP_HAL_Linux: Use HAL_CANMANAGER_ENABLED instead of HAL_ENABLE_LIBUAVCAN_DRIVERS 2021-06-24 09:02:42 +10:00