Commit Graph

29067 Commits

Author SHA1 Message Date
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
Andrew Tridgell
278d87e6f2 AP_Scripting: restored corrected boolean in height_amsl binding 2022-03-28 20:53:56 +11:00
Andrew Tridgell
8d6bfac43c HAL_SITL: don't use terrain adjustment 2022-03-28 20:53:56 +11:00
Andrew Tridgell
8c026ec701 AP_Arming: setup for terrain adjustment on arming 2022-03-28 20:53:56 +11:00
Andrew Tridgell
75bd6a4b6a SITL: don't use adjusted terrain in SITL 2022-03-28 20:53:56 +11:00
Andrew Tridgell
89465d2126 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-28 20:53:56 +11:00
Andrew Tridgell
4bc35ba04d HAL_ChibiOS: display source of RC input
distinguish between IOMCU, RCInput with bytes and RCInput with pulses
2022-03-28 20:53:56 +11:00
Andrew Tridgell
0ae1ac182a 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-28 20:53:56 +11:00
Andrew Tridgell
9ba73d362d AP_RCProtocol: added using_uart() method 2022-03-28 20:53:56 +11:00
Andy Piper
4c4d60778c AP_HAL_ChibiOS: add KakuteH7-bdshot target 2022-03-28 20:53:56 +11:00
Andrew Tridgell
f0f19ce8fb AP_BattMonitor: fixed battery remaining of sum battery
and move to common function for update_consumed()
2022-03-28 20:53:56 +11:00
Randy Mackay
50cf7c9f94 AP_BLHeli: add reboot required to some parameters 2022-03-28 20:53:56 +11:00
Andy Piper
bafe46882f AP_HAL_ChibiOS: correct channel offsets for dshot commands
Co-authored-by: Randy Mackay <rmackay9@yahoo.com>
2022-03-28 20:53:56 +11:00
Randy Mackay
43beccd86c AP_HAL_ChibiOS: reversible DShot fix
Co-authored-by: Andy Piper <github@andypiper.com>
2022-03-28 20:53:56 +11:00
Andrew Tridgell
86899b279f HAL_ChibiOS: prevent conflicting RC input
when we have RC from both IOMCU and from rcprotocol (eg. from
SERIALn_PROTOCOL=23) we need to only process one of them. This
prioritises IOMCU input
2022-03-28 20:53:56 +11:00
Andrew Tridgell
3ffc08ae91 AP_GPS: prevent switching to a dead GPS
when we switch away from the blended GPS instance we need to ensure we
don't switch to a GPS that is timing out, and may be the instance that
is triggering the disable of blending
2022-03-28 20:53:56 +11:00
Andrew Tridgell
36ba3fab9e GCS_MAVLink: send GCS voltage to GCS
may be resting voltage of option enabled
2022-03-28 20:53:56 +11:00
Andrew Tridgell
11e17a49d3 AP_BattMonitor: added option to send resting voltage to GCS 2022-03-28 20:53:56 +11:00
Andy Piper
6ddb813fba AP_Declination: ensure indexing into declination tables is always correct
add constants for table sizes
2022-03-18 14:30:36 +11:00
Andrew Tridgell
3cef6b8167 AP_Arming: make mission checks virtual 2022-03-18 14:23:20 +11:00
Andrew Tridgell
518b126f52 AP_Arming: display a warning if arming checks disabled when arming 2022-03-18 14:22:53 +11:00
Andrew Tridgell
66c13d29b7 AC_AttitudeControl: added set_lean_angle_max_cd() 2022-03-16 07:09:30 +11:00
Andrew Tridgell
ecbcbbe044 AC_Autorotation: use accel_to_angle() 2022-03-15 09:25:53 +11:00
Andrew Tridgell
f398cf8814 AC_WPNav: use angle/accel functions 2022-03-15 09:25:36 +11:00
Andrew Tridgell
a16357fb08 AP_Math: added angle_to_accel() and accel_to_angle() 2022-03-15 09:25:18 +11:00
Leonard Hall
b9628f106d AC_PosControl: Decay posiiton error during relax 2022-03-10 10:49:54 +11:00
Leonard Hall
94b83d34b1 AC_AttitudeControl: AC_PosControl: add soften for landing 2022-03-10 10:48:16 +11:00
Peter Barker
a7aa4155ad AP_HAL_ChibiOS: allow specification of AUTOBUILD_TARGETS in hwdef files 2022-03-10 10:36:09 +11:00
Andrew Tridgell
58cc0b4289 AP_Math: fixed build error on cygwin
ensure variables are always initialised
2022-03-10 10:31:02 +11:00
Leonard Hall
d7f283d3b5 AP_Math: SCurve: Increase corner speeds 2022-03-10 10:30:53 +11:00
Leonard Hall
594fc3f02d AP_Math: Convert S-Curves to use maximum Snap to remove minimum time between waypoints 2022-03-10 10:30:49 +11:00
Leonard Hall
9c70fc1aa9 AC_WPNav: Support pause 2022-03-10 10:30:31 +11:00
Leonard Hall
8049efabbc AC_WPNav: init optionally accepts stopping point 2022-03-10 10:30:29 +11:00
Leonard Hall
f9192b0c2c AC_Loiter: use Pos_Control soften_for_landing_xy 2022-03-10 10:30:26 +11:00
Leonard Hall
54f17d4a82 AC_WPNav: Increase corner speeds 2022-03-10 10:30:22 +11:00
Leonard Hall
2936b6cb5e AC_WP_Nav: Convert S-Curves to use maximum Snap to remove minimum time between waypoints 2022-03-10 10:30:20 +11:00
MallikarjunSE
2a39b3733e AP_HAL_ChibiOS: Add Sierra-F9P support 2022-03-10 08:30:11 +11:00
Andy Piper
6a9d01e3ac AP_HAL_ChibiOS: normalize BeastH7v2 in line with BeastF7v2 definition 2022-03-10 08:27:31 +11:00
Evgeniy
9b940b3e51 AP_HAL_ChibiOS: BeastH7v2 board added 2022-03-10 08:27:29 +11:00