summaryrefslogtreecommitdiffstats
path: root/uav_ctrl_lqr.m
diff options
context:
space:
mode:
authorNao Pross <np@0hm.ch>2024-05-16 14:59:06 +0200
committerNao Pross <np@0hm.ch>2024-05-16 14:59:06 +0200
commit6440d952b7a3332423481f27175c2fd876b7e3ae (patch)
tree0a691efaf7e459e49e1f1ed86bd8de812a6d9ac0 /uav_ctrl_lqr.m
parentDelete LQR option from main script, start tuning D-scales (diff)
downloaduav-6440d952b7a3332423481f27175c2fd876b7e3ae.tar.gz
uav-6440d952b7a3332423481f27175c2fd876b7e3ae.zip
Delete old LQR code
Diffstat (limited to 'uav_ctrl_lqr.m')
-rw-r--r--uav_ctrl_lqr.m39
1 files changed, 0 insertions, 39 deletions
diff --git a/uav_ctrl_lqr.m b/uav_ctrl_lqr.m
deleted file mode 100644
index 8063c64..0000000
--- a/uav_ctrl_lqr.m
+++ /dev/null
@@ -1,39 +0,0 @@
-% Copyright (C) 2024, Naoki Sean Pross, ETH Zürich
-%
-% Design a nominal controller for UAV.
-
-function [ctrl_lqr] = uav_ctrl_lqr(params, model)
-
-% ------------------------------------------------------------------------
-% Design a Kalman filter for state estimation
-
-G = model.linear.StateSpace
-[L, P, E] = lqe(G.A, G.
-
-% ------------------------------------------------------------------------
-% Design a nominal LQR controller
-
-% Define penalties according to following priorities
-
-q_pos = 1; % penalty on position
-q_vel = 10; % penalty on linear velocity
-q_ang = 10; % high penalty on angles
-q_rate = 10; % very high penalty on angular velocities
-
-r_ang = 1; % flap movement is cheap
-r_thrust = 10; % thrust is more expensive on the battery
-
-% LQR design matrices
-Q = kron(diag([q_pos, q_vel, q_ang, q_rate]), eye(3));
-R = diag([r_ang, r_ang, r_ang, r_ang, r_thrust]);
-
-% Compute controller using output lqr
-[K, S, poles] = lqry(model.linear.StateSpace, Q, R);
-
-% ------------------------------------------------------------------------
-% Save controller
-
-ctrl_lqr = struct('Name', 'LQR', 'K', K);
-
-end
-% vim: ts=2 sw=2 et: