Commit Graph

29093 Commits

Author SHA1 Message Date
Andrew Tridgell
2f73ce408f AP_Mission: allow NAV_VTOL_TAKEOFF in is_takoff_next() 2022-05-28 16:08:08 +09:00
Andrew Tridgell
8066478679 AP_Airspeed: fixed airspeed cal on 2nd airspeed sensor
we need to use the pressure from the sensor we are calibrating
2022-05-28 16:08:08 +09:00
Andrew Tridgell
4e6f0c0ef4 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-28 16:08:08 +09:00
Peter Barker
5f39602d8c AP_Compass: do not use GSF if any model has been clipped 2022-05-28 16:08:08 +09:00
Andrew Tridgell
1e82319bfa 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-28 16:08:08 +09:00
Andrew Tridgell
6bf9556612 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-28 16:08:08 +09:00
Joshua Henderson
7a2d48389c AP_Airspeed: remove negative pressure set unhealthy 2022-05-28 16:08:08 +09:00
Leonard Hall
0b4b5e473b AC_AttitudeControl: Allow diabling of slew limit 2022-05-16 08:15:26 +09:00
Andrew Tridgell
6b790eaca0 hwdef: added FlyingMoonF427 support 2022-05-16 08:15:26 +09:00
Andrew Tridgell
707bc9502f hwdef: added FlyingMoonF407 board support 2022-05-16 08:15:26 +09:00
Andrew Tridgell
ed18123f95 HAL_ChibiOS: fixed RSSI from IOMCU analog pin 103
need to check new pin not old pin
2022-05-16 08:15:26 +09:00
Andrew Tridgell
bcc548bbd8 AP_Logger: fixed a bug in wrapped log count
fixes #20687
2022-05-16 08:15:26 +09:00
Andrew Tridgell
6332d5972f 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-07 08:40:41 +09:00
Andrew Tridgell
fc999ed264 AP_Scripting: added quicktune.lua script
rapid tuning for VTOL control
2022-05-07 08:40:41 +09:00
Andrew Tridgell
58cdcf6968 AP_Scripting: added get_rpy_srate binding
and norm_input_dz binding
2022-05-07 08:40:41 +09:00
Andrew Tridgell
9f49570f7f AC_AttitudeControl: added get_rpy_srate() 2022-05-07 08:40:41 +09:00
Andrew Tridgell
3c6e4d907c 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-03 10:07:44 +10:00
Andy Piper
05c90c4684 AP_InertialSensor: move frontend update into ramfunc. 2022-04-29 07:54:06 +09:00
Andy Piper
2169874117 AP_FlashIface: make sure XIP flash is ready before returning 2022-04-29 07:54:06 +09:00
Andy Piper
9300ab8d02 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-29 07:54:06 +09:00
Randy Mackay
a3d595f68f AP_Arming: add pre-arm check of disabled servo channels 2022-04-29 07:54:06 +09:00
Andy Piper
bafab0fddf 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-29 07:54:06 +09:00
Andy Piper
ff5a813b4f AP_HAL_ChibiOS: determine presence of disabled channels based on digital channels in a group 2022-04-29 07:54:06 +09:00
Andy Piper
007174d36a AP_HAL: add accessor for disabled channels to RCOutput 2022-04-29 07:54:06 +09:00
Andy Piper
a673a481fd AP_BLHeli: keep a record of disabled motors 2022-04-29 07:54:06 +09:00
Bill Geyer
fd7b713799 AC_AutoTune: fix gain determination fail logic 2022-04-29 07:54:06 +09:00
Bill Geyer
fa28fed0d4 AC_AutoTune: use failed state to exit 2022-04-29 07:54:06 +09:00
Bill Geyer
de0a36874e AC_AutoTune: use generic load gain method to save flash 2022-04-29 07:54:06 +09:00
Andy Piper
cfb8830fad AP_HAL_ChibiOS: bdshot version of MatekF765-Wing 2022-04-29 07:54:06 +09:00
Andy Piper
33c9ffd874 AP_HAL_ChibiOS: use narrower bitwidths for dshot and LEDs to allow more accurate prescaler calculation 2022-04-29 07:54:06 +09:00
Andy Piper
7552219c5b AP_HAL: update prescaler tests 2022-04-29 07:54:06 +09:00
Randy Mackay
a7d89829bf AP_RPM: pre-arm displays gpio vs servo_ch conflict 2022-04-29 07:54:06 +09:00
Randy Mackay
b366689282 AP_Relay: pre-arm displays gpio vs servo_ch conflict 2022-04-29 07:54:06 +09:00
Randy Mackay
1444545b6a AP_Button: pre-arm displays gpio vs servo_ch conflict 2022-04-29 07:54:06 +09:00
Randy Mackay
f3db67b322 AP_HAL: add GPIO::pin_to_servo_channel method 2022-04-29 07:54:06 +09:00
Randy Mackay
343115a242 AP_HAL_ChibiOS: GPIO comment removes mention of BRD_PWM_COUNT 2022-04-29 07:54:06 +09:00
Randy Mackay
a52f45df62 AP_IOMCU: valid_GPIO_pin checks if pin configured for GPIO 2022-04-29 07:54:06 +09:00
Randy Mackay
34c0a0515a AP_IOMCU: convert_pin_number leaves input untouched on failure 2022-04-29 07:54:06 +09:00
Randy Mackay
82f4fb20f8 AP_RPM: avoid attach interrupt retry and spam to GCS if PIN = -1 2022-04-29 07:54:06 +09:00
xianglunkai
2fb92d03ae AP_Proximity_Boundary_3D:correction of miswriting 2022-04-29 07:54:06 +09:00
Andrew Tridgell
ceecc2b708 AP_Logger: removed annoying message on missing logs 2022-04-29 07:54:06 +09:00
Andrew Tridgell
0e0e09e262 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-29 07:54:06 +09:00
xianglunkai
be633c6dd8 AP_Logger: must set default fd = -1 2022-04-29 07:54:06 +09:00
Andrew Tridgell
e7ceb359a7 SITL: update for changed INS_NOTCH parameter name 2022-04-29 07:54:06 +09:00
Andrew Tridgell
053e9d7c19 AP_HAL_ChibiOS: update for changed INS_NOTCH parameter name 2022-04-29 07:54:06 +09:00
Andrew Tridgell
b06ee3f4b5 AP_InertialSensor: move INS_HNTC2 to a new parameter table ID 2022-04-29 07:54:06 +09:00
QioTek
d56c6b6249 AP_HAL_ChibiOS: ICM4 series sensors as an alternative with IMU3.
AP_HAL_ChibiOS:  ICM4 series sensors as an alternative with IMU3.
2022-04-29 07:54:06 +09:00
mateksys
d51dd75ba0 AP_HAL_ChibiOS:add icm42688p as substitution 2022-04-29 07:54:06 +09:00
Andrew Tridgell
7b7eea4c84 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-29 07:54:06 +09:00
Andrew Tridgell
946c7196c2 AC_AttitudeControl: use deadzone for pitch
when pitch for nose-in and tail-in is enabled we should use the
deadzone
2022-04-29 07:54:06 +09:00
Andrew Tridgell
eb60f29088 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-29 07:54:06 +09:00
Andrew Tridgell
41f56d8d87 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-29 07:54:06 +09:00
Andrew Tridgell
07d0336334 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-29 07:54:06 +09:00
李孟晓
f497e8639d AP_HAL_ChibiOS: CUAV-Nora: add usart3 support 2022-04-09 17:04:26 +09:00
Andy Piper
0e78bdbb19 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-09 17:04:26 +09:00
Andrew Tridgell
f8c3b4be5d HAL_ChibiOS: incorrect class of class in uart TX timeout
need to call chEvtGetAndClearEventsI() as we are in a system lock
state
2022-04-09 17:04:26 +09:00
Andrew Tridgell
e50f893a7e 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-09 17:04:26 +09:00
Andrew Tridgell
e1c74ee6e5 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-09 17:04:26 +09:00
Andrew Tridgell
0a3ca205eb 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-09 17:04:26 +09:00
Andrew Tridgell
a03b9ec034 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-09 17:04:26 +09:00
Andrew Tridgell
86f7365c1c 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-09 17:04:26 +09:00
Andrew Tridgell
8d4130ee11 Revert "hwdef: changed MatekH743 to a 32 bit timer"
This reverts commit 7dc5911572.
2022-04-09 17:04:26 +09:00
Andrew Tridgell
0c2041d415 HAL_ChibiOS: constrain more timer timeouts 2022-04-09 17:04:26 +09:00
Andrew Tridgell
ce1fc5406c 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-09 17:04:26 +09:00
Andrew Tridgell
1f30cf93cf 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-09 17:04:26 +09:00
Andrew Tridgell
2ad485bb09 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-09 17:04:26 +09:00
Andy Piper
b3bd0d3fbb AP_HAL_ChibiOS: spro H7 extreme updates.
cannot currently use both IMUs on spro H7 extreme due to CPU load
2022-04-09 17:04:26 +09:00
Peter Barker
da97462385 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-09 17:04:26 +09:00
Andrew Tridgell
a039500e53 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-09 17:04:26 +09:00
Bill Geyer
cfaef178f4 AP_Math: add chirp function to support frequency sweeps in systemid and autotune 2022-03-30 11:37:41 +09:00
Bill Geyer
53b91b0c67 AC_Autotune: clean up variable init for dwell 2022-03-30 11:37:41 +09:00
Bill Geyer
f3fba7d844 AC_AutoTune: use chirp function in AP_Math for frequency sweeps 2022-03-30 11:37:41 +09:00
Bill Geyer
74db41806b AC_AutoTune: combine dwell_run_test for angle and rate 2022-03-30 11:37:41 +09:00
Bill Geyer
4680f73715 AC_AutoTune: combine dwell_init methods 2022-03-30 11:37:41 +09:00
Bill Geyer
8156831e0e AC_AutoTune:tradheli-streamline gcs messages 2022-03-30 11:37:41 +09:00
Peter Barker
42e567207e AC_AutoTune: Vector tidying 2022-03-30 11:37:41 +09:00
Peter Barker
97ed1ac4c7 AC_AutoTune_Heli: use structure assignment to clear structures 2022-03-30 11:37:41 +09:00
Peter Barker
e2dad1af4d AC_AutoTune: use structure assignment for test results 2022-03-30 11:37:41 +09:00
Peter Barker
ecf3d16a4d AC_AutoTune: createstructure to hold specific test's sweep results 2022-03-30 11:37:41 +09:00
Henry Wurzburg
c4a31b1d07 HWDEF: add SLCAN OTG port, correct defaults.param errors 2022-03-30 11:37:41 +09:00
Andy Piper
b8e37317c2 AP_HAL_SITL: correct disable channel maths
unilaterally write rcoutput to appease the sitl gods
2022-03-30 11:37:41 +09:00
Andy Piper
295e36d7d6 SRV_Channel: don't count disabled channels in mask and setup functions
disable channels that are not in use
2022-03-30 11:37:41 +09:00
Andy Piper
15ec9d5ab4 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-03-30 11:37:41 +09:00
AndKe
0351cd42c4 AP_HAL_ChibiOS: add OREOLED to CubeGreen 2022-03-30 11:37:41 +09:00
Andrew Tridgell
fde2930fa6 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-30 11:37:41 +09:00
Andrew Tridgell
3713769e57 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-30 11:37:41 +09:00
Andrew Tridgell
adabaca240 AP_Logger: added terrain correction logging field 2022-03-30 11:37:41 +09:00
Andrew Tridgell
14145959e0 AP_Terrain: added logging of terrain correction 2022-03-30 11:37:41 +09:00
Andrew Tridgell
262163eb0f AP_Scripting: restored corrected boolean in height_amsl binding 2022-03-30 11:37:41 +09:00
Andrew Tridgell
eac02acef8 HAL_SITL: don't use terrain adjustment 2022-03-30 11:37:41 +09:00
Andrew Tridgell
59409fd6b7 AP_Arming: setup for terrain adjustment on arming 2022-03-30 11:37:41 +09:00
Andrew Tridgell
78f83d5411 SITL: don't use adjusted terrain in SITL 2022-03-30 11:37:41 +09:00
Andrew Tridgell
502539671d AP_Terrain: added terrain reference adjustment
this restores the terrain adjustment functionality removed in #19946,
but without the problematic approach of always using home (which can
be moved in flight) and with a TERR_OFS_MAX parameter to limit the
amount of adjustment
2022-03-30 11:37:41 +09:00
Andrew Tridgell
a8ca9d5b98 HAL_ChibiOS: display source of RC input
distinguish between IOMCU, RCInput with bytes and RCInput with pulses
2022-03-30 11:37:41 +09:00
Andrew Tridgell
f159caa203 HAL_ChibiOS: switch between IOMCU and RCProt rapidly
keep the RCProtocol decoder going when IOMCU being used, allowing for fast failover
between IOMCU RC input and uart RC input
2022-03-30 11:37:41 +09:00
Andrew Tridgell
1b13a9d15b AP_RCProtocol: added using_uart() method 2022-03-30 11:37:41 +09:00
Andy Piper
147e07a29a AP_HAL_ChibiOS: add KakuteH7-bdshot target 2022-03-30 11:37:41 +09:00
Andrew Tridgell
b805f91b18 AP_BattMonitor: fixed battery remaining of sum battery
and move to common function for update_consumed()
2022-03-30 11:37:41 +09:00
Randy Mackay
3584a6cac9 AP_BLHeli: add reboot required to some parameters 2022-03-30 11:37:41 +09:00
Andy Piper
6721aa5f9e AP_HAL_ChibiOS: correct channel offsets for dshot commands
Co-authored-by: Randy Mackay <rmackay9@yahoo.com>
2022-03-30 11:37:41 +09:00