Commit Graph

46899 Commits

Author SHA1 Message Date
Rishabh 5e5ca6e02a AP_Proximity: Check for stray faces and add new param for filter cut off freq 2021-04-05 14:09:17 +09:00
Rishabh e31ea2f3ee AC_Avoid: Change parameter defaults 2021-04-05 13:43:28 +09:00
Rishabh 1dc67fb932 AP_Proximity: Change parameter defaults 2021-04-05 13:43:28 +09:00
Andrew Tridgell 45477f6063 HAL_ChibiOS: fixed default MSP port for f405-MatekGPS 2021-04-05 11:02:32 +10:00
Andrew Tridgell ca948171fe HAL_ChibiOS: fixed ADC error on revXY STM32H7 boards
with the new ChibiOS revision we were configuring for newer revisions
of the H7, which meant that we changed the ADC config. This broke ADC
readings on revX and revY H7 MCUs.

This PR fixes it in two ways:

 1) change ChibiOS config to assume XY config chips

 2) use 16 bit ADC for H7, which means the chip rev doesn't matter,
    and also gives us 16x the resolution for ADC readinga, so we can
    read smaller voltage and current values
2021-04-05 11:01:03 +10:00
Peter Barker ea4bbcf6ee autotest: add test for copter position reset 2021-04-05 00:02:42 +10:00
willpiper 94bdca7f6f AP_HAL_ChibiOS: tidy up beastF7 DMA channels 2021-04-04 16:51:19 +10:00
Randy Mackay ab2e429f32 Tools: Copter.fly_square descends more quickly 2021-04-03 12:07:59 +09:00
Randy Mackay f341429977 Tools: Copter.RTLSpeed gets increased speed tolerance 2021-04-03 12:07:59 +09:00
Randy Mackay c04f686ce7 Tools: extend copter NavDelay test by 80sec
s-curves slows missions slightly
2021-04-03 12:07:59 +09:00
Randy Mackay 224cd5a0d3 Sub: auto-yaw-correct-xtract uses target velocity instead of position error
Co-authored-by: Leonard Hall <leonardthall@gmail.com>
2021-04-03 12:07:59 +09:00
Randy Mackay afa59b9a60 Sub: integrate s-curves, remove spline support 2021-04-03 12:07:59 +09:00
Randy Mackay ff8b69fbad Plane: update tuning to integrate poscon changes 2021-04-03 12:07:59 +09:00
Randy Mackay 941cf6b293 Copter: integrate AC_WPNav::get_yaw_rate_cds rename 2021-04-03 12:07:59 +09:00
Randy Mackay 94d4e5912b Copter: add comments to smartRTL 2021-04-03 12:07:59 +09:00
Randy Mackay 96267553cf Copter: auto detects mission changes 2021-04-03 12:07:59 +09:00
Randy Mackay 238d102a56 Copter: auto's wp_start skips submode change on terrain failsafe 2021-04-03 12:07:59 +09:00
Leonard Hall d981de1ff4 Copter: position control PID logging 2021-04-03 12:07:59 +09:00
Leonard Hall a29e2d8920 Copter: fix references to position error 2021-04-03 12:07:59 +09:00
Randy Mackay 7c14f4de0d Copter: rtl passes speed to wpnav::init 2021-04-03 12:07:59 +09:00
Randy Mackay 9d91b6c3be Copter: smart-rtl fix for final point altitude 2021-04-03 12:07:59 +09:00
Leonard Hall 328c0655e3 Copter: support for SCurves and position controller changes
wp_start provides next_dest_loc
send next_destination to wp_nav instead of setting fast_waypoint
fixup zigzag for S-curve changes
fixup guided
auto spline fixes
smart rtl rename of next_point to dest_NED
loc_from_cmd accepts default location
auto mode stops before starting land command
auto do_next_wp accepts default location
rename do_next_wp to set_next_wp
also rename get_spline_from_cmd argument
also improve failure to set next waypoint due to missing terrain data
also fixup comment in set_next_wp
also auto stops when moving from straight to spline segments
also auto mode spline fix
also auto mode calls AC_WPNav::set_spline_destination_next

