Minor modifications
This commit is contained in:
38
index.org
38
index.org
@@ -226,7 +226,6 @@ Bode options.
|
||||
P.Xlim = [1e-1,1e2];
|
||||
P.MagLowerLimMode = 'manual';
|
||||
P.MagLowerLim= 1e-3;
|
||||
%P.PhaseVisible = 'off';
|
||||
#+end_src
|
||||
|
||||
Frequency vector.
|
||||
@@ -234,27 +233,42 @@ Frequency vector.
|
||||
w = 2*pi*logspace(-1,2,1000); % [rad/s]
|
||||
#+end_src
|
||||
|
||||
*** generation of the state space model
|
||||
*** Generation of the State Space Model
|
||||
Mass matrix
|
||||
#+begin_src matlab
|
||||
M = [m 0 0
|
||||
0 m 0
|
||||
0 0 I];
|
||||
#+end_src
|
||||
|
||||
%Jacobian of the bottom sensor
|
||||
Jacobian of the bottom sensor
|
||||
#+begin_src matlab
|
||||
Js1 = [1 0 h/2
|
||||
0 1 -l/2];
|
||||
%Jacobian of the top sensor
|
||||
#+end_src
|
||||
|
||||
Jacobian of the top sensor
|
||||
#+begin_src matlab
|
||||
Js2 = [1 0 -h/2
|
||||
0 1 0];
|
||||
#+end_src
|
||||
|
||||
%Jacobian of the actuators
|
||||
Jacobian of the actuators
|
||||
#+begin_src matlab
|
||||
Ja = [1 0 ha % Left horizontal actuator
|
||||
0 1 -la % Left vertical actuator
|
||||
0 1 la]; % Right vertical actuator
|
||||
Jta = Ja';
|
||||
#+end_src
|
||||
|
||||
Stiffness and Damping matrices
|
||||
#+begin_src matlab
|
||||
K = k*Jta*Ja;
|
||||
C = c*Jta*Ja;
|
||||
#+end_src
|
||||
|
||||
State Space Matrices
|
||||
#+begin_src matlab
|
||||
E = [1 0 0
|
||||
0 1 0
|
||||
0 0 1]; %projecting ground motion in the directions of the legs
|
||||
@@ -265,12 +279,6 @@ Frequency vector.
|
||||
BB = [zeros(3,6)
|
||||
M\Jta M\(k*Jta*E)];
|
||||
|
||||
% BB = [zeros(3,3)
|
||||
% M\Jta ];
|
||||
%
|
||||
% CC = [Ja zeros(3)];
|
||||
% DD = zeros(3,3);
|
||||
|
||||
CC = [[Js1;Js2] zeros(4,3);
|
||||
zeros(2,6)
|
||||
(Js1+Js2)./2 zeros(2,3)
|
||||
@@ -280,12 +288,16 @@ Frequency vector.
|
||||
DD = [zeros(4,6)
|
||||
zeros(2,3) eye(2,3)
|
||||
zeros(6,6)];
|
||||
#+end_src
|
||||
|
||||
State Space model:
|
||||
- Input = three actuators and three ground motions
|
||||
- Output = the bottom sensor; the top sensor; the ground motion; the half sum; the half difference; the rotation
|
||||
|
||||
#+begin_src matlab
|
||||
system_dec = ss(AA,BB,CC,DD);
|
||||
#+end_src
|
||||
|
||||
- Input = three actuators and three ground motions
|
||||
- Output = the bottom sensor; the top sensor; the ground motion; the half sum; the half difference; the rotation
|
||||
|
||||
#+begin_src matlab :results output replace
|
||||
size(system_dec)
|
||||
|
Reference in New Issue
Block a user