Commit Graph

52504 Commits

Author SHA1 Message Date
Andrew Tridgell
0f230ee4c6 AP_InertialSensor: call notch param update with semaphore held 2022-06-17 14:07:00 +10:00
Andrew Tridgell
c06f69e77d AP_GyroFFT: added defaults for FFT with no notch
allow for testing with FFT enabled, and defaulting number of
frequencies to look for
2022-06-17 14:07:00 +10:00
Andrew Tridgell
85db0c498b AP_InertialSensor: fixed the last notch values to be per-instance
thanks to Andy for noticing this
2022-06-17 14:07:00 +10:00
Andrew Tridgell
a6dd296cc8 AP_GyroFFT: skip disabled notches 2022-06-17 14:07:00 +10:00
Andrew Tridgell
7b08a6c00c AP_InertialSensor: don't update disabled notches 2022-06-17 14:07:00 +10:00
Andrew Tridgell
66ad3051c3 AP_GyroFFT: allow for 2 FFT based notches 2022-06-17 14:07:00 +10:00
Andrew Tridgell
975fc6b70d AP_Vehicle: implement common harmonic notch update code 2022-06-17 14:07:00 +10:00
Andrew Tridgell
5f2cc8960d Plane: moved harmonic notch update code to AP_Vehicle 2022-06-17 14:07:00 +10:00
Andrew Tridgell
2a5d662d84 Copter: moved harmonic notch update code to AP_Vehicle 2022-06-17 14:07:00 +10:00
Andrew Tridgell
f8c1c39868 AP_RPM: use HarmonicNotch class 2022-06-17 14:07:00 +10:00
Andrew Tridgell
5080c32197 AP_GyroFFT: use HarmonicNotch class 2022-06-17 14:07:00 +10:00
Andrew Tridgell
d893d9bc89 AP_Arming: use HarmonicNotch class 2022-06-17 14:07:00 +10:00
Andrew Tridgell
e799649e6c AP_InertialSensor: switch to HarmonicNotch class
this makes the logic much easier to follow, without indexes into
arrays
2022-06-17 14:07:00 +10:00
Andrew Tridgell
1de23e564e Filter: removed parameters from the old notch filter
saves some flash space
2022-06-17 14:07:00 +10:00
Andrew Tridgell
e763386651 AP_GyroFFT: only allow one harmonic notch filter to be linked to FFT 2022-06-17 14:07:00 +10:00
Andrew Tridgell
0467c1aef6 AP_Arming: added arming check for conflicting notch modes 2022-06-17 14:07:00 +10:00
Andrew Tridgell
a23a25f6b3 Plane: param conversion for INS_NOTCH to INS_HNTC2 2022-06-17 14:07:00 +10:00
Andrew Tridgell
b429bb7b98 Filter: clarify meaning of 1st harmonic 2022-06-17 14:07:00 +10:00
Andrew Tridgell
5e1489eeff Plane: support harmonic notch on 2nd RPM sensor 2022-06-17 14:07:00 +10:00
Andrew Tridgell
711ec6ce70 Copter: support harmonic notch on 2nd RPM sensor 2022-06-17 14:07:00 +10:00
Andrew Tridgell
559f4c00c3 Filter: added RPM2 harmonic notch type 2022-06-17 14:07:00 +10:00
Andrew Tridgell
a617057f36 Copter: update for changed INS_NOTCH parameter name 2022-06-17 14:07:00 +10:00
Andrew Tridgell
e894dfe339 Plane: support two full harmonic notch filters 2022-06-17 14:07:00 +10:00
Andrew Tridgell
4c5ea5dfdf Copter: support two full harmonic notch filters 2022-06-17 14:07:00 +10:00
Andrew Tridgell
f9de6dff1c AP_Vehicle: support two full harmonic notch filters 2022-06-17 14:07:00 +10:00
Andrew Tridgell
3d025a7c5c AP_RPM: support two full harmonic notch filters 2022-06-17 14:07:00 +10:00
Andrew Tridgell
25d00e433e AP_InertialSensor: support two full harmonic notch filters 2022-06-17 14:07:00 +10:00
Andrew Tridgell
54a5bd007d Plane: prepare for 4.2.1 release 2022-05-23 17:36:17 +10:00
Andrew Tridgell
b8ed81ca5f Plane: release notes for 4.2.1 2022-05-23 17:35:21 +10:00
Andrew Tridgell
031f69df15 Plane: fixed false positive in landing detector
this fixes a case where we can get false positive on the landing
detector for quadplanes.

The issue happens if we cross the LAND_DESCEND to LAND_FINAL threshold
while pilot repositioning is active, with stale information in
landing_detect.lower_limit_start_ms as we don't run should_relax() in
LAND_DESCEND
2022-05-23 17:35:21 +10:00
Andrew Tridgell
2d0cfb3fad AP_BoardConfig: expose BRD_SAFETYENABLE on all boards
default BRD_SAFETYENABLE to 0 on boards with no safety switch, which
gives us the same behaviour as before, but users can choose to enable
the safety

this fixes two problems:

  - CAN servos and ESCs work on boards with no safety switch
    (eg. MatekH743 with CAN)

  - during startup we could get spurious outputs before out aircraft
    type is setup