Copter: AutoYaw provides rate from WPNav
2021-04-03 12:07:59 +09:00
Randy Mackay 204c839ae0 Copter: mode_smart_rtl uses peek_point 2021-04-03 12:07:59 +09:00
Randy Mackay 193799346c AP_SmartRTL: peek_point method peeks at next point
includes peek point takes semaphore
2021-04-03 12:07:59 +09:00
Leonard Hall 64ae08a925 AC_Loiter: fix references to position error 2021-04-03 12:07:59 +09:00
Leonard Hall d0ab74e496 AC_Circle: fix references to position error 2021-04-03 12:07:59 +09:00
Randy Mackay 2201450180 AC_WPNav: renames and comment fixes 2021-04-03 12:07:59 +09:00
Randy Mackay 85b24cf641 AC_WPNav: fix get_wp_destination_loc
was incorrectly adding alt-above-terrain as if it was alt-above-ekf-origin
also fixup comments
2021-04-03 12:07:59 +09:00
Leonard Hall 32c27b32aa AC_WPNav: support for SCurve navigation
set_wp_destination clear yaw target
limit velocity and acceleration based on track slope
add is_active() and remove unused reached_spline_destination
init accepts desired speed
set_kinematic_limits uses current speed limits instead of defaults
add time compression to prevent target moving too fast for air
implement alternative spline
remove vel-target-length
set_wp_destination always calculates this leg
set_kinematic_limits moved to scurve
fix origin speed after spline segment
spline terrain following fix
handle s-curves with mismatching alt types
fix set_spline_destination_next
add update_track_with_speed_accel_limits
Change to next waypoint at corner apex
use scurve advance along track
remove unused definitions and out-of-date todo
set_spline_destination_next sets fast_waypoint
scurve origin speed set from spline target velocity
fixup takeoff delay
2021-04-03 12:07:59 +09:00
Leonard Hall 6a8ba6f329 AC_PosControl_Sub: update for new position controller changes 2021-04-03 12:07:59 +09:00
Randy Mackay cb0d37586e AC_PosControl: use Vector limit_length and formatting fixes 2021-04-03 12:07:59 +09:00
Leonard Hall ba00c2edd6 AC_PosControl: alt hold controller update
pass accel limit top_pos_xy
prearm check updated
fix PSC_VELZ_FLTE/D param descriptions
fix VelZ FF param desc
limit maximum desired z component
integrate AC_PID_Basic
2021-04-03 12:07:59 +09:00
Leonard Hall b73ad1a1bc AC_PosControl: remove unused sqrt_controller_3D 2021-04-03 12:07:59 +09:00
Leonard Hall 49da872218 AC PosControl: fix position error get functions 2021-04-03 12:07:59 +09:00
Randy Mackay e24f23e076 AP_Mission: add restart_current_nav_cmd 2021-04-03 12:07:59 +09:00
Randy Mackay 2357568eb1 AP_Mission: Mission_Command struct gets comparison operators 2021-04-03 12:07:59 +09:00
Leonard Hall 83b7c496b5 AP_Logger: support for position controller logging 2021-04-03 12:07:59 +09:00
Randy Mackay ae66803148 AC_AttitudeControl: minor optimisation and comment fixes 2021-04-03 12:07:59 +09:00
Leonard Hall d6e3495eca AC_AttitudeControl: support for feedforward rate in angle request for yaw 2021-04-03 12:07:59 +09:00
Leonard Hall 1d720cc5e9 AC_PID: library update and additional functions
includes corrections from peer review
2021-04-03 12:07:59 +09:00
Randy Mackay bc0da915c4 AP_Math: add SplineCurve library
Co-authored-by: Leonard Hall <leonardthall@gmail.com>

includes corrections from peer review
2021-04-03 12:07:59 +09:00
Leonard Hall af7403f4e9 AP_Math: add SCurve library
SCurve const more local variables
rename update to get_jerk_vel_pos_at_time
removed unused update
debug output in SITL
fixes to ensure finished at end of path
fixes including validity check
includes corrections from peer review
2021-04-03 12:07:59 +09:00
Randy Mackay 0e506a71a1 AP_Math: remove control's limit_vector_length
these have been moved to Vector2f and Vector3f
2021-04-03 12:07:59 +09:00
Randy Mackay e2b46d05dc AP_Math: Vector2,3 get limit_length methods 2021-04-03 12:07:59 +09:00
Leonard Hall 3bb0482795 AP_Math: add update_pos_vel_accel to control
also add shape_vel, shape_pos_vel and stopping_distance
also add calculation of kinematic limits
2021-04-03 12:07:59 +09:00
Randy Mackay 67f2c79717 AP_InternalError: added invalid_arguments failure
this is intended to catch problems where we have unexpectedly received
invalid arguments.  For example an out-of-bounds target speed that
should have been caught somewhere else.

running out of bits so we use a single bit to capture invalid inputs to or output from a calculation
2021-04-03 12:07:59 +09:00
Peter Barker f0094bac40 autotest: remove copied-in duplicate of pymavlink rotmat 2021-04-03 13:26:06 +11:00
Peter Barker dfa342a79f autotest: correct rc-values-good debug 2021-04-03 08:59:14 +11:00
Peter Barker 7d9daccdf7 autotest: fix mavproxy switch test
The order in which we fix the environment means that we need to be
listening on the correct port for rc values - so just fix it in the test
2021-04-03 08:58:52 +11:00
Peter Barker d384ba6585 autotest: increase time permitted for Copter to turn east
Sometimes they turn almost 360 which takes a while
2021-04-02 21:29:43 +11:00