Leonard Hall
3f33ac0a82
AC_AttitudeControl: Fix Angle Vel units on function
2021-08-14 16:41:52 +10:00
Leonard Hall
b1cd9434a9
AP_Hal_ChibiOS: Skyviper Parameters PSC_VELXY_FLTE
2021-08-14 16:41:52 +10:00
Leonard Hall
0d52cd4aeb
AC_AttitudeControl: AC_PosControl: fix PID filter names FILT -> FLTE, D_FILT -> FLTD
2021-08-14 16:41:52 +10:00
Leonard Hall
a9fb5ceb5c
AC_PID: fix PID filter names FILT -> FLTE, D_FILT -> FLTD
...
Follow used guided but references the maximum velocity settings. As Guided does not set maximum velocities these values come back as zero. So we need to reference WP_Nav to get safe maximums.
2021-08-14 16:41:52 +10:00
Andrew Tridgell
a7c3b2244a
AP_GPS: added doc message for bit 2 of DRV_OPTIONS
2021-08-14 16:41:52 +10:00
Andrew Tridgell
96580ee4f3
AP_GPS: added GPS_DRV_OPTIONS bit for forcing ublox GPS to 115200
...
this may help with some GPS modules
2021-08-14 16:41:52 +10:00
Andy Piper
150290dd25
AP_HAL_ChibiOS: probe for compasses on FlywooF745
2021-08-14 16:41:52 +10:00
Randy Mackay
c1b67d295f
AP_NavEKF3: skip GSF reset count check if source actively changed
...
also only fail all compass on emergency reset
2021-08-14 16:41:52 +10:00
Andrew Tridgell
ae725421bc
AP_NavEKF3: fixed output LLH to account for IMU offset
...
thanks to Paul and Randy
2021-08-14 16:41:52 +10:00
Leonard Hall
628206b5e8
AC_AttitudeControl: Support thrust to weight of 10:1
2021-08-14 16:41:52 +10:00
Andy Piper
a1f0ad63a9
AP_Motors: remove tri yaw servo from motor mask
2021-08-14 16:41:52 +10:00
Andrew Tridgell
9ed2e35229
AP_GPS: added arming checks for yaw available on ublox RTK rover
2021-08-14 16:41:52 +10:00
bugobliterator
c539fe9bc2
AP_RangeFinder: use separate register_driver method while contructing CAN Driver
2021-08-14 16:41:52 +10:00
bugobliterator
97a04c85f0
AP_EFI: use separate register_driver method while contructing CAN Driver
2021-08-14 16:41:52 +10:00
bugobliterator
36b3fcc1a0
AP_BattMonitor: use separate register_driver method while contructing CAN Driver
2021-08-14 16:41:52 +10:00
bugobliterator
b6a86533fc
AP_CANSensor: create a separate register driver method
2021-08-14 16:41:52 +10:00
Andrew Tridgell
6609faff9e
APM_Control: new autotune scheme
...
this separately tunes D and then P, which more closely follows the
technique used for a manual tune
2021-07-25 09:30:25 +10:00
Andrew Tridgell
c63548a5f3
AP_Math: fixed expo_curve()
...
doesn't make sense as constexpr
2021-07-25 09:30:25 +10:00
Andrew Tridgell
506e03251a
AP_AHRS: build fix
2021-07-25 09:30:25 +10:00
Paul Riseborough
998cad030e
AP_NavEKF3: Revert IMU and wind speed process noise parameter defaults
...
These give noisier state estimates, but are more robust to rapid changes in IMU biases.
TODO implement a means of using the modified parameters when there are more than one EKF instance running with IMU's that are sampling at a higher rate.
2021-07-25 09:30:25 +10:00
Paul Riseborough
73229371c7
AP_NavEKF3: retune wind process noise for better airspeed fault detection
2021-07-25 09:30:25 +10:00
Paul Riseborough
8744b0954f
AP_NavEKF3: Fix bug preventing copter wind estimation at low speed
...
Also re-tunes process noise default for smoother wind velocity state estimates.
2021-07-25 09:30:25 +10:00
Paul Riseborough
6637d9dece
AP_NavEKF3: Revert EK3_BETA_MASK parameter extension
...
These are not required due to use of bit 7 in FLIGHT_OPTIONS to achieve the same function.
2021-07-25 09:30:25 +10:00
Paul Riseborough
1d3ed8e9da
AP_NavEKF3: Rework non-airspeed wind estimation
...
Faster wind estimation when not using airspeed with acceptable noise in wind velocity estimates.
2021-07-25 09:30:25 +10:00
Paul Riseborough
fb6de9ad9d
AP_NAvEKF3: use #define value for bad IMU hold time
2021-07-25 09:30:25 +10:00
Paul Riseborough
ca00da81cd
AP_NavEKF3: Increase lower state variance limit when vibration affected
...
This makes state corrections from GPS and baro observations more aggressive
2021-07-25 09:30:25 +10:00
Paul Riseborough
c3f38ec159
AP_NavEKF3: Use sensor variance when checking for bad IMU
2021-07-25 09:30:25 +10:00
Paul Riseborough
00b91b4799
AP_NavEKF3: Make bad IMU status more persistent
2021-07-25 09:30:25 +10:00
Paul Riseborough
14c2bb0c9b
AP_AHRS: Add accessor function for vibration affected status
...
AP_AHRS: fix rebase build error
2021-07-25 09:30:25 +10:00
Paul Riseborough
fdea45a3e4
AP_NavEKF3: Add accessor function for vibration affected status
2021-07-25 09:30:25 +10:00
Paul Riseborough
ace601f1dd
AP_NavEKF3: Don't update accel bias states if vibration affected
2021-07-25 09:30:25 +10:00
Paul Riseborough
8b16d8dc4c
AP_NavEKF3: Use large accel process noise when IMU data is bad
2021-07-25 09:30:25 +10:00
Paul Riseborough
eb5a82dd38
AP_NavEKF3: Adjust gyro bias process noise tuning
...
NEw value is a compromise between roll/pitch angle and horizontal state velocity estimation errors and the noise in the gyro bias estimate
2021-07-25 09:30:25 +10:00
Paul Riseborough
942a1f329f
AP_NavEKF3: Allow smaller dvel bias state variances for improved tuning
2021-07-25 09:30:25 +10:00
Paul Riseborough
ffce6fab70
AP_NavEKF3: Retune IMU process noise
...
Required to achieve equivalent fusion noise and weighting on IMU vs other sources to previous param defaults with the old covariance prediction equations.
2021-07-25 09:30:25 +10:00
Paul Riseborough
77082e414b
AP_NavEKF3: Make gyro bias learning less noisy
2021-07-25 09:30:25 +10:00
Paul Riseborough
a32fd0a97c
AP_NavEKF3: Fix bug preventing learning of XY IMU dvel bias in flight
2021-07-25 09:30:25 +10:00
Paul Riseborough
90a8dc48d1
AP_NavEKF3: Change powf(x,2) to sq(x)
2021-07-25 09:30:25 +10:00
Paul Riseborough
bb88aef1b3
AP_NavEKF3: Update covariance prediction equations
2021-07-25 09:30:25 +10:00
Paul Riseborough
b6a2f4b4f5
AP_NavEKF3: Use alternate form for quaternion to rotmat equations in derivation
2021-07-25 09:30:25 +10:00
Andrew Tridgell
36174d198f
AP_Math: fix uses of single precision
2021-07-22 16:01:01 +10:00
Randy Mackay
b375fe291f
AR_WPNav: integrate PathPlanner returning path_planner_used
...
Rover does not need to handle the results differently based on the planner used
2021-07-22 16:01:01 +10:00
Randy Mackay
6dd100df7b
AC_WPNav_OA: minor formatting and comment fixes
2021-07-22 16:01:01 +10:00
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