2022-05-23 17:35:21 +10:00
Andrew Tridgell
9a5e8d3927 HAL_ChibiOS: always start with safety enabled
we want it enabled during early boot to prevent incorrect ESC and
servo output
2022-05-23 17:35:21 +10:00
Andrew Tridgell
bd22f0073c Plane: prepare for 4.2.1beta1 2022-05-19 17:10:04 +10:00
Andrew Tridgell
2fadfa8690 Plane: update release notes for 4.2.1beta1 2022-05-19 17:10:04 +10:00
Andrew Tridgell
d4146a1672 Plane: cope with QGC retrying AUTO mode
QGC tries several times to enter AUTO even when it is refused. We need
to keep refusing
2022-05-19 17:09:45 +10:00
Andrew Tridgell
80c27a426c autotest: don't try to arm in RTL mode for quadplanes 2022-05-19 17:09:45 +10:00
Andrew Tridgell
9f187c0711 AP_UAVCAN: added CAN_Dx_UC_ESC_OF parameter
this allows for an offset in ESC numbering for much more efficient CAN
bandwidth usage.

For example, on a coaxial OctoQuad quadplane the ESCs are typically
setup as outputs 5 to 12. An ideal setup is to split these over 2 CAN
buses, with one CAN bus for the top layer and the one bus for the
bottom layer (allowing for VTOL flight with one bus failed).

Without this offset parameter you would be sending RawCommand messages
like this:

bus1: [ 0, 0, 0, 0, ESC1, ESC2, ESC3, ESC4 ]
bus2: [ 0, 0, 0, 0, 0, 0, 0, 0, ESC1, ESC2, ESC3, ESC4 ]

this is very wasteful of bus bandwidth, with bus1 using 3x the
bandwidth it should and bus2 using 4x the bandwidth it should (the
above will take 3 can frames for bus1, and 4 can frames for bus 2)

With this patch you can set:

CAN_D1_UC_ESC_OF = 4
CAN_D2_UC_ESC_OF = 8

and you will get this on the bus:

bus1: [ ESC1, ESC2, ESC3, ESC4 ]
bus2: [ ESC1, ESC2, ESC3, ESC4 ]

that takes just 1 can frame per send on each bus
2022-05-19 17:09:45 +10:00
Andrew Tridgell
defe800745 Copter: allow VTOL_TAKEOFF and VTOL_LAND as synonyms
this allows is_takeoff_next() to be in common, and reduces confusion
if user selects VTOL_TAKEOFF in a GCS mission editor
2022-05-19 17:09:45 +10:00
Peter Barker
86fd9e112a ArduSub: support *10 multipler when storing/retrieving radius in NAV_LOITER_TURNS 2022-05-19 17:09:45 +10:00
Peter Barker
338ae69f15 ArduCopter: support *10 multipler when storing/retrieving radius in NAV_LOITER_TURNS 2022-05-19 17:09:45 +10:00
Peter Barker
1a4bb9b319 ArduPlane: support *10 multipler when storing/retrieving radius in NAV_LOITER_TURNS 2022-05-19 17:09:45 +10:00
Peter Barker
9cf802c843 AP_Mission: support *10 multipler when storing/retrieving radius in NAV_LOITER_TURNS 2022-05-19 17:09:45 +10:00
Andrew Tridgell
9d0f5ce7b0 AP_Vehicle: added QLAND_INSTEAD_OF_RTL mode reason 2022-05-19 17:09:45 +10:00
Andrew Tridgell
1e31dc61a8 AP_Mission: allow NAV_VTOL_TAKEOFF in is_takoff_next() 2022-05-19 17:09:45 +10:00
Andrew Tridgell
c093c5d945 Plane: increased safety of guided -> auto quadplane takeoff
when we arm in guided mode then enter a special guided_wait_takeoff
state. We keep motors suppressed until one of the following happens

  1) disarm
  2) guided takeoff command
  3) change to AUTO with a takeoff waypoint as first nav waypoint
  4) change to another mode

while in this state we don't go to throttle unlimited, and will refuse
a change to AUTO mode if the first waypoint is not a takeoff. If we
try to switch to RTL then we will instead use QLAND

This state is needed to cope with the takeoff sequence used by QGC on
common controllers such as the MX16, which do this on a "takeoff"
swipe:

  - changes mode to GUIDED
  - arms
  - changes mode to AUTO
2022-05-19 17:09:45 +10:00
Andrew Tridgell
72b5212baf AP_Airspeed: fixed airspeed cal on 2nd airspeed sensor
we need to use the pressure from the sensor we are calibrating
2022-05-19 17:09:45 +10:00
Andrew Tridgell
68a43b3c79 AP_NavEKF: getYawData also provides number of clipping models
In the case of the compass calibrator we do not want to use the GSF
result if any model is degenerate.  We've had a compass calibrate in
flight 180-degrees out from what it should have.
2022-05-19 17:09:45 +10:00
Peter Barker
1764b88624 AP_Compass: do not use GSF if any model has been clipped 2022-05-19 17:09:45 +10:00
Peter Barker
a3edc8588c autotest: adjust current wp reset 2022-05-19 17:09:45 +10:00
Andrew Tridgell
d14897b1b1 autotest: reset mission on takeoff for quadplanes 2022-05-19 17:09:45 +10:00