Commit Graph

29105 Commits

Author SHA1 Message Date
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
b429bb7b98 Filter: clarify meaning of 1st harmonic 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
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
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
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
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
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
Andrew Tridgell
bbd250a5c9 AP_EFI: added fuel usage integration for Lutan EFI
allows for EFI_COEF1 and EFI_COEF2 to be set to get fuel consumption
on GCS
2022-05-19 17:09:45 +10:00
Andrew Tridgell
29915f83c9 AP_Mission: improved handling of large LOITER_TURNS
instead of wrapping we should use MIN with 255, which is closer to
what was requested
2022-05-19 17:09:45 +10:00
Joshua Henderson
811aeed7ed AP_Airspeed: remove negative pressure set unhealthy 2022-05-10 16:59:04 +10:00
Andrew Tridgell
f7360ade04 hwdef: added FlyingMoonF427 support 2022-05-09 07:27:10 +10:00
Andrew Tridgell
6a55d081a7 hwdef: added FlyingMoonF407 board support 2022-05-09 07:27:04 +10:00
Andrew Tridgell
bdc900495c HAL_ChibiOS: fixed RSSI from IOMCU analog pin 103
need to check new pin not old pin
2022-05-08 20:35:25 +10:00
Andrew Tridgell
24234865e5 AP_Logger: fixed a bug in wrapped log count
fixes #20687
2022-05-06 06:56:56 +10:00
Andrew Tridgell
d90b5a22bb AP_AHRS: fixed bug in blended EKF bias
The bug fix in #20431 was incomplete, and ended up with the wrong
blended accel bias. This fixes it
2022-05-04 10:33:17 +10:00
Andrew Tridgell
86e65f850e AP_Scripting: added quicktune.lua script
rapid tuning for VTOL control
2022-05-04 10:33:17 +10:00
Andrew Tridgell
89b9b231f5 AP_Scripting: added get_rpy_srate binding
and norm_input_dz binding
2022-05-04 10:33:17 +10:00
Andrew Tridgell
779d2181c5 AC_AttitudeControl: added get_rpy_srate() 2022-05-04 10:33:17 +10:00
Andrew Tridgell
6d264497e9 AP_Compass: fixed custom orientation in 3 compass drivers
this prevents an internal error and mag failure with DroneCAN, MSP or
ExternalAHRS compasses
2022-05-04 10:33:17 +10:00
Andy Piper
99a9c6edd7 AP_InertialSensor: move frontend update into ramfunc. 2022-04-28 12:56:34 +10:00
Andy Piper
94737870e0 AP_FlashIface: make sure XIP flash is ready before returning 2022-04-28 12:56:34 +10:00
Andy Piper
0afaaf9a53 AP_HAL_ChibiOS: add I2C and compass backend to drivers in memory on H750
move more of EKF into memory on H750
move rc handling into memory on H750
disable double math on SPRacing H7
2022-04-28 12:56:34 +10:00
Randy Mackay
6d6aa27b2a AP_Arming: add pre-arm check of disabled servo channels 2022-04-28 12:56:34 +10:00
Andy Piper
c08f9f7945 SRV_Channel: observe disabled_channels when enabling channels
setup disabled_channels observing channels that are implied to be digital
allow none to be a valid channel function once again
2022-04-28 12:56:34 +10:00
Andy Piper
5a5461825b AP_HAL_ChibiOS: determine presence of disabled channels based on digital channels in a group 2022-04-28 12:56:34 +10:00
Andy Piper
4e487c9198 AP_HAL: add accessor for disabled channels to RCOutput 2022-04-28 12:56:34 +10:00
Andy Piper
9c12221c89 AP_BLHeli: keep a record of disabled motors 2022-04-28 12:56:34 +10:00
Bill Geyer
6e3f1918c2 AC_AutoTune: fix gain determination fail logic 2022-04-28 12:56:34 +10:00
Bill Geyer
aaa64a067a AC_AutoTune: use failed state to exit 2022-04-28 12:56:34 +10:00
Bill Geyer
a7511c3d3a AC_AutoTune: use generic load gain method to save flash 2022-04-28 12:56:34 +10:00
Andy Piper
5dc81972f9 AP_HAL_ChibiOS: bdshot version of MatekF765-Wing 2022-04-28 12:56:34 +10:00
Andy Piper
b2f201b6c3 AP_HAL_ChibiOS: use narrower bitwidths for dshot and LEDs to allow more accurate prescaler calculation 2022-04-28 12:56:34 +10:00
Andy Piper
48e0efaddb AP_HAL: update prescaler tests 2022-04-28 12:56:34 +10:00
Randy Mackay
ae287381ba AP_RPM: pre-arm displays gpio vs servo_ch conflict 2022-04-28 12:56:34 +10:00
Randy Mackay
fd13965226 AP_Relay: pre-arm displays gpio vs servo_ch conflict 2022-04-28 12:56:34 +10:00
Randy Mackay
320cb974a5 AP_Button: pre-arm displays gpio vs servo_ch conflict 2022-04-28 12:56:34 +10:00
Randy Mackay
7c7121f4bd AP_HAL: add GPIO::pin_to_servo_channel method 2022-04-28 12:56:34 +10:00
Randy Mackay
64520e3c59 AP_HAL_ChibiOS: GPIO comment removes mention of BRD_PWM_COUNT 2022-04-28 12:56:34 +10:00
Randy Mackay
79e73e1683 AP_IOMCU: valid_GPIO_pin checks if pin configured for GPIO 2022-04-28 12:56:34 +10:00
Randy Mackay
892cea622f AP_IOMCU: convert_pin_number leaves input untouched on failure 2022-04-28 12:56:34 +10:00
Randy Mackay
0b18622e59 AP_RPM: avoid attach interrupt retry and spam to GCS if PIN = -1 2022-04-28 12:56:34 +10:00
xianglunkai
304a40d3b7 AP_Proximity_Boundary_3D:correction of miswriting 2022-04-28 12:56:34 +10:00
Andrew Tridgell
656e699be4 AP_Logger: removed annoying message on missing logs 2022-04-28 12:56:34 +10:00
Andrew Tridgell
f9765a98ff AP_Logger: fixed log listing with gap, and EKF error on log list
this fixes two issues:

