Leonard Hall
ff58054d1b
AC_AttitudeControl: AC_PosControl: Clean up to use .xy()
2021-08-26 12:22:52 +09:00
Leonard Hall
8223d664a7
AC_AttitudeControl: AC_PosControl: Non functional clean up
2021-08-26 12:22:52 +09:00
Leonard Hall
9c097dd6be
AC_AttitudeControl: AC_PosControl: limit initial acceleration
2021-08-26 12:22:52 +09:00
Leonard Hall
445e52b821
AC_AttitudeControl: AC_PosControl: fix stopping point initialization
2021-08-26 12:22:52 +09:00
Iampete1
df7321c0da
AC_PosControl: init_z_controller_stopping_point: remove duplicate set_integrator
2021-08-21 09:54:33 +01:00
Andrew Tridgell
285798446a
AC_AttitudeControl: apply EKF Z gain scaler
...
for flying with DCM
2021-08-19 14:42:28 +10:00
Andrew Tridgell
25ee57080f
AC_AttitudeControl: this fixes an issue with Z accel initialisation
...
tailsitter quadplanes were climbing a lot on transition from fixed
wing to Q modes. Leonard tracked it down to a bug in the Z accel init
2021-08-16 08:33:34 +10:00
Leonard Hall
71ccffd7c9
AC_AttitudeControl: AC_PosControl: support Control: Refactor to use Jerk
2021-08-11 17:07:29 +09:00
Leonard Hall
870888efeb
AC_AttitudeControl: AC_PosControl: fix PID filter names FILT -> FLTE, D_FILT -> FLTD
2021-08-10 08:33:56 +09:00
Peter Barker
5046083863
AC_AttitudeControl: rename for AHRS restructuring
2021-07-21 21:01:39 +10:00
Leonard Hall
ff1843a79c
AC_AttitudeControl: AC_PosControl: Auto Terain following update
2021-07-21 16:03:44 +09:00
Leonard Hall
9d845759f8
AC_PosControl: Add MAX(bla,0) because safe_sqrt isn't safe
2021-07-21 15:40:41 +09:00
Leonard Hall
f130503cc7
AC_AttitudeControl: AC_PosControl: calculate cross track
2021-07-21 15:40:41 +09:00
Leonard Hall
e2b5d3d585
AC_AttitudeControl: AC_PosControl: support accel only input in the vertical
2021-07-10 20:25:05 +09:00
Leonard Hall
e0e283f13e
AC_AttitudeControl: AC_PosControl: support terrain following
2021-07-10 20:25:05 +09:00
Leonard Hall
8a2f75d742
AC_AttitudeControl: AC_PosControl: seperate kinimatic shaping from pid limit setting
2021-07-10 20:25:05 +09:00
Leonard Hall
6e82bff55b
AC_AttitudeControl: Add terain following to guided
2021-07-10 20:25:05 +09:00
Leonard Hall
b3acdd49d6
AC_AttitudeControl: AC_PosControl: Support Accel only input
2021-07-10 20:25:05 +09:00
Leonard Hall
8e084a0879
AC_AttitudeControl: AC_PosControl: Change input_pos_xyz name
2021-07-10 20:25:05 +09:00
Leonard Hall
5475d1153c
AC_PosControl: fixup ekf reset
2021-06-25 10:01:49 +09:00
Andrew Tridgell
66186e5221
AC_AttitudeControl: convert poscontrol to use double position
2021-06-24 21:34:30 +10:00
Andrew Tridgell
7819cc6400
AC_AttitudeControl: cleanup poscontrol comments with input from Leonard
2021-06-24 20:28:45 +10:00
Andrew Tridgell
fd68233fed
AC_AttitudeControl: cleanup position control APIs
...
use Vector2 for xy, float for z
2021-06-24 20:28:45 +10:00
Leonard Hall
47b0ac663a
AC_AttitudeControl: AC_PosControl: Init and stopping point fixes
2021-06-24 09:01:07 +10:00
Leonard Hall
ffc64c3042
AC_AttitudeControl: AC_PosControl: change force_descend to ignore_descent_limit
2021-06-23 10:58:50 +09:00
Leonard Hall
d599052da3
AC_AttitudeControl:AC_PosControl: vibration failsafe fix
2021-06-23 10:29:23 +09:00
Leonard Hall
d9529e1be3
AC_AttitudeControl: AC_PosControl: Remove extra accel limit
2021-06-21 14:14:23 +09:00
Hwurzburg
3f4d4e45fc
AC_AttitudeControl: correct param ranges to accomodate TradHeli defaults
2021-05-28 09:44:11 +09:00
Randy Mackay
d9c68031fa
AC_PosControl: write_log checks xy and z controllers are active
...
This allows write_log to be write PSCZ messages for modes with onlyi vertical control (e.g. althold) without also logging out-of-date PSC messages
2021-05-26 18:58:31 +10:00
Leonard Hall
491350c1d6
AC_AttitudeControl: Fix before squash
2021-05-24 20:13:37 +10:00
Andrew Tridgell
8213fc5277
AC_AttitudeControl: prevent panic on SITL when no lock-step scheduling
...
this disables the internal error for bad timing on SITL types without
lock-step scheduling, such as RealFlight
2021-05-24 20:13:37 +10:00
Leonard Hall
92e05e8c4f
AC_AttitudeControl: PosControl fixes
2021-05-24 20:13:37 +10:00
Leonard Hall
4158c37cfa
AC_PosControl: Calculate heading
2021-04-27 17:13:55 +09:00
Leonard Hall
bb46f7a947
AC_PosControl: Thrust Vector output
2021-04-27 17:13:55 +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
Peter Hall
aa75fc2c3d
AC_PosControl: use target lean angles rather than true for init
2021-03-17 08:13:11 +09:00
Leonard Hall
8ace1bfad1
AC_PosControl: const local vars and remove todo
2021-02-10 13:26:23 +09:00
Randy Mackay
0703a1cf93
AC_PosControl: add PSCZ logging
2021-02-09 19:33:52 +09:00
Randy Mackay
9f914d9e7d
AC_PosControl: add get_z_accel_cmss helper function
2021-02-09 19:33:52 +09:00
Randy Mackay
6320338771
AC_PosControl: use AP_Math control functions
2021-01-20 18:19:40 +11:00
Randy Mackay
d6869b9234
AC_PosControl: fix typo in posxy_p param desc
2020-11-05 14:59:00 +09:00
Andrew Tridgell
0a7c628355
AC_AttitudeControl: added SMAX param docs
2020-10-25 10:32:48 +11:00
Randy Mackay
4ed486bb92
AC_AttitudeControl: revert Add PosControl PID logging
2020-09-12 08:10:33 +09:00
Iampete1
c109df3dd5
AC_AttitudeControl: Add PosControl PID logging
2020-09-11 10:12:08 +10:00
Iampete1
e955b431ef
AC_PosControl: move to structure logging for PSC
2020-09-11 10:12:08 +10:00
Iampete1
c27bdafea4
AC_PosControl: correct VELXY_D_FILT Description
2020-06-23 11:40:12 +09:00
Rishabh
6a98ab569e
AC_PosControl: Replace update_vel_controller_xy() with update_xy_controller()
2020-04-21 09:22:45 +10:00
Peter Barker
e477f6c840
AC_PosControl: add documentation for PSC log message
2020-04-06 10:46:45 +10:00
Leonard Hall
29332ac112
AC_PosControl: add relax_velocity_controller_xy
2020-03-11 10:39:18 +09:00
Randy Mackay
fc2e15651e
AC_PosControl: allow smaller changes in max speed and accel
...
also small changes in max speed for z-axis
2020-02-22 08:53:41 +09:00
Randy Mackay
5e60ae8a26
AC_PosControl: add missing ACCZ param descriptions
2020-02-14 09:20:11 +09:00
Peter Barker
d6dbdd58d3
AC_AttitudeControl: adjust for some methods on AP_AHRS become non-const
2020-01-21 11:53:18 +11:00
Luke.Qin
c8ef863e6d
AC_PosControl: fix minor bug for set_max_speed_z()
2019-11-26 19:28:38 +09:00
Leonard Hall
3ca713fdcb
AC_AttitudeControl: limit ATC_MOT_MIX_MAX in case of a fly away
2019-10-31 12:23:48 +08:00
Leonard Hall
e5f724bc3a
AC_PosControl: add high vibration compensation
2019-10-18 11:15:25 +09:00
Leonard Hall
5acfc77a3c
AC_AttitudeControl: Support for Standby functions
2019-10-17 14:57:18 +09:00
Leonard Hall
979b54b33e
AC_PosControl: support update to PID object
2019-07-25 17:38:15 +09:00
Leonard Hall
78be1067a8
AC_AttitudeControl: Alt Hold init bug
2019-07-17 09:09:25 +09:00
Leonard Hall
32cc642b2e
AC_AttitudeControl: Formatting Changes
2019-04-20 09:31:56 +09:00
Randy Mackay
4e494d5a63
AC_PosControl: minor comment fix to pre-arm checks
2019-04-16 11:23:46 +09:00
Randy Mackay
0624f6b8c3
AC_PosControl: minor comment fix
2019-04-16 11:23:46 +09:00
Tom Pittenger
ce872d83a4
AC_AttitudeControl: rename dataflash to logger
2019-03-28 16:40:57 +11:00
Peter Barker
eb1fc3107c
AC_PosControl: log PSC data in metres in place of centimetres
2019-03-26 10:18:05 +11:00
Peter Barker
50d95943e3
AC_AttitudeControl: add pre-arm checks
2019-03-06 10:36:32 +09:00
Randy Mackay
8710526894
AC_PosControl: constify dt calcs
2019-01-30 15:58:34 +09:00
Randy Mackay
b14be4e8ae
AC_PosControl: increase accuracy of dt calcs
2019-01-30 15:58:34 +09:00
Peter Barker
6fc76a32af
GLOBAL: use AP::logger() and strip redundant Log_ from methods
2019-01-18 18:08:20 +11:00
Peter Barker
b47733142f
GLOBAL: rename DataFlash_Class to AP_Logger
2019-01-18 18:08:20 +11:00
Randy Mackay
ba3303dc61
AC_PosControl: set-alt-target-with-slew sets desired to 0 once at target
...
This resolves and issue with the set-alt-target-with-slew method leaving the z-axis desired velocity at the max speed-up or speed-down
this causes a jump in throttle if the user switches to Loiter after the vehicle has reached its target
2018-11-26 09:30:32 +09:00
Peter Barker
dcd930497a
AC_AttitudeControl: AC_PosControl: avoid calling norm()
...
The result of this won't be used as often as this loop is called
2018-10-30 09:00:23 +09:00
Peter Barker
dabe8a13f7
AC_AttitudeControl: use EKF singleton to get ekfNavVelGainScaler
2018-10-09 10:47:38 +11:00
Michael du Breuil
1d13aff711
AC_AttitudeControl: Rename several set_speed and set_accel functions
2018-09-20 15:15:45 -07:00
Leonard Hall
b15b5516cb
AC_PosControl: Fix divide by zero check in limit_vector_length
2018-09-12 15:51:30 +09:00
Leonard Hall
5863b84c35
AC_PosControl: reduce glitch on init
2018-09-04 13:37:28 +09:00
Michael du Breuil
334ff0fb66
AC_AttitudeControl: Prevent DCM fallback from triggering a flyaway
2018-03-31 13:40:52 +09:00
Randy Mackay
ac82a37728
AC_PosControl: run horiz control at main loop rate
2018-03-16 13:50:57 +09:00
Randy Mackay
13007e2a07
AC_PosControl: dataflash logging of PSC message
2018-03-16 13:50:57 +09:00
Randy Mackay
69cfea4057
AC_PosControl: use float for local consts
2018-03-16 13:50:57 +09:00
Leonard Hall
dadc6a63c4
AC_PosControl: add set_leash_length_xy
2018-03-16 13:50:57 +09:00
Leonard Hall
e5bc2b26fe
AC_PosControl: add lean angle max
2018-03-16 13:50:57 +09:00
Leonard Hall
0f3645b061
AC_PosControl: increase velocity gains
2018-03-16 13:50:57 +09:00
Leonard Hall
7ec043502f
AC_PosControl: add accel limit to xy controller
2018-03-16 13:50:57 +09:00
Leonard Hall
bd13704f6f
AC_PosControl: update init for guided
2018-03-16 13:50:57 +09:00
Leonard Hall
85b7f06554
AC_PosControl: combine z position control into single method
2018-03-16 13:50:57 +09:00
Leonard Hall
993e638752
AC_PosControl: combine xy position control into single method
...
Also always limit lean angle to maintain altitude
2018-03-16 13:50:57 +09:00
Leonard Hall
74bb7616a7
AC_PosControl: add accel feedforward
...
also add limit_vector_length and sqrt_controller helper functions
enforce angle limits
rename accel-feedforward to accel-desired
remove freeze_ff_xy
remove unused VEL_XY_MAX_FROM_POS_ERR
remove xy mode
remove jerk limiting code including setters
limit_vector_length uses is_positive
Also modify formatting
2018-03-16 13:50:57 +09:00
Randy Mackay
3badcdcfba
AC_PosControl: default gains for sub
2018-01-31 08:48:21 +09:00
Randy Mackay
61933c6f1c
AC_PosControl: shorten PSC_ACCELZ param to PSC_ACCZ
2018-01-31 08:48:21 +09:00
Randy Mackay
c70d3e0ab8
AC_PosControl: move pids to be local
2018-01-23 12:00:43 +09:00
Randy Mackay
3a73ff1e2e
AC_PosControl: replace velocity control with local 2-axis PID
2018-01-23 12:00:43 +09:00
Leonard Hall
e249e06714
AC_PosControl: minor enhancement to lean_angles_to_accel
2018-01-20 09:49:58 +09:00
Leonard Hall
b9ed8b292a
AC_PosControl: pass dt to att control sqrt_controller
2018-01-16 12:13:48 +09:00
Leonard Hall
3e0c24adf9
AC_PosControl: remove out-of-date comments
2018-01-11 21:18:34 +09:00
Dr.-Ing. Amilcar Do Carmo Lucas
fa4427fbce
AC_AttitudeControl: Add AC_PosControl::get_bearing_to_target() method
2017-12-05 09:17:15 +09:00
Leonard Hall
bd284d9fd7
AC_PosControl: correct lean-angle-to-accel formula
...
Thanks to @luweikxy for finding this issue!
2017-11-24 09:12:00 +09:00
Dr.-Ing. Amilcar Do Carmo Lucas
c7c2c4ff2c
AC_AttitudeControl: use floating-point multiplication instead of a more expensive floating-point division
2017-10-23 09:20:17 -07:00
Andrew Tridgell
99aad41955
AC_AttitudeControl: added a update_vel_controller_xy() API
...
this allows for just XY control of velocity for quadplanes
2017-09-09 08:14:09 +10:00