tdehaeze/nass-simscape
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity
master
nass-simscape/org/flexible_joints_study.org

1274 lines
43 KiB
Org Mode
Raw Permalink Normal View History

Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+TITLE: Study of the Flexible Joints
#+SETUPFILE: ./setup/org-setup-file.org
* Introduction :ignore:
In this document is studied the effect of the mechanical behavior of the flexible joints that are located the extremities of each nano-hexapod's legs.
Ideally, we want the x and y rotations to be free and all the translations to be blocked.
However, this is never the case and be have to consider:
Update few figures
2020-05-05 11:27:37 +02:00
- Finite bending stiffnesses (Section [[sec:rot_stiffness]])
- Axial stiffness in the direction of the legs (Section [[sec:trans_stiffness]])
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
Update few figures
2020-05-05 11:27:37 +02:00
This may impose some limitations, also, the goal is to specify the required joints stiffnesses (summarized in Section [[sec:conclusion]]).
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
Update few figures
2020-05-05 11:27:37 +02:00
* Bending and Torsional Stiffness
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
<<sec:rot_stiffness>>
** Introduction :ignore:
In this section, we wish to study the effect of the rotation flexibility of the nano-hexapod joints.
** Matlab Init :noexport:ignore:
#+begin_src matlab :tangle no :exports none :results silent :noweb yes :var current_dir=(file-name-directory buffer-file-name)
<<matlab-dir>>
#+end_src
#+begin_src matlab :exports none :results silent :noweb yes
<<matlab-init>>
#+end_src
#+begin_src matlab :tangle no
simulinkproject('../');
#+end_src
#+begin_src matlab
load('mat/conf_simulink.mat');
open('nass_model.slx')
#+end_src
** Initialization
Let's initialize all the stages with default parameters.
#+begin_src matlab
initializeGround();
initializeGranite();
initializeTy();
initializeRy();
initializeRz();
initializeMicroHexapod();
initializeAxisc();
initializeMirror();
#+end_src
#+begin_src matlab :exports none
initializeSimscapeConfiguration();
initializeDisturbances('enable', false);
initializeLoggingConfiguration('log', 'none');
initializeController('type', 'hac-dvf');
#+end_src
Let's consider the heaviest mass which should we the most problematic with it comes to the flexible joints.
#+begin_src matlab
initializeSample('mass', 50, 'freq', 200*ones(6,1));
initializeReferences('Rz_type', 'rotating-not-filtered', 'Rz_period', 60);
#+end_src
#+begin_src matlab :exports none
K = tf(zeros(6));
Kdvf = tf(zeros(6));
#+end_src
Update few figures
2020-05-05 11:27:37 +02:00
** Realistic Bending Stiffness Values
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
*** Introduction :ignore:
Let's compare the ideal case (zero stiffness in rotation and infinite stiffness in translation) with a more realistic case:
- $K_{\theta, \phi} = 15\,[Nm/rad]$ stiffness in flexion
- $K_{\psi} = 20\,[Nm/rad]$ stiffness in torsion
#+begin_src matlab
Kf_M = 15*ones(6,1);
Kf_F = 15*ones(6,1);
Continue flexible joint study
2020-05-05 10:34:45 +02:00
Kt_M = 20*ones(6,1);
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
Kt_F = 20*ones(6,1);
#+end_src
The stiffness and damping of the nano-hexapod's legs are:
#+begin_src matlab
Continue flexible joint study
2020-05-05 10:34:45 +02:00
k_opt = 1e5; % [N/m]
c_opt = 2e2; % [N/(m/s)]
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+end_src
Continue flexible joint study
2020-05-05 10:34:45 +02:00
This corresponds to the optimal identified stiffness.
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
*** Direct Velocity Feedback
We identify the dynamics from actuators force $\tau_i$ to relative motion sensors $d\mathcal{L}_i$ with and without considering the flexible joint stiffness.
The obtained dynamics are shown in Figure [[fig:flex_joint_rot_dvf]].
It is shown that the adding of stiffness for the flexible joints does increase a little bit the frequencies of the mass suspension modes. It stiffen the structure.
#+begin_src matlab :exports none
%% Name of the Simulink File
mdl = 'nass_model';
%% Input/Output definition
clear io; io_i = 1;
io(io_i) = linio([mdl, '/Controller'], 1, 'openinput'); io_i = io_i + 1; % Actuator Inputs
io(io_i) = linio([mdl, '/Micro-Station'], 3, 'openoutput', [], 'Dnlm'); io_i = io_i + 1; % Force Sensors
#+end_src
#+begin_src matlab :exports none
Continue flexible joint study
2020-05-05 10:34:45 +02:00
initializeNanoHexapod('k', k_opt, 'c', c_opt, ...
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
'type_F', 'universal_p', ...
'type_M', 'spherical_p');
G_dvf_p = linearize(mdl, io);
G_dvf_p.InputName = {'Fnl1', 'Fnl2', 'Fnl3', 'Fnl4', 'Fnl5', 'Fnl6'};
G_dvf_p.OutputName = {'Dnlm1', 'Dnlm2', 'Dnlm3', 'Dnlm4', 'Dnlm5', 'Dnlm6'};
#+end_src
#+begin_src matlab :exports none
Continue flexible joint study
2020-05-05 10:34:45 +02:00
initializeNanoHexapod('k', k_opt, 'c', c_opt, ...
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
'type_F', 'universal', ...
'type_M', 'spherical', ...
'Kf_M', Kf_M, ...
'Kt_M', Kt_M, ...
'Kf_F', Kf_F, ...
'Kt_F', Kt_F);
G_dvf = linearize(mdl, io);
G_dvf.InputName = {'Fnl1', 'Fnl2', 'Fnl3', 'Fnl4', 'Fnl5', 'Fnl6'};
G_dvf.OutputName = {'Dnlm1', 'Dnlm2', 'Dnlm3', 'Dnlm4', 'Dnlm5', 'Dnlm6'};
#+end_src
#+begin_src matlab :exports none
freqs = logspace(-1, 3, 1000);
figure;
ax1 = subplot(2, 1, 1);
hold on;
plot(freqs, abs(squeeze(freqresp(G_dvf(1, 1), freqs, 'Hz'))));
plot(freqs, abs(squeeze(freqresp(G_dvf_p(1, 1), freqs, 'Hz'))));
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'log');
ylabel('Amplitude [m/N]'); set(gca, 'XTickLabel',[]);
ax2 = subplot(2, 1, 2);
hold on;
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(G_dvf(1, 1), freqs, 'Hz')))), ...
'DisplayName', 'Flexible Joints');
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(G_dvf_p(1, 1), freqs, 'Hz')))), ...
'DisplayName', 'Perfect Joints');
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'lin');
ylabel('Phase [deg]'); xlabel('Frequency [Hz]');
ylim([-270, 90]);
yticks([-360:90:360]);
legend('location', 'northeast');
linkaxes([ax1,ax2],'x');
#+end_src
#+begin_src matlab :tangle no :exports results :results file replace
Continue flexible joint study
2020-05-05 10:34:45 +02:00
exportFig('figs/flex_joint_rot_dvf.pdf', 'width', 'full', 'height', 'full');
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+end_src
#+name: fig:flex_joint_rot_dvf
#+caption: Dynamics from actuators force $\tau_i$ to relative motion sensors $d\mathcal{L}_i$ with (blue) and without (red) considering the flexible joint stiffness
#+RESULTS:
[[file:figs/flex_joint_rot_dvf.png]]
*** Primary Plant
#+begin_src matlab :exports none
Kdvf = 5e3*s/(1+s/2/pi/1e3)*eye(6);
#+end_src
Let's now identify the dynamics from $\bm{\tau}^\prime$ to $\bm{\epsilon}_{\mathcal{X}_n}$ (for the primary controller designed in the frame of the legs).
The dynamics is compare with and without the joint flexibility in Figure [[fig:flex_joints_rot_primary_plant_L]].
The plant dynamics is not found to be changing significantly.
#+begin_src matlab :exports none
%% Name of the Simulink File
mdl = 'nass_model';
%% Input/Output definition
clear io; io_i = 1;
io(io_i) = linio([mdl, '/Controller'], 1, 'input'); io_i = io_i + 1; % Actuator Inputs
io(io_i) = linio([mdl, '/Tracking Error'], 1, 'output', [], 'En'); io_i = io_i + 1; % Position Errror
load('mat/stages.mat', 'nano_hexapod');
#+end_src
#+begin_src matlab :exports none
Continue flexible joint study
2020-05-05 10:34:45 +02:00
initializeNanoHexapod('k', k_opt, 'c', c_opt, ...
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
'type_F', 'universal_p', ...
'type_M', 'spherical_p');
Continue flexible joint study
2020-05-05 10:34:45 +02:00
G = linearize(mdl, io);
G.InputName = {'Fnl1', 'Fnl2', 'Fnl3', 'Fnl4', 'Fnl5', 'Fnl6'};
G.OutputName = {'Ex', 'Ey', 'Ez', 'Erx', 'Ery', 'Erz'};
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
Continue flexible joint study
2020-05-05 10:34:45 +02:00
Gl_p = -nano_hexapod.kinematics.J*G;
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
Gl_p.OutputName = {'E1', 'E2', 'E3', 'E4', 'E5', 'E6'};
#+end_src
#+begin_src matlab :exports none
Continue flexible joint study
2020-05-05 10:34:45 +02:00
initializeNanoHexapod('k', k_opt, 'c', c_opt, ...
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
'type_F', 'universal', ...
'type_M', 'spherical', ...
'Kf_M', Kf_M, ...
'Kt_M', Kt_M, ...
'Kf_F', Kf_F, ...
'Kt_F', Kt_F);
G = linearize(mdl, io);
G.InputName = {'Fnl1', 'Fnl2', 'Fnl3', 'Fnl4', 'Fnl5', 'Fnl6'};
G.OutputName = {'Ex', 'Ey', 'Ez', 'Erx', 'Ery', 'Erz'};
Gl = -nano_hexapod.kinematics.J*G;
Gl.OutputName = {'E1', 'E2', 'E3', 'E4', 'E5', 'E6'};
#+end_src
#+begin_src matlab :exports none
freqs = logspace(0, 3, 1000);
figure;
ax1 = subplot(2, 1, 1);
hold on;
for j = 1:6
set(gca,'ColorOrderIndex',1);
plot(freqs, abs(squeeze(freqresp(Gl(j, j), freqs, 'Hz'))));
end
for j = 1:6
set(gca,'ColorOrderIndex',2);
Update few figures
2020-05-05 11:27:37 +02:00
plot(freqs, abs(squeeze(freqresp(Gl_p(j, j), freqs, 'Hz'))));
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
end
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'log');
ylabel('Amplitude [m/N]'); set(gca, 'XTickLabel',[]);
ax2 = subplot(2, 1, 2);
hold on;
for j = 1:6
set(gca,'ColorOrderIndex',1);
Update few figures
2020-05-05 11:27:37 +02:00
if j == 1
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(Gl(j, j), freqs, 'Hz')))), ...
'DisplayName', 'Flexible Joints');
else
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(Gl(j, j), freqs, 'Hz')))), ...
'HandleVisibility', 'off');
end
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
end
for j = 1:6
set(gca,'ColorOrderIndex',2);
Update few figures
2020-05-05 11:27:37 +02:00
if j == 1
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(Gl_p(j, j), freqs, 'Hz')))), ...
'DisplayName', 'Perfect Joints');
else
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(Gl_p(j, j), freqs, 'Hz')))), ...
'HandleVisibility', 'off');
end
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
end
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'lin');
ylabel('Phase [deg]'); xlabel('Frequency [Hz]');
ylim([-270, 90]);
yticks([-360:90:360]);
Update few figures
2020-05-05 11:27:37 +02:00
legend('location', 'southwest');
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
linkaxes([ax1,ax2],'x');
#+end_src
#+begin_src matlab :tangle no :exports results :results file replace
exportFig('figs/flex_joints_rot_primary_plant_L.pdf', 'width', 'full', 'height', 'full');
#+end_src
#+name: fig:flex_joints_rot_primary_plant_L
Update few figures
2020-05-05 11:27:37 +02:00
#+caption: Dynamics from $\bm{\tau}^\prime_i$ to $\bm{\epsilon}_{\mathcal{X}_n,i}$ with perfect joints and with flexible joints
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+RESULTS:
[[file:figs/flex_joints_rot_primary_plant_L.png]]
*** Conclusion
#+begin_important
Update few figures
2020-05-05 11:27:37 +02:00
Considering realistic flexible joint bending stiffness for the nano-hexapod does not seems to impose any limitation on the DVF control nor on the primary control.
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
It only increases a little bit the suspension modes of the sample on top of the nano-hexapod.
#+end_important
** Parametric Study
*** Introduction :ignore:
We wish now to see what is the impact of the rotation stiffness of the flexible joints on the dynamics.
This will help to determine the requirements on the joint's stiffness.
Update few figures
2020-05-05 11:27:37 +02:00
Let's consider the following bending stiffness of the flexible joints:
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+begin_src matlab
Continue flexible joint study
2020-05-05 10:34:45 +02:00
Ks = [1, 5, 10, 50, 100]; % [Nm/rad]
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+end_src
We also consider here a nano-hexapod with the identified optimal actuator stiffness.
#+begin_src matlab :exports none
K = tf(zeros(6));
Kdvf = tf(zeros(6));
#+end_src
*** Direct Velocity Feedback
The dynamics from the actuators to the relative displacement sensor in each leg is identified and shown in Figure [[fig:flex_joints_rot_study_dvf]].
The corresponding Root Locus plot is shown in Figure [[fig:flex_joints_rot_study_dvf_root_locus]].
Update few figures
2020-05-05 11:27:37 +02:00
It is shown that the bending stiffness of the flexible joints does indeed change a little the dynamics, but critical damping is stiff achievable with Direct Velocity Feedback.
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+begin_src matlab :exports none
%% Name of the Simulink File
mdl = 'nass_model';
%% Input/Output definition
clear io; io_i = 1;
io(io_i) = linio([mdl, '/Controller'], 1, 'openinput'); io_i = io_i + 1; % Actuator Inputs
Continue flexible joint study
2020-05-05 10:34:45 +02:00
io(io_i) = linio([mdl, '/Micro-Station'], 3, 'openoutput', [], 'Dnlm'); io_i = io_i + 1; % Relative Displacement Sensors
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
Continue flexible joint study
2020-05-05 10:34:45 +02:00
G_dvf_s = {zeros(length(Ks), 1)};
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
for i = 1:length(Ks)
Continue flexible joint study
2020-05-05 10:34:45 +02:00
initializeNanoHexapod('k', k_opt, 'c', c_opt, ...
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
'type_F', 'universal', ...
'type_M', 'spherical', ...
'Kf_M', Ks(i), ...
'Kt_M', Ks(i), ...
'Kf_F', Ks(i), ...
Continue flexible joint study
2020-05-05 10:34:45 +02:00
'Kt_F', Ks(i));
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
Continue flexible joint study
2020-05-05 10:34:45 +02:00
G = linearize(mdl, io);
G.InputName = {'Fnl1', 'Fnl2', 'Fnl3', 'Fnl4', 'Fnl5', 'Fnl6'};
G.OutputName = {'Dnlm1', 'Dnlm2', 'Dnlm3', 'Dnlm4', 'Dnlm5', 'Dnlm6'};
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
Continue flexible joint study
2020-05-05 10:34:45 +02:00
G_dvf_s(i) = {G};
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
end
#+end_src
#+begin_src matlab :exports none
freqs = logspace(-1, 3, 1000);
figure;
ax1 = subplot(2, 1, 1);
hold on;
for i = 1:length(Ks)
Continue flexible joint study
2020-05-05 10:34:45 +02:00
plot(freqs, abs(squeeze(freqresp(G_dvf_s{i}(1, 1), freqs, 'Hz'))));
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
end
plot(freqs, abs(squeeze(freqresp(G_dvf_p(1, 1), freqs, 'Hz'))), 'k--');
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'log');
ylabel('Amplitude [m/N]'); set(gca, 'XTickLabel',[]);
ax2 = subplot(2, 1, 2);
hold on;
for i = 1:length(Ks)
Continue flexible joint study
2020-05-05 10:34:45 +02:00
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(G_dvf_s{i}(1, 1), freqs, 'Hz')))), ...
Update few figures
2020-05-05 11:27:37 +02:00
'DisplayName', sprintf('$k = %.0f$ [Nm/rad]', Ks(i)));
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
end
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(G_dvf_p(1, 1), freqs, 'Hz')))), 'k--', ...
'DisplayName', 'Ideal Joint');
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'lin');
ylabel('Phase [deg]'); xlabel('Frequency [Hz]');
ylim([-270, 90]);
yticks([-360:90:360]);
legend('location', 'southwest');
linkaxes([ax1,ax2],'x');
#+end_src
#+begin_src matlab :tangle no :exports results :results file replace
Continue flexible joint study
2020-05-05 10:34:45 +02:00
exportFig('figs/flex_joints_rot_study_dvf.pdf', 'width', 'full', 'height', 'full');
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+end_src
#+name: fig:flex_joints_rot_study_dvf
#+caption: Dynamics from $\tau_i$ to $d\mathcal{L}_i$ for all the considered Rotation Stiffnesses
#+RESULTS:
[[file:figs/flex_joints_rot_study_dvf.png]]
#+begin_src matlab :exports none
figure;
gains = logspace(2, 5, 300);
hold on;
for i = 1:length(Ks)
set(gca,'ColorOrderIndex',i);
Continue flexible joint study
2020-05-05 10:34:45 +02:00
plot(real(pole(G_dvf_s{i})), imag(pole(G_dvf_s{i})), 'x', ...
Update few figures
2020-05-05 11:27:37 +02:00
'DisplayName', sprintf('$k = %.0f$ [Nm/rad]', Ks(i)));
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
set(gca,'ColorOrderIndex',i);
Continue flexible joint study
2020-05-05 10:34:45 +02:00
plot(real(tzero(G_dvf_s{i})), imag(tzero(G_dvf_s{i})), 'o', ...
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
'HandleVisibility', 'off');
for k = 1:length(gains)
set(gca,'ColorOrderIndex',i);
Continue flexible joint study
2020-05-05 10:34:45 +02:00
cl_poles = pole(feedback(G_dvf_s{i}, (gains(k)*s)*eye(6)));
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
plot(real(cl_poles), imag(cl_poles), '.', ...
'HandleVisibility', 'off');
end
end
hold off;
axis square;
xlim([-140, 10]); ylim([0, 150]);
xlabel('Real Part'); ylabel('Imaginary Part');
legend('location', 'northwest');
#+end_src
#+begin_src matlab :tangle no :exports results :results file replace
Continue flexible joint study
2020-05-05 10:34:45 +02:00
exportFig('figs/flex_joints_rot_study_dvf_root_locus.pdf', 'width', 'wide', 'height', 'tall');
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+end_src
#+name: fig:flex_joints_rot_study_dvf_root_locus
#+caption: Root Locus for all the considered Rotation Stiffnesses
#+RESULTS:
[[file:figs/flex_joints_rot_study_dvf_root_locus.png]]
*** Primary Control
Continue flexible joint study
2020-05-05 10:34:45 +02:00
The dynamics from $\bm{\tau}^\prime$ to $\bm{\epsilon}_{\mathcal{X}_n}$ (for the primary controller designed in the frame of the legs) is shown in Figure [[fig:flex_joints_rot_study_primary_plant]].
Update few figures
2020-05-05 11:27:37 +02:00
It is shown that the bending stiffness of the flexible joints have very little impact on the dynamics.
Continue flexible joint study
2020-05-05 10:34:45 +02:00
#+begin_src matlab :exports none
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
Kdvf = 5e3*s/(1+s/2/pi/1e3)*eye(6);
#+end_src
#+begin_src matlab :exports none
%% Name of the Simulink File
mdl = 'nass_model';
%% Input/Output definition
clear io; io_i = 1;
io(io_i) = linio([mdl, '/Controller'], 1, 'input'); io_i = io_i + 1; % Actuator Inputs
io(io_i) = linio([mdl, '/Tracking Error'], 1, 'output', [], 'En'); io_i = io_i + 1; % Position Errror
load('mat/stages.mat', 'nano_hexapod');
Continue flexible joint study
2020-05-05 10:34:45 +02:00
Gl_s = {zeros(length(Ks), 1)};
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
for i = 1:length(Ks)
Continue flexible joint study
2020-05-05 10:34:45 +02:00
initializeNanoHexapod('k', k_opt, 'c', c_opt, ...
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
'type_F', 'universal', ...
'type_M', 'spherical', ...
'Kf_M', Ks(i), ...
Continue flexible joint study
2020-05-05 10:34:45 +02:00
'Kt_M', Ks(i), ...
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
'Kf_F', Ks(i), ...
Continue flexible joint study
2020-05-05 10:34:45 +02:00
'Kt_F', Ks(i));
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
G = linearize(mdl, io);
G.InputName = {'Fnl1', 'Fnl2', 'Fnl3', 'Fnl4', 'Fnl5', 'Fnl6'};
G.OutputName = {'Ex', 'Ey', 'Ez', 'Erx', 'Ery', 'Erz'};
Continue flexible joint study
2020-05-05 10:34:45 +02:00
Gl = -nano_hexapod.kinematics.J*G;
Gl.OutputName = {'E1', 'E2', 'E3', 'E4', 'E5', 'E6'};
Gl_s(i) = {Gl};
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
end
#+end_src
#+begin_src matlab :exports none
freqs = logspace(-1, 3, 1000);
figure;
ax1 = subplot(2, 1, 1);
hold on;
for i = 1:length(Ks)
Continue flexible joint study
2020-05-05 10:34:45 +02:00
plot(freqs, abs(squeeze(freqresp(Gl_s{i}(1, 1), freqs, 'Hz'))));
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
end
plot(freqs, abs(squeeze(freqresp(Gl_p(1, 1), freqs, 'Hz'))), 'k--');
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'log');
ylabel('Amplitude [m/N]'); set(gca, 'XTickLabel',[]);
ax2 = subplot(2, 1, 2);
hold on;
for i = 1:length(Ks)
Continue flexible joint study
2020-05-05 10:34:45 +02:00
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(Gl_s{i}(1, 1), freqs, 'Hz')))), ...
Update few figures
2020-05-05 11:27:37 +02:00
'DisplayName', sprintf('$k = %.0f$ [Nm/rad]', Ks(i)));
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
end
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(Gl_p(1, 1), freqs, 'Hz')))), 'k--', ...
'DisplayName', 'Ideal Joint');
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'lin');
ylabel('Phase [deg]'); xlabel('Frequency [Hz]');
ylim([-270, 90]);
yticks([-360:90:360]);
legend('location', 'southwest');
linkaxes([ax1,ax2],'x');
#+end_src
#+begin_src matlab :tangle no :exports results :results file replace
exportFig('figs/flex_joints_rot_study_primary_plant.pdf', 'width', 'full', 'height', 'full');
#+end_src
#+name: fig:flex_joints_rot_study_primary_plant
Update few figures
2020-05-05 11:27:37 +02:00
#+caption: Diagonal elements of the transfer function matrix from $\bm{\tau}^\prime$ to $\bm{\epsilon}_{\mathcal{X}_n}$ for the considered bending stiffnesses
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+RESULTS:
[[file:figs/flex_joints_rot_study_primary_plant.png]]
*** Conclusion
#+begin_important
Update few figures
2020-05-05 11:27:37 +02:00
The bending stiffness of the flexible joint does not significantly change the dynamics.
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+end_important
Update conclusion about flexible joints
2020-05-05 11:50:07 +02:00
* Axial Stiffness
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
<<sec:trans_stiffness>>
** Introduction :ignore:
Continue flexible joint study
2020-05-05 10:34:45 +02:00
Let's know consider a flexibility in translation of the flexible joint, in the axis of the legs.
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
** Matlab Init :noexport:ignore:
#+begin_src matlab :tangle no :exports none :results silent :noweb yes :var current_dir=(file-name-directory buffer-file-name)
<<matlab-dir>>
#+end_src
#+begin_src matlab :exports none :results silent :noweb yes
<<matlab-init>>
#+end_src
#+begin_src matlab :tangle no
simulinkproject('../');
#+end_src
#+begin_src matlab
load('mat/conf_simulink.mat');
open('nass_model.slx')
#+end_src
Continue flexible joint study
2020-05-05 10:34:45 +02:00
** Realistic Translation Stiffness Values
*** Introduction :ignore:
We choose realistic values of the axial stiffness of the joints:
\[ K_a = 60\,[N/\mu m] \]
#+begin_src matlab
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
Ka_F = 60e6*ones(6,1); % [N/m]
Ka_M = 60e6*ones(6,1); % [N/m]
Ca_F = 1*ones(6,1); % [N/(m/s)]
Ca_M = 1*ones(6,1); % [N/(m/s)]
Continue flexible joint study
2020-05-05 10:34:45 +02:00
#+end_src
*** Initialization
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
Let's initialize all the stages with default parameters.
#+begin_src matlab
initializeGround();
initializeGranite();
initializeTy();
initializeRy();
initializeRz();
initializeMicroHexapod();
initializeAxisc();
initializeMirror();
#+end_src
#+begin_src matlab :exports none
initializeSimscapeConfiguration();
initializeDisturbances('enable', false);
initializeLoggingConfiguration('log', 'none');
initializeController('type', 'hac-dvf');
#+end_src
Let's consider the heaviest mass which should we the most problematic with it comes to the flexible joints.
#+begin_src matlab
initializeSample('mass', 50, 'freq', 200*ones(6,1));
initializeReferences('Rz_type', 'rotating-not-filtered', 'Rz_period', 60);
#+end_src
#+begin_src matlab :exports none
K = tf(zeros(6));
Kdvf = tf(zeros(6));
#+end_src
Continue flexible joint study
2020-05-05 10:34:45 +02:00
*** Direct Velocity Feedback
The dynamics from actuators force $\tau_i$ to relative motion sensors $d\mathcal{L}_i$ with and without considering the flexible joint stiffness are identified.
The obtained dynamics are shown in Figure [[fig:flex_joint_trans_dvf]].
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+begin_src matlab :exports none
%% Name of the Simulink File
mdl = 'nass_model';
%% Input/Output definition
clear io; io_i = 1;
io(io_i) = linio([mdl, '/Controller'], 1, 'openinput'); io_i = io_i + 1; % Actuator Inputs
io(io_i) = linio([mdl, '/Micro-Station'], 3, 'openoutput', [], 'Dnlm'); io_i = io_i + 1; % Force Sensors
#+end_src
#+begin_src matlab :exports none
Continue flexible joint study
2020-05-05 10:34:45 +02:00
initializeNanoHexapod('k', k_opt, 'c', c_opt, ...
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
'type_F', 'universal_3dof', ...
'type_M', 'spherical_3dof', ...
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
'Ka_F', Ka_F, ...
'Ka_M', Ka_M, ...
'Ca_F', Ca_F, ...
'Ca_M', Ca_M);
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
G_dvf_3dof = linearize(mdl, io);
G_dvf_3dof.InputName = {'Fnl1', 'Fnl2', 'Fnl3', 'Fnl4', 'Fnl5', 'Fnl6'};
G_dvf_3dof.OutputName = {'Dnlm1', 'Dnlm2', 'Dnlm3', 'Dnlm4', 'Dnlm5', 'Dnlm6'};
#+end_src
#+begin_src matlab :exports none
Continue flexible joint study
2020-05-05 10:34:45 +02:00
initializeNanoHexapod('k', k_opt, 'c', c_opt, ...
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
'type_F', 'universal', ...
'type_M', 'spherical');
G_dvf = linearize(mdl, io);
G_dvf.InputName = {'Fnl1', 'Fnl2', 'Fnl3', 'Fnl4', 'Fnl5', 'Fnl6'};
G_dvf.OutputName = {'Dnlm1', 'Dnlm2', 'Dnlm3', 'Dnlm4', 'Dnlm5', 'Dnlm6'};
#+end_src
#+begin_src matlab :exports none
freqs = logspace(-1, 3, 1000);
figure;
ax1 = subplot(2, 1, 1);
hold on;
plot(freqs, abs(squeeze(freqresp(G_dvf(1, 1), freqs, 'Hz'))));
plot(freqs, abs(squeeze(freqresp(G_dvf_3dof(1, 1), freqs, 'Hz'))));
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'log');
ylabel('Amplitude [m/N]'); set(gca, 'XTickLabel',[]);
ax2 = subplot(2, 1, 2);
hold on;
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(G_dvf(1, 1), freqs, 'Hz')))), ...
'DisplayName', '2dof Joints');
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(G_dvf_3dof(1, 1), freqs, 'Hz')))), ...
'DisplayName', '3dof Joints');
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'lin');
ylabel('Phase [deg]'); xlabel('Frequency [Hz]');
ylim([-270, 90]);
yticks([-360:90:360]);
legend('location', 'northeast');
linkaxes([ax1,ax2],'x');
#+end_src
#+begin_src matlab :tangle no :exports results :results file replace
Continue flexible joint study
2020-05-05 10:34:45 +02:00
exportFig('figs/flex_joint_trans_dvf.pdf', 'width', 'full', 'height', 'full');
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+end_src
#+name: fig:flex_joint_trans_dvf
Continue flexible joint study
2020-05-05 10:34:45 +02:00
#+caption: Dynamics from actuators force $\tau_i$ to relative motion sensors $d\mathcal{L}_i$ with (blue) and without (red) considering the flexible joint axis stiffness
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+RESULTS:
[[file:figs/flex_joint_trans_dvf.png]]
Continue flexible joint study
2020-05-05 10:34:45 +02:00
*** Primary Plant
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+begin_src matlab
Kdvf = 5e3*s/(1+s/2/pi/1e3)*eye(6);
#+end_src
Continue flexible joint study
2020-05-05 10:34:45 +02:00
Let's now identify the dynamics from $\bm{\tau}^\prime$ to $\bm{\epsilon}_{\mathcal{X}_n}$ (for the primary controller designed in the frame of the legs).
The dynamics is compare with and without the joint flexibility in Figure [[fig:flex_joints_trans_primary_plant_L]].
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+begin_src matlab :exports none
%% Name of the Simulink File
mdl = 'nass_model';
%% Input/Output definition
clear io; io_i = 1;
io(io_i) = linio([mdl, '/Controller'], 1, 'input'); io_i = io_i + 1; % Actuator Inputs
io(io_i) = linio([mdl, '/Tracking Error'], 1, 'output', [], 'En'); io_i = io_i + 1; % Position Errror
load('mat/stages.mat', 'nano_hexapod');
#+end_src
#+begin_src matlab :exports none
Continue flexible joint study
2020-05-05 10:34:45 +02:00
initializeNanoHexapod('k', k_opt, 'c', c_opt, ...
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
'type_F', 'universal_3dof', ...
'type_M', 'spherical_3dof', ...
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
'Ka_F', Ka_F, ...
'Ka_M', Ka_M, ...
'Ca_F', Ca_F, ...
'Ca_M', Ca_M);
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
Continue flexible joint study
2020-05-05 10:34:45 +02:00
G = linearize(mdl, io);
G.InputName = {'Fnl1', 'Fnl2', 'Fnl3', 'Fnl4', 'Fnl5', 'Fnl6'};
G.OutputName = {'Ex', 'Ey', 'Ez', 'Erx', 'Ery', 'Erz'};
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
Continue flexible joint study
2020-05-05 10:34:45 +02:00
Gl_3dof = -nano_hexapod.kinematics.J*G;
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
Gl_3dof.OutputName = {'E1', 'E2', 'E3', 'E4', 'E5', 'E6'};
#+end_src
#+begin_src matlab :exports none
Continue flexible joint study
2020-05-05 10:34:45 +02:00
initializeNanoHexapod('k', k_opt, 'c', c_opt, ...
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
'type_F', 'universal', ...
'type_M', 'spherical');
G = linearize(mdl, io);
G.InputName = {'Fnl1', 'Fnl2', 'Fnl3', 'Fnl4', 'Fnl5', 'Fnl6'};
G.OutputName = {'Ex', 'Ey', 'Ez', 'Erx', 'Ery', 'Erz'};
Gl = -nano_hexapod.kinematics.J*G;
Gl.OutputName = {'E1', 'E2', 'E3', 'E4', 'E5', 'E6'};
#+end_src
#+begin_src matlab :exports none
freqs = logspace(0, 3, 1000);
figure;
ax1 = subplot(2, 1, 1);
hold on;
for j = 1:6
set(gca,'ColorOrderIndex',1);
plot(freqs, abs(squeeze(freqresp(Gl(j, j), freqs, 'Hz'))));
end
for j = 1:6
set(gca,'ColorOrderIndex',2);
plot(freqs, abs(squeeze(freqresp(Gl_3dof(j, j), freqs, 'Hz'))), '--');
end
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'log');
ylabel('Amplitude [m/N]'); set(gca, 'XTickLabel',[]);
title('Diagonal elements of the Plant');
ax2 = subplot(2, 1, 2);
hold on;
for j = 1:6
set(gca,'ColorOrderIndex',1);
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(Gl(j, j), freqs, 'Hz')))));
end
for j = 1:6
set(gca,'ColorOrderIndex',2);
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(Gl_3dof(j, j), freqs, 'Hz')))), '--');
end
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'lin');
ylabel('Phase [deg]'); xlabel('Frequency [Hz]');
ylim([-270, 90]);
yticks([-360:90:360]);
linkaxes([ax1,ax2],'x');
#+end_src
#+begin_src matlab :tangle no :exports results :results file replace
Continue flexible joint study
2020-05-05 10:34:45 +02:00
exportFig('figs/flex_joints_trans_primary_plant_L.pdf', 'width', 'full', 'height', 'full');
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+end_src
#+name: fig:flex_joints_trans_primary_plant_L
Continue flexible joint study
2020-05-05 10:34:45 +02:00
#+caption: Dynamics from $\bm{\tau}^\prime_i$ to $\bm{\epsilon}_{\mathcal{X}_n,i}$ with infinite axis stiffnes (solid) and with realistic axial stiffness (dashed)
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+RESULTS:
[[file:figs/flex_joints_trans_primary_plant_L.png]]
Update few figures
2020-05-05 11:27:37 +02:00
*** Conclusion
#+begin_important
For the realistic value of the flexible joint axial stiffness, the dynamics is not much impact, and this should not be a problem for control.
#+end_important
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
** Parametric study
*** Introduction :ignore:
Continue flexible joint study
2020-05-05 10:34:45 +02:00
We wish now to see what is the impact of the *axial* stiffness of the flexible joints on the dynamics.
Let's consider the following values for the axial stiffness:
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+begin_src matlab
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
Kas = [1e4, 1e5, 1e6, 1e7, 1e8, 1e9]; % [N/m]
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+end_src
Continue flexible joint study
2020-05-05 10:34:45 +02:00
We also consider here a nano-hexapod with the identified optimal actuator stiffness ($k = 10^5\,[N/m]$).
#+begin_src matlab :exports none
K = tf(zeros(6));
Kdvf = tf(zeros(6));
#+end_src
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
*** Direct Velocity Feedback
Continue flexible joint study
2020-05-05 10:34:45 +02:00
The dynamics from the actuators to the relative displacement sensor in each leg is identified and shown in Figure [[fig:flex_joints_trans_study_dvf]].
It is shown that the axial stiffness of the flexible joints does have a huge impact on the dynamics.
If the axial stiffness of the flexible joints is $K_a > 10^7\,[N/m]$ (here $100$ times higher than the actuator stiffness), then the change of dynamics stays reasonably small.
This is more clear by looking at the root locus (Figures [[fig:flex_joints_trans_study_dvf_root_locus]] and [[fig:flex_joints_trans_study_root_locus_unzoom]]).
Update few figures
2020-05-05 11:27:37 +02:00
It can be seen that very little active damping can be achieve for axial stiffnesses below $10^7\,[N/m]$.
Continue flexible joint study
2020-05-05 10:34:45 +02:00
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+begin_src matlab :exports none
%% Name of the Simulink File
mdl = 'nass_model';
%% Input/Output definition
clear io; io_i = 1;
io(io_i) = linio([mdl, '/Controller'], 1, 'openinput'); io_i = io_i + 1; % Actuator Inputs
io(io_i) = linio([mdl, '/Micro-Station'], 3, 'openoutput', [], 'Dnlm'); io_i = io_i + 1; % Force Sensors
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
G_dvf_3dof_s = {zeros(length(Kas), 1)};
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
for i = 1:length(Kas)
Continue flexible joint study
2020-05-05 10:34:45 +02:00
initializeNanoHexapod('k', k_opt, 'c', c_opt, ...
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
'type_F', 'universal_3dof', ...
'type_M', 'spherical_3dof', ...
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
'Ka_F', Kas(i), ...
'Ka_M', Kas(i), ...
'Ca_F', 0.05*sqrt(Kas(i)*10), ...
'Ca_M', 0.05*sqrt(Kas(i)*10));
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
G = linearize(mdl, io);
G.InputName = {'Fnl1', 'Fnl2', 'Fnl3', 'Fnl4', 'Fnl5', 'Fnl6'};
G.OutputName = {'Dnlm1', 'Dnlm2', 'Dnlm3', 'Dnlm4', 'Dnlm5', 'Dnlm6'};
Continue flexible joint study
2020-05-05 10:34:45 +02:00
G_dvf_3dof_s(i) = {G};
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
end
#+end_src
#+begin_src matlab :exports none
freqs = logspace(-1, 3, 1000);
figure;
ax1 = subplot(2, 1, 1);
hold on;
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
for i = 1:length(Kas)
Continue flexible joint study
2020-05-05 10:34:45 +02:00
plot(freqs, abs(squeeze(freqresp(G_dvf_3dof_s{i}(1, 1), freqs, 'Hz'))));
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
end
Continue flexible joint study
2020-05-05 10:34:45 +02:00
plot(freqs, abs(squeeze(freqresp(G_dvf(1, 1), freqs, 'Hz'))), 'k--');
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'log');
ylabel('Amplitude [m/N]'); set(gca, 'XTickLabel',[]);
ax2 = subplot(2, 1, 2);
hold on;
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
for i = 1:length(Kas)
Continue flexible joint study
2020-05-05 10:34:45 +02:00
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(G_dvf_3dof_s{i}(1, 1), freqs, 'Hz')))), ...
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
'DisplayName', sprintf('$k = %.0g$ [N/m]', Kas(i)));
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
end
Continue flexible joint study
2020-05-05 10:34:45 +02:00
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(G_dvf(1, 1), freqs, 'Hz')))), 'k--', ...
'DisplayName', 'Perfect Joint');
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'lin');
ylabel('Phase [deg]'); xlabel('Frequency [Hz]');
ylim([-270, 90]);
yticks([-360:90:360]);
Continue flexible joint study
2020-05-05 10:34:45 +02:00
legend('location', 'southwest');
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
linkaxes([ax1,ax2],'x');
#+end_src
Continue flexible joint study
2020-05-05 10:34:45 +02:00
#+begin_src matlab :tangle no :exports results :results file replace
exportFig('figs/flex_joints_trans_study_dvf.pdf', 'width', 'full', 'height', 'full');
#+end_src
#+name: fig:flex_joints_trans_study_dvf
#+caption: Dynamics from $\tau_i$ to $d\mathcal{L}_i$ for all the considered axis Stiffnesses
#+RESULTS:
[[file:figs/flex_joints_trans_study_dvf.png]]
#+begin_src matlab :exports none
figure;
gains = logspace(2, 5, 300);
hold on;
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
for i = 1:length(Kas)
Continue flexible joint study
2020-05-05 10:34:45 +02:00
set(gca,'ColorOrderIndex',i);
plot(real(pole(G_dvf_3dof_s{i})), imag(pole(G_dvf_3dof_s{i})), 'x', ...
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
'DisplayName', sprintf('$k = %.0g$ [N/m]', Kas(i)));
Continue flexible joint study
2020-05-05 10:34:45 +02:00
set(gca,'ColorOrderIndex',i);
plot(real(tzero(G_dvf_3dof_s{i})), imag(tzero(G_dvf_3dof_s{i})), 'o', ...
'HandleVisibility', 'off');
for k = 1:length(gains)
set(gca,'ColorOrderIndex',i);
cl_poles = pole(feedback(G_dvf_3dof_s{i}, (gains(k)*s)*eye(6)));
plot(real(cl_poles), imag(cl_poles), '.', ...
'HandleVisibility', 'off');
end
end
hold off;
axis square;
xlim([-140, 10]); ylim([0, 150]);
xlabel('Real Part'); ylabel('Imaginary Part');
legend('location', 'northwest');
#+end_src
#+begin_src matlab :tangle no :exports results :results file replace
exportFig('figs/flex_joints_trans_study_dvf_root_locus.pdf', 'width', 'wide', 'height', 'tall');
#+end_src
#+name: fig:flex_joints_trans_study_dvf_root_locus
#+caption: Root Locus for all the considered axial Stiffnesses
#+RESULTS:
[[file:figs/flex_joints_trans_study_dvf_root_locus.png]]
Update few figures
2020-05-05 11:27:37 +02:00
#+begin_src matlab :exports none
Continue flexible joint study
2020-05-05 10:34:45 +02:00
xlim([-1e3, 0]);
ylim([0, 1e3]);
#+end_src
#+begin_src matlab :tangle no :exports results :results file replace
exportFig('figs/flex_joints_trans_study_root_locus_unzoom.pdf', 'width', 'wide', 'height', 'tall');
#+end_src
#+name: fig:flex_joints_trans_study_root_locus_unzoom
#+caption: Root Locus (unzoom) for all the considered axial Stiffnesses
#+RESULTS:
[[file:figs/flex_joints_trans_study_root_locus_unzoom.png]]
*** Primary Control
The dynamics from $\bm{\tau}^\prime$ to $\bm{\epsilon}_{\mathcal{X}_n}$ (for the primary controller designed in the frame of the legs) is shown in Figure [[fig:flex_joints_trans_study_primary_plant]].
#+begin_src matlab :exports none
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
Kdvf = 5e3*s/(1+s/2/pi/1e3)*eye(6);
#+end_src
#+begin_src matlab :exports none
%% Name of the Simulink File
mdl = 'nass_model';
%% Input/Output definition
clear io; io_i = 1;
io(io_i) = linio([mdl, '/Controller'], 1, 'input'); io_i = io_i + 1; % Actuator Inputs
io(io_i) = linio([mdl, '/Tracking Error'], 1, 'output', [], 'En'); io_i = io_i + 1; % Position Errror
load('mat/stages.mat', 'nano_hexapod');
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
Gl_3dof_s = {zeros(length(Kas), 1)};
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
for i = 1:length(Kas)
Continue flexible joint study
2020-05-05 10:34:45 +02:00
initializeNanoHexapod('k', k_opt, 'c', c_opt, ...
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
'type_F', 'universal_3dof', ...
'type_M', 'spherical_3dof', ...
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
'Ka_F', Kas(i), ...
'Ka_M', Kas(i), ...
'Ca_F', 0.05*sqrt(Kas(i)*10), ...
'Ca_M', 0.05*sqrt(Kas(i)*10));
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
G = linearize(mdl, io);
G.InputName = {'Fnl1', 'Fnl2', 'Fnl3', 'Fnl4', 'Fnl5', 'Fnl6'};
G.OutputName = {'Ex', 'Ey', 'Ez', 'Erx', 'Ery', 'Erz'};
Gl_3dof = -nano_hexapod.kinematics.J*G;
Gl_3dof.OutputName = {'E1', 'E2', 'E3', 'E4', 'E5', 'E6'};
Gl_3dof_s(i) = {Gl_3dof};
end
#+end_src
#+begin_src matlab :exports none
freqs = logspace(-1, 3, 1000);
figure;
ax1 = subplot(2, 1, 1);
hold on;
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
for i = 1:length(Kas)
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
plot(freqs, abs(squeeze(freqresp(Gl_3dof_s{i}(1, 1), freqs, 'Hz'))));
end
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'log');
ylabel('Amplitude [m/N]'); set(gca, 'XTickLabel',[]);
ax2 = subplot(2, 1, 2);
hold on;
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
for i = 1:length(Kas)
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(Gl_3dof_s{i}(1, 1), freqs, 'Hz')))), ...
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
'DisplayName', sprintf('$k = %.0g$ [N/m]', Kas(i)));
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
end
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'lin');
ylabel('Phase [deg]'); xlabel('Frequency [Hz]');
ylim([-270, 90]);
yticks([-360:90:360]);
legend('location', 'northeast');
linkaxes([ax1,ax2],'x');
#+end_src
Continue flexible joint study
2020-05-05 10:34:45 +02:00
#+begin_src matlab :tangle no :exports results :results file replace
exportFig('figs/flex_joints_trans_study_primary_plant.pdf', 'width', 'full', 'height', 'full');
#+end_src
#+name: fig:flex_joints_trans_study_primary_plant
#+caption: Diagonal elements of the transfer function matrix from $\bm{\tau}^\prime$ to $\bm{\epsilon}_{\mathcal{X}_n}$ for the considered axial stiffnesses
#+RESULTS:
[[file:figs/flex_joints_trans_study_primary_plant.png]]
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
** Conclusion
#+begin_important
Continue flexible joint study
2020-05-05 10:34:45 +02:00
The axial stiffness of the flexible joints should be maximized.
Update few figures
2020-05-05 11:27:37 +02:00
For the considered actuator stiffness $k = 10^5\,[N/m]$, the axial stiffness of the flexible joints should ideally be above $10^7\,[N/m]$.
Continue flexible joint study
2020-05-05 10:34:45 +02:00
This is a reasonable stiffness value for such joints.
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
Continue flexible joint study
2020-05-05 10:34:45 +02:00
We may interpolate the results and say that the axial joint stiffness should be 100 times higher than the actuator stiffness, but this should be confirmed with further analysis.
Start the study about flexible joints
2020-05-04 22:11:36 +02:00
#+end_important
Update few figures
2020-05-05 11:27:37 +02:00
* Conclusion
<<sec:conclusion>>
#+begin_important
Update conclusion about flexible joints
2020-05-05 11:50:07 +02:00
In this study we considered the bending, torsional and axial stiffnesses of the flexible joints used for the nano-hexapod.
The bending and torsional stiffnesses somehow adds a parasitic stiffness in parallel with the legs.
It is not found to be much problematic for the considered control architecture (it is however, if Integral Force Feedback is to be used).
As a consequence of the added stiffness, it could increase a little bit the required actuator force.
The axial stiffness of the flexible joints can be very problematic for control.
Small values of the axial stiffness are shown to limit the achievable damping with Direct Velocity Feedback.
The axial stiffness should therefore be maximized and taken into account in the model of the nano-hexapod.
For the identified optimal actuator stiffness $k = 10^5\,[N/m]$, the flexible joint should have the following stiffness properties:
- Axial Stiffness: $K_a > 10^7\,[N/m]$
- Bending Stiffness: $K_b < 50\,[Nm/rad]$
- Torsion Stiffness: $K_t < 50\,[Nm/rad]$
As there is generally a trade-off between bending stiffness and axial stiffness, it should be highlighted that the *axial* stiffness is the most important property of the flexible joints.
Update few figures
2020-05-05 11:27:37 +02:00
#+end_important
Model flexible nano-hexapod elements
2020-11-03 09:45:50 +01:00
* Designed Flexible Joints
** Matlab Init :noexport:ignore:
#+begin_src matlab :tangle no :exports none :results silent :noweb yes :var current_dir=(file-name-directory buffer-file-name)
<<matlab-dir>>
#+end_src
#+begin_src matlab :exports none :results silent :noweb yes
<<matlab-init>>
#+end_src
#+begin_src matlab :tangle no
simulinkproject('../');
#+end_src
#+begin_src matlab
load('mat/conf_simulink.mat');
open('nass_model.slx')
#+end_src
** Initialization
Let's initialize all the stages with default parameters.
#+begin_src matlab
initializeGround();
initializeGranite();
initializeTy();
initializeRy();
initializeRz();
initializeMicroHexapod();
initializeAxisc('type', 'none');
initializeMirror('type', 'none');
initializeMirror();
#+end_src
#+begin_src matlab :exports none
initializeSimscapeConfiguration();
initializeDisturbances('enable', false);
initializeLoggingConfiguration('log', 'none');
initializeController('type', 'hac-dvf');
#+end_src
Let's consider the heaviest mass which should we the most problematic with it comes to the flexible joints.
#+begin_src matlab
initializeSample('mass', 50, 'freq', 200*ones(6,1));
initializeReferences('Rz_type', 'rotating-not-filtered', 'Rz_period', 60);
#+end_src
#+begin_src matlab :exports none
K = tf(zeros(6));
Kdvf = tf(zeros(6));
#+end_src
#+begin_src matlab
flex_joint = load('./mat/flexor_025.mat', 'int_xyz', 'int_i', 'n_xyz', 'n_i', 'nodes', 'M', 'K');
apa = load('./mat/APA300ML_simplified_model.mat');
#+end_src
#+begin_src matlab
initializeNanoHexapod('actuator', 'amplified', ...
'ke', apa.ke, 'ka', apa.ka, 'k1', apa.k1, 'c1', apa.c1, 'F_gain', apa.F_gain, ...
'type_M', 'spherical_3dof', ...
'Kr_M', flex_joint.K(1,1)*ones(6,1), ...
'Ka_M', flex_joint.K(3,3)*ones(6,1), ...
'Kf_M', flex_joint.K(4,4)*ones(6,1), ...
'Kt_M', flex_joint.K(6,6)*ones(6,1), ...
'type_F', 'spherical_3dof', ...
'Kr_F', flex_joint.K(1,1)*ones(6,1), ...
'Ka_F', flex_joint.K(3,3)*ones(6,1), ...
'Kf_F', flex_joint.K(4,4)*ones(6,1), ...
'Kt_F', flex_joint.K(6,6)*ones(6,1));
#+end_src
#+begin_src matlab
initializeNanoHexapod();
#+end_src
** Direct Velocity Feedback
#+begin_src matlab :exports none
%% Name of the Simulink File
mdl = 'nass_model';
%% Input/Output definition
clear io; io_i = 1;
io(io_i) = linio([mdl, '/Controller'], 1, 'openinput'); io_i = io_i + 1; % Actuator Inputs
io(io_i) = linio([mdl, '/Micro-Station'], 3, 'openoutput', [], 'Dnlm'); io_i = io_i + 1; % Force Sensors
#+end_src
#+begin_src matlab :exports none
G_dvf = linearize(mdl, io);
G_dvf.InputName = {'Fnl1', 'Fnl2', 'Fnl3', 'Fnl4', 'Fnl5', 'Fnl6'};
G_dvf.OutputName = {'Dnlm1', 'Dnlm2', 'Dnlm3', 'Dnlm4', 'Dnlm5', 'Dnlm6'};
#+end_src
#+begin_src matlab :exports none
freqs = logspace(0, 4, 1000);
figure;
ax1 = subplot(2, 1, 1);
hold on;
plot(freqs, abs(squeeze(freqresp(G_dvf(1, 1), freqs, 'Hz'))));
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'log');
ylabel('Amplitude [m/N]'); set(gca, 'XTickLabel',[]);
ax2 = subplot(2, 1, 2);
hold on;
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(G_dvf(1, 1), freqs, 'Hz')))), ...
'DisplayName', 'Designed Joints');
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'lin');
ylabel('Phase [deg]'); xlabel('Frequency [Hz]');
ylim([-270, 90]);
yticks([-360:90:360]);
legend('location', 'northeast');
linkaxes([ax1,ax2],'x');
#+end_src
#+begin_src matlab :exports none
K_iff = 1e6*s/(1 + s/2/pi/100)/(1 + s/2/pi/100);
freqs = logspace(0, 4, 1000);
figure;
ax1 = subplot(2, 1, 1);
hold on;
plot(freqs, abs(squeeze(freqresp(K_iff*G_dvf(1, 1), freqs, 'Hz'))));
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'log');
ylabel('Amplitude [m/N]'); set(gca, 'XTickLabel',[]);
ax2 = subplot(2, 1, 2);
hold on;
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(K_iff*G_dvf(1, 1), freqs, 'Hz')))), ...
'DisplayName', 'Designed Joints');
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'lin');
ylabel('Phase [deg]'); xlabel('Frequency [Hz]');
ylim([-270, 90]);
yticks([-360:90:360]);
legend('location', 'northeast');
linkaxes([ax1,ax2],'x');
#+end_src
#+begin_src matlab :exports none
gains = logspace(0, 5, 100);
figure;
hold on;
plot(real(pole(G_dvf)), imag(pole(G_dvf)), 'x');
set(gca,'ColorOrderIndex',1);
plot(real(tzero(G_dvf)), imag(tzero(G_dvf)), 'o');
for i = 1:length(gains)
set(gca,'ColorOrderIndex',1);
cl_poles = pole(feedback(G_dvf, (gains(i)*s/(1+s/2/pi/100)^2)*eye(6)));
plot(real(cl_poles), imag(cl_poles), '.');
end
% ylim([0, 2*pi*500]);
% xlim([-2*pi*500,0]);
xlabel('Real Part')
ylabel('Imaginary Part')
axis square
#+end_src
** Integral Force Feedback
#+begin_src matlab :exports none
%% Name of the Simulink File
mdl = 'nass_model';
%% Input/Output definition
clear io; io_i = 1;
io(io_i) = linio([mdl, '/Controller'], 1, 'openinput'); io_i = io_i + 1; % Actuator Inputs
io(io_i) = linio([mdl, '/Micro-Station'], 3, 'openoutput', [], 'Fnlm'); io_i = io_i + 1; % Force Sensors
#+end_src
#+begin_src matlab :exports none
G_iff = linearize(mdl, io);
G_iff.InputName = {'Fnl1', 'Fnl2', 'Fnl3', 'Fnl4', 'Fnl5', 'Fnl6'};
G_iff.OutputName = {'Fnlm1', 'Fnlm2', 'Fnlm3', 'Fnlm4', 'Fnlm5', 'Fnlm6'};
#+end_src
#+begin_src matlab :exports none
freqs = logspace(0, 4, 1000);
figure;
ax1 = subplot(2, 1, 1);
hold on;
plot(freqs, abs(squeeze(freqresp(G_iff(1, 1), freqs, 'Hz'))));
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'log');
ylabel('Amplitude [N/N]'); set(gca, 'XTickLabel',[]);
ax2 = subplot(2, 1, 2);
hold on;
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(G_iff(1, 1), freqs, 'Hz')))), ...
'DisplayName', 'Designed Joints');
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'lin');
ylabel('Phase [deg]'); xlabel('Frequency [Hz]');
ylim([-270, 90]);
yticks([-360:90:360]);
legend('location', 'northeast');
linkaxes([ax1,ax2],'x');
#+end_src
#+begin_src matlab :exports none
K_iff = -1e4/(s + 2*pi*5)*s/(s + 2*pi*5);
freqs = logspace(-1, 4, 1000);
figure;
ax1 = subplot(2, 1, 1);
hold on;
plot(freqs, abs(squeeze(freqresp(K_iff*G_iff(1, 1), freqs, 'Hz'))));
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'log');
ylabel('Loop Gain'); set(gca, 'XTickLabel',[]);
ax2 = subplot(2, 1, 2);
hold on;
plot(freqs, 180/pi*unwrap(angle(squeeze(freqresp(K_iff*G_iff(1, 1), freqs, 'Hz')))), ...
'DisplayName', 'Designed Joints');
hold off;
set(gca, 'XScale', 'log'); set(gca, 'YScale', 'lin');
ylabel('Phase [deg]'); xlabel('Frequency [Hz]');
ylim([-180, 180]);
yticks([-360:90:360]);
legend('location', 'northeast');
linkaxes([ax1,ax2],'x');
#+end_src
#+begin_src matlab :exports none
gains = logspace(0, 5, 100);
figure;
hold on;
plot(real(pole(G_iff)), imag(pole(G_iff)), 'x');
set(gca,'ColorOrderIndex',1);
plot(real(tzero(G_iff)), imag(tzero(G_iff)), 'o');
for i = 1:length(gains)
set(gca,'ColorOrderIndex',1);
cl_poles = pole(feedback(G_iff, -(gains(i)/(s + 2*pi*5)*s/(s + 2*pi*5))*eye(6)));
plot(real(cl_poles), imag(cl_poles), '.');
end
ylim([0, 2*pi*500]);
xlim([-2*pi*500,0]);
xlabel('Real Part')
ylabel('Imaginary Part')
axis square
#+end_src
Reference in New Issue Copy Permalink