The first issue that if we are missing a log file in the middle of the
list then it was not possible to download recent logs, as we get the
incorrect value for total number of logs. This happened for me with
107 logs, with log62 missing from the microSD. It would only show 45
available logs, so the most recent logs could not be downloaded.

The second issue is that get_num_logs() was very slow if there were a
lot of log files in a directory. This would cause EKF errors and ESC
resets. Using a opendir/readdir loop is much faster (approx 10x faster
in my testing with 107 logs on a MatekH743).
2022-04-28 12:56:34 +10:00
xianglunkai
1444aeadf0 AP_Logger: must set default fd = -1 2022-04-28 12:56:34 +10:00
Andrew Tridgell
84ade3a93b SITL: update for changed INS_NOTCH parameter name 2022-04-28 12:56:34 +10:00
Andrew Tridgell
57bcde4437 AP_HAL_ChibiOS: update for changed INS_NOTCH parameter name 2022-04-28 12:56:34 +10:00
Andrew Tridgell
dcda807464 AP_InertialSensor: move INS_HNTC2 to a new parameter table ID 2022-04-28 12:56:34 +10:00
QioTek
7e00f1c7e0 AP_HAL_ChibiOS: ICM4 series sensors as an alternative with IMU3.
AP_HAL_ChibiOS:  ICM4 series sensors as an alternative with IMU3.
2022-04-28 12:56:34 +10:00
mateksys
e668601ed6 AP_HAL_ChibiOS:add icm42688p as substitution 2022-04-28 12:56:34 +10:00
Andrew Tridgell
0ac673a71c AP_Scripting: increase default heap size in SITL and on F7/H7
if we have 500k or more memory then use 100k heap for Lua, making
setup easier
2022-04-28 12:56:34 +10:00
Andrew Tridgell
ebb352cf82 AC_AttitudeControl: use deadzone for pitch
when pitch for nose-in and tail-in is enabled we should use the
deadzone
2022-04-28 12:56:34 +10:00
Andrew Tridgell
dbab0562d7 AC_AttitudeControl: added an option for pitch weathervaning
when nose-in or tail-in, if the aircraft has significant pitch
asymmetry in hover then we would spin around in no wind if we use
pitch as an input

this makes pitch input for nose-in and tail-in optional and off by
default to preserve existing behaviour
2022-04-28 12:56:34 +10:00
Andrew Tridgell
da2cb552fc HAL_ChibiOS: disable fatal exceptions for DMA errors
this zeros-watchdog was caused by a SPI DMA error on STM32F405:

  https://discuss.ardupilot.org/t/crash-with-4-2-0-beta-and-4-3-0-daily-bdshot/83297

we had incorrectly left these internal errors enabled when asserts
were not enabled. That led to a osalSysHalt()

without these we get an spi_fail internal error, caught by the
SPIDevice code
2022-04-28 12:56:34 +10:00
Andrew Tridgell
3e87782cc0 AP_InertialSensor: catch FIFO overruns on BMI088
we have seen errors where the BMI088 gets out of sync, so that the 3
axes are rotated. The data is shifted by 4 bytes, so that X=Z, Y=X
and Z=Y

this changes the BMI088 to "stop on full" mode, which is what Bosch
use in their example drivers, and also catches FIFO overrun events and
triggers a full FIFO reset. This should fix the problem with the FIFO
sync
2022-04-28 12:56:34 +10:00
李孟晓
876a9f3d5e AP_HAL_ChibiOS: CUAV-Nora: add usart3 support 2022-04-07 10:05:28 +10:00
Andy Piper
f51b5dab84 AP_HAL_ChibiOS: fix dshot timeout bug where the elapsed pulse is longer than the send time
dshot timeouts should be no longer than the pulse interval
use correct timestamp for dmar send time
2022-04-07 10:05:28 +10:00
Andrew Tridgell
11637e784f HAL_ChibiOS: incorrect class of class in uart TX timeout
need to call chEvtGetAndClearEventsI() as we are in a system lock
state
2022-04-07 10:05:28 +10:00
Andrew Tridgell
f64beea5ee HAL_ChibiOS: fixed H7 flash storage
this fixes the flash re-init problem when flash storage fills on
H7. It was caused by rejecting writes where one or more of the 32 byte
chunks was not all 0xff but was equal to the current data. That
happens when writing to the sector header in AP_FlashStorage

it also moves the interrupt disable inside the loop to allow for
other interrupts to run between blocks
2022-04-07 10:05:28 +10:00
Andrew Tridgell
f4826ac38a HAL_ChibiOS: use 16 byte lines for flash storage on H7
this halves the number of flash writes needed, and makes flash storage
twice as space efficient on H7

On H7 we need to write 32 bytes at a time to flash, which corresponds
to 30 bytes of data in AP_FlashStorage. By using a 16 byte storage
line we don't waste as much space
2022-04-07 10:05:28 +10:00
Andrew Tridgell
a91b6ec28e HAL_ChibiOS: increase monitor thread stack by 512
this is needed to ensure that the log writes of MON and WDOG don't
overflow monitor thread stack
2022-04-07 10:05:28 +10:00
Andrew Tridgell
90751168c7 HAL_ChibiOS: added expected delays on flash writes
this prevents a long loop internal error on disarm after a large
amount of flash writes when armed on a board with flash storage
2022-04-07 10:05:28 +10:00
Andrew Tridgell
20ecc03886 HAL_ChibiOS: disable interrupts during flash operations
we have now shown that interrupts being enabled during flash
operations can cause the infamous "68ms" bug, or watchdog when using a
32 bit timer on boards using flash for storage

The issue is quite repeatable with a load of a very large waypoint
file (over 500 waypoints) using "wp ftpload" in MAVProxy. This puts a
huge load on flash storage.

Our current working theory is that while doing flash writes for
storage on dual-bank we block access to only one bank, so if another
thread uses a timeout function with a short timeout while the flash
write is happening and chVTDoTickI calls code which crosses the flash
bank boundary then it can cause chVTDoTickI to violate the assumption
that no more than CH_CFG_ST_DELTA ticks pass while it is calculating
the value to set in the system timer. In that case we get a delay of a
full timer wrap, which is 68ms on boards with 16 bit timer and 70
minutes on boards with 32 bit timer
2022-04-07 10:05:28 +10:00
Andrew Tridgell
92299ffdf4 Revert "hwdef: changed MatekH743 to a 32 bit timer"
This reverts commit 7dc5911572.
2022-04-07 10:05:28 +10:00
Andrew Tridgell
2d0dc2b1fc HAL_ChibiOS: constrain more timer timeouts 2022-04-07 10:05:28 +10:00
Andrew Tridgell
8055ba9837 HAL_ChibiOS: prevent long timeouts in DShot
this prevents bad calculated timeouts in DShot. The timeout would
sometimes come out as 0xFFFFFFFF, which led to an assert and could
block the thread

This fix is meant to be minimilistic to allow it to be merged easily
into 4.2. A better fix would fix all the uint32_t wrap handling in
DShot
2022-04-07 10:05:28 +10:00
Andrew Tridgell
061b0580b3 AP_Math: added unsigned versions of constrain functions
sometimes it really does matter that we use constrain_uint32() instead
of constrain_int32(). For example, if we have a value like 0xFFFFFFFF
then the result will be very different

we should use unsigned constrain when dealing with unsigned values
2022-04-07 10:05:28 +10:00
Andrew Tridgell
a661f3e7a7 AP_Logger: fixed @SYS file logging
the key fix is the reset of the fd to -1. Without that fix we only
ever log @SYS/uarts.txt

The timing change is needed to get the files out in a reasonable
time. The function is actually getting called at 100Hz or less, not
1kHz (measured on MatekH743 copter at 400Hz). So we need to run it
faster to get the files logged in a reasonable time
2022-04-07 10:05:28 +10:00
Andy Piper
0da6b97485 AP_HAL_ChibiOS: spro H7 extreme updates.
cannot currently use both IMUs on spro H7 extreme due to CPU load
2022-04-07 10:05:28 +10:00
Peter Barker
6a21152b67 AP_AHRS: subtract accel bias from correct ins accel instance
In the case that you have INS_USE indicating IMUs should be used, but
EK3_IMU_MASK leaving some IMUs unused, we subtract the bias from the
wrong INS data
2022-04-07 10:05:28 +10:00
Andrew Tridgell
283742edf1 AP_Logger: increase stack of log_io thread by 256
This was seem on omnibusf4pro, it is a bit too close:

  log_io PRI= 59 sp=0x20015CC0 STACK=144/1656
2022-04-07 10:05:28 +10:00
Bill Geyer
559f90b814 AP_Math: add chirp function to support frequency sweeps in systemid and autotune 2022-04-07 10:05:28 +10:00
Bill Geyer
250782c7f8 AC_Autotune: clean up variable init for dwell 2022-04-07 10:05:28 +10:00
Bill Geyer
61222462b3 AC_AutoTune: use chirp function in AP_Math for frequency sweeps 2022-04-07 10:05:28 +10:00
Bill Geyer
80aed73632 AC_AutoTune: combine dwell_run_test for angle and rate 2022-04-07 10:05:28 +10:00
Bill Geyer
0846880049 AC_AutoTune: combine dwell_init methods 2022-04-07 10:05:28 +10:00
Bill Geyer
3a6c5b27f6 AC_AutoTune:tradheli-streamline gcs messages 2022-04-07 10:05:28 +10:00
Peter Barker
c33256b3c2 AC_AutoTune: Vector tidying 2022-04-07 10:05:28 +10:00
Peter Barker
a0aa04efcc AC_AutoTune_Heli: use structure assignment to clear structures 2022-04-07 10:05:28 +10:00
Peter Barker
225112045c AC_AutoTune: use structure assignment for test results 2022-04-07 10:05:28 +10:00
Peter Barker
3886f88b8c AC_AutoTune: createstructure to hold specific test's sweep results 2022-04-07 10:05:28 +10:00
Henry Wurzburg
a0c286a8ed HWDEF: add SLCAN OTG port, correct defaults.param errors 2022-04-07 10:05:28 +10:00
Andy Piper
89c8057e98 AP_HAL_SITL: correct disable channel maths
unilaterally write rcoutput to appease the sitl gods
2022-04-07 10:05:28 +10:00
Andy Piper
de526b07dc SRV_Channel: don't count disabled channels in mask and setup functions
disable channels that are not in use
2022-04-07 10:05:28 +10:00
Andy Piper
f7624662b7 AP_HAL_ChibiOS: fix ESCs constantly arming on rover with dshot commands
make sure debug will compile
take into account active channels when configuring bdshot
add channel mask debug output
correct set bdshot telemetry position at startup
make sure all channels in a bdshot group are pulled high to prevent spurious pulses
2022-04-07 10:05:28 +10:00
AndKe
0451c405b4 AP_HAL_ChibiOS: add OREOLED to CubeGreen 2022-04-07 10:05:28 +10:00
Andrew Tridgell
3487f8f251 hwdef: changed MatekH743 to a 32 bit timer
the 68ms issue is still present on this board. Switching to a 32 bit
timer will fix it, but loses us the tonealarm support
2022-03-28 20:53:56 +11:00
Andrew Tridgell
43df023a4d AP_Param: fixed param class conversion code
param class conversion was unconditionally overwriting the parameter
from the old parameter. This meant if the user has set a value in an
old firmware they could not change it in a new firmware.

I hit this with ARSPD_TYPE. I had previously set this to 0 in a
previous use of the board, and found that it kept resetting to 0 on
the new firmware when I tried to enable airspeed
2022-03-28 20:53:56 +11:00
Andrew Tridgell
739192f579 AP_Logger: added terrain correction logging field 2022-03-28 20:53:56 +11:00
Andrew Tridgell
76a924559b AP_Terrain: added logging of terrain correction 2022-03-28 20:53:56 +11:00