Leonard Hall
9866eaded1
AC_PosControl: rename p_alt_pos to p_pos_z
...
Also pid_alt_accel to pid_accel_z
2015-03-06 14:02:44 +09:00
Leonard Hall
349f1aeceb
AC_PosControl: use 2-axis PI controller
2015-03-06 14:02:42 +09:00
Leonard Hall
8d4f0ec80c
AC_PosControl: integrate PID input filter
2015-03-06 14:02:39 +09:00
Randy Mackay
e4d48fdc92
AC_AttControlHeli: separate accel max for roll, pitch
...
renamed _accel_y_max to _accel_yaw_max
2015-03-06 14:02:36 +09:00
Leonard Hall
51455af51a
AC_AttConHeli: integrate PID input filter
2015-03-06 14:02:35 +09:00
Leonard Hall
792b2a2eb3
AC_AttControl: separate accel max for roll, pitch, yaw
...
Also add:
Rate filters
rename rate filter defines
d-term only filter for roll, pitch rate control
accessors to save max accel for roll, pitch, yaw
fix for duplicate ACCEL_Y_MAX param
2015-03-06 14:02:33 +09:00
Leonard Hall
9833c91b2b
AC_AttControl: get_max_rate_step_bf_roll, pitch and yaw
2015-03-06 14:02:30 +09:00
Leonard Hall
f00025e5c9
AC_AttControl: accessor for rate feedforward
2015-03-06 14:02:27 +09:00
Leonard Hall
691fb8947e
AC_AttControl: accessor for rate_bf_targets
2015-03-06 14:02:25 +09:00
Leonard Hall
784a4ce51a
AC_AttControl: increase max angle overshoot to 30deg
2015-03-06 14:02:23 +09:00
Leonard Hall
eb084f7c58
AC_AttControl: bf yaw control uses input filtered PID
2015-03-06 14:02:21 +09:00
Jonathan Challinger
e9bbe062f3
AC_PosControl: modify accel_to_lean_angles to apply filters before yaw rotation
2015-02-24 16:41:03 +09:00
Andrew Tridgell
78dadcb5c6
AC_AttitudeControl: fixed example build
2015-02-09 13:08:34 +11:00
Randy Mackay
186337f18e
AC_PosControl: rename xy_mode enum values
...
Also added a few comments and fixed formatting
2015-02-06 17:00:55 +09:00
Jonathan Challinger
3faca88423
AC_PosControl: allow control of xy rate constraint behavior
2015-02-06 17:00:48 +09:00
Robert Lefebvre
14d76d158a
AC_AttitudeControl: Correct comment.
2015-02-03 14:55:30 +09:00
Randy Mackay
07a0388f25
AC_PosControl: move alt limit to set_alt_target_from_climb_rate
...
The alt limit is instead enforced when the target is set using the
set_alt_target_from_climb_rate function
Also updated comments
2015-01-30 14:13:52 +09:00
Robert Lefebvre
02f3f96310
AC_PosControl: Enable altitude limit checking.
2015-01-30 14:13:45 +09:00
Randy Mackay
d7f7af8c13
AC_AttControl: fix example sketch
2015-01-28 17:15:32 +09:00
Robert Lefebvre
743c5e4fde
AC_AttitudeControl: Remove un-needed #include
2015-01-21 14:36:54 +09:00
Randy Mackay
aeecc46f7b
AC_PosControl: remove unnecessary set of desired_accel
...
The desired_accel is set again 11 lines lower so this line did nothing.
2015-01-14 16:23:26 +09:00
Jonathan Challinger
9ebd0e9960
AC_PosControl: reincarnate dead block of code
2015-01-14 16:20:17 +09:00
Jonathan Challinger
a580cd83e8
AC_PosControl: Fill _vel_desired.z for reporting
2015-01-14 16:08:48 +09:00
Andrew Tridgell
5c4440a9ac
AC_AttitudeControl: updates for new AP_Baro API
2015-01-09 11:50:56 +11:00
Randy Mackay
2a5a133bbf
AC_AttControl: remove deprecated trigger_xy method
2015-01-07 14:03:49 +09:00
Randy Mackay
c36253b9b2
AC_PosControl: add comments
...
No functional change
2014-12-31 14:03:22 +09:00
Jonathan Challinger
557d339cf1
AC_PosControl: remove various unnecessary timing hacks
2014-12-31 14:03:18 +09:00
Jonathan Challinger
d6e455417f
AC_PosControl: change keep_xy_I_terms to a parameter of init_xy_controller
2014-12-31 14:03:13 +09:00
priseborough
12ea1d6e85
AC_AttitudeControl: Scale angle demand noise filter
...
Scales filter frequency using EKF nav gain scaler to take advantage of the reduced nav frequency whichcan tolerate a slower angle response.
This is required to reduce the effect of EKF optical flow noise increase with height.
2014-12-06 18:16:51 +11:00
priseborough
e80b1c67cd
AC_AttitudeControl: Add EKF optical flow noise gain scaler
...
Allows gains to be adjusted to compensate for optical flow noise
2014-12-06 18:16:50 +11:00
priseborough
2dff76394d
AC_PosControl: Add spike and noise filter to demanded angles
...
This has been done to provide a smooth psotion hold when using an optical flow aided EKF which can be noisy.
Signed-off-by: priseborough <p_riseborough@live.com.au>
2014-12-06 18:16:49 +11:00
Jonathan Challinger
bfe71fea82
AC_PosControl: Use blended accelerometer measurement in altitude control
2014-12-05 19:40:10 +09:00
Randy Mackay
d34ea4c124
AC_PosControl: fix to default force_descend param
2014-11-13 18:40:45 -08:00
Jonathan Challinger
e81c1dd5a1
AC_PosControl: add force_descend option to set_alt_target_from_climb_rate
2014-11-13 18:40:38 -08:00
Randy Mackay
98f5a93e10
AC_AttControl: remove unused logging structure
2014-11-08 10:17:32 +09:00
Randy Mackay
ac7ea2a12c
AC_PosControl: use AttControl's sqrt_controller
2014-10-27 15:20:48 +09:00
Jonathan Challinger
7224669399
AC_AttitudeControl: cleanup angle_ef_roll_pitch_rate_ef_yaw_smooth
2014-10-27 15:20:46 +09:00
Jonathan Challinger
779baa006d
AC_PosControl: Use sqrt_controller function
2014-10-27 15:20:44 +09:00
Jonathan Challinger
0c4a489491
AC_AttitudeControl: use sqrt_controller function
2014-10-27 15:20:43 +09:00
Randy Mackay
fc898a00a3
AC_AttControl: add sqrt_controller
...
Original code by Jonathan Challinger
2014-10-27 15:20:40 +09:00
Andrew Tridgell
9a98e63702
AC_AttitudeControl: fixed example build
2014-10-24 12:10:39 +11:00
Randy Mackay
a1cfd03c9b
AC_PosControl: bug fix dt calculation
...
fixes issue in which now could be earlier than _last_update_xy_ms
leading to a large dt value and a sudden lean on takeoff
2014-10-21 11:40:47 +09:00
Jonathan Challinger
4a397a8d67
AC_PosControl: Protect from divide-by-zero in get_stopping_point_xy
2014-10-10 21:17:12 +09:00
Randy Mackay
1754cacf3c
AC_PosControl: remove completed to-do comments
2014-10-04 23:49:24 +09:00
Randy Mackay
f65e81cb07
AC_AttControl: remove some old comments
2014-10-04 23:49:21 +09:00
Randy Mackay
cf3b2be99c
AC_PosControl: 4hz filter on z-axis velocity error
2014-09-22 13:40:01 +09:00
Randy Mackay
665f353416
AC_PosControl: 2hz filter on accel error
...
Replaced hard-coded filter with LowPassFilter class allowing the
filter's to be 2hz on both APM and Pixhawk
2014-09-21 17:53:55 +09:00
Randy Mackay
3e1bd04c94
TradHeli: update AttControl params to match multicopters
2014-09-09 14:41:57 +09:00
Randy Mackay
5a66ff1ef9
AC_AttControl: bug fix for ef target during acro
2014-08-23 22:17:54 +09:00
Randy Mackay
3e0b573dfe
AC_AttControl: remove debug message
2014-08-22 22:58:48 +09:00
Randy Mackay
f6e12bda06
AC_AttControlHeli: integrate div-by-zero check for bf-to-ef conversion
2014-08-22 22:56:18 +09:00
Randy Mackay
c45338f080
AC_AttControl: div-by-zero check for bf-to-ef conversion
2014-08-22 22:56:15 +09:00
Randy Mackay
691a3d8126
AC_AttControlHeli: add passthrough_bf_roll_pitch_rate_yaw
2014-08-22 16:28:57 +09:00
Robert Lefebvre
7d3e22af59
AC_AttitudeControl_Heli: Add use_flybar_passthrough accessor function.
2014-08-22 16:28:45 +09:00
Robert Lefebvre
9b1d9e3cf0
AC_AttitudeControl_Heli: Add passthrough_to_motor_roll_pitch function.
2014-08-22 16:28:42 +09:00
Robert Lefebvre
5c04af6d20
AC_AttitudeControl_Heli: Create Flybar Passthrough flag which will be used for control pass-through.
2014-08-22 16:28:38 +09:00
Randy Mackay
58257e3858
AC_AttControl: set rate D term filter from ins filter
2014-08-14 11:47:35 +09:00
lthall
329118b7c9
Copter: AC_ATT correct yaw error calculation
2014-08-14 11:47:13 +09:00
lthall
90dc9411a5
Copter: ACRO Error calculation fix
2014-08-14 11:47:08 +09:00
Andrew Tridgell
a9153519dc
AC_AttitudeControl: fixed example build
2014-08-13 21:45:38 +10:00
Randy Mackay
e0fc2dd50e
AC_PosControl: remove 20cm on takeoff
2014-08-05 09:11:57 +09:00
Randy Mackay
1362bdc338
AC_PosControl: smooth take-off with accel PID's I term
...
This avoids an instantaneous jump in throttle during take-off by loading
the accel PID's I term with the expected change in throttle level
2014-08-04 21:04:09 +09:00
Randy Mackay
e550c1e9a3
AC_PosControl: add set_alt_target_to_current_alt method
2014-08-04 16:54:04 +09:00
Randy Mackay
424cb1aeca
AC_AttControl: fix example sketch
2014-07-29 12:00:33 +09:00
Andrew Tridgell
6df2890fd8
AC_AttitudeControl: fixed example build
2014-07-25 17:52:53 +10:00
Randy Mackay
c2f8571f37
AC_AttControl: FF and accel limiting off by default
...
Also adjust parameter ranges used by GCSs
2014-07-17 16:22:32 +09:00
Randy Mackay
eebd32f306
AC_AttControl: remove duplicate rate_ef_desired to resolve compiler warning
2014-07-16 21:50:31 +09:00
lthall
fb55658c91
Copter: Acro use same error limit in all three axis
2014-07-16 17:46:13 +09:00
lthall
2889f5abc4
AC_AttControl: Fix feedforward behavior
2014-07-16 17:46:06 +09:00
Randy Mackay
581838b271
AC_AttControl: initialise _acro_angle_switch
...
Resolves a compiler warning
2014-07-16 15:11:12 +09:00
Randy Mackay
83a84c7b90
AC_AttControl: add empty virtual destructor
...
This resolves pixhawk bricking and reduces one compiler warning
2014-07-16 14:56:52 +09:00
Jonathan Challinger
6e66cf43cb
AC_AttitudeControl: Use bias-corrected angular rates instead of raw gyro measurements
2014-07-16 14:40:56 +09:00
Randy Mackay
70568225a6
AC_PosControl: init members to resolve compiler warnings
2014-07-16 14:38:40 +09:00
Randy Mackay
9233bbab14
AC_PosControl: cast fabs to float to resolve compiler warnings
2014-07-16 14:38:38 +09:00
Randy Mackay
76507a9e67
AC_AttControlHeli: remove hal declaration to clear compiler warning
2014-07-16 14:38:32 +09:00
Randy Mackay
5128991a84
AC_AttControlHeli: cast fabs to float to resolve compiler warning
2014-07-16 14:38:29 +09:00
Randy Mackay
0f7178e447
AC_AttControl: cast fabs to float to resolve compiler warning
2014-07-16 14:38:20 +09:00
Jonathan Challinger
762bb3e6e8
AC_AttitudeControl: Limit _pos_target.z to below alt_max before computing error
2014-07-13 21:14:34 +09:00
Jonathan Challinger
5f66027ba3
AC_AttitudeControl: Fixup some minor mistakes in AC_PosControl
2014-07-13 17:17:31 +09:00
Robert Lefebvre
a7f6a91827
AC_AttitudeControl_Heli: Remove ToDo. Rate controllers should always run even if throttle is zero.
2014-07-13 17:11:20 +09:00
Randy Mackay
971411e0db
AC_AttControl: fixed typo in parameter description
2014-07-13 10:31:11 +09:00
Randy Mackay
5f623ac859
AC_AttControl: re-enable rate feedforward by default
...
Roll and Pitch rate controllers became sluggish without feed-forward
enabled.
2014-07-11 15:31:00 +09:00
Andrew Tridgell
8af876fe8a
AC_AttitudeControl: fixed build
...
includes are case sensitive on the build server
2014-07-09 10:19:17 +10:00
Robert Lefebvre
26be7aed97
AC_AttControl_Heli: Add LPF filter to Rate Feedforward terms
2014-07-08 20:18:13 +09:00
Randy Mackay
82ed70b25e
AC_PosControl: add xyz velocity controller
...
Velocity controller interpretsthe velocity requests as
desired velocities (i.e. feed forward). These are then used to update
the target position and also added to the target velocity.
Also renamed the set_desired_velocity() function to
set_desired_velocity_xy() to make clear only lat and lon axis are
updated.
2014-07-06 17:01:02 +09:00
Randy Mackay
0c9a496262
AC_AttControlHeli: add ATC_RATE_FF_ENAB parameter
...
Because this class inherits from AC_AttitudeControl library this new
parameter must be added here as well
2014-06-10 21:25:33 +09:00
Randy Mackay
46f25c52a4
AC_AttControl: allow enabling/disabling feedforward and accel limiting
2014-06-10 20:03:02 +09:00
Randy Mackay
130eb07d48
AC_AttControl: angle_ef_roll_pitch_rate_ef_yaw supports zero yaw accel
2014-06-10 20:02:58 +09:00
Randy Mackay
02b4b21f67
AC_AttControl: disable feed forward by default
...
Can be re-enabled by setting ATC_RATE_FF_ENAB parameter to 1
2014-06-10 20:02:55 +09:00
Randy Mackay
b57c0dabf6
AC_AttControl: check accel_rp_max instead of rate_bff_ff_enabled
...
We use the accel_rp_max, accel_y_max to check whether to apply accel
limiting or not. This is related to separate from the
body-frame-feed-forward.
2014-06-10 20:02:54 +09:00
Randy Mackay
2bb30b3ef9
AC_AttControl: add set_yaw_target_to_current_heading method
2014-06-10 20:02:49 +09:00
Randy Mackay
d9c966c927
AC_AttControl: RATE_FF_ENAB param to disable rate feed forward
2014-06-10 20:02:48 +09:00
Randy Mackay
4d4c7a2118
AC_AttControl: move freeze_ff to flags structure
2014-06-10 20:02:46 +09:00
Randy Mackay
a662f87ffb
AC_AttControl: remove resolved To-Do
...
This To-Do is resolved by heli flight modes calling the
relax_bf_rate_controller method
2014-06-10 20:02:45 +09:00
Randy Mackay
7f734f38d6
AC_AttControl: add earth frame angle constraints
...
This should help recovery time if pilot switches out of ACRO (into
Stabilize, AltHold, etc) while inverted
2014-06-10 20:02:43 +09:00
Randy Mackay
698cf934b8
AC_AttControl: formatting fixes
2014-06-10 20:02:42 +09:00
lthall
2bb63857fa
AC_AttControl: clean up stabilize
2014-06-10 20:02:40 +09:00
lthall
c24d293e1b
AC_AttControl: zero _accel_xyz_max stops feed forward
...
Also added place holder for turning off feed forward.
2014-06-10 20:02:39 +09:00
lthall
8bbce7e658
AC_PosControl: freeze feed forward for alt control in Auto
2014-06-10 20:02:36 +09:00
lthall
922026c15c
AC_AttControl: rate compensation for yaw
2014-06-10 20:02:34 +09:00