2020-02-25 18:10:20 +01:00
<?xml version="1.0" encoding="utf-8"?>
< !DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Strict//EN"
"http://www.w3.org/TR/xhtml1/DTD/xhtml1-strict.dtd">
< html xmlns = "http://www.w3.org/1999/xhtml" lang = "en" xml:lang = "en" >
< head >
2021-02-20 23:09:27 +01:00
<!-- 2021 - 02 - 20 sam. 23:08 -->
2020-02-25 18:10:20 +01:00
< meta http-equiv = "Content-Type" content = "text/html;charset=utf-8" / >
< title > Active Damping with an uni-axial model< / title >
< meta name = "generator" content = "Org mode" / >
< meta name = "author" content = "Dehaeze Thomas" / >
2021-02-20 23:09:27 +01:00
< link rel = "stylesheet" type = "text/css" href = "https://research.tdehaeze.xyz/css/style.css" / >
< script type = "text/javascript" src = "https://research.tdehaeze.xyz/js/script.js" > < / script >
< script >
MathJax = {
svg: {
scale: 1,
fontCache: "global"
},
tex: {
tags: "ams",
multlineWidth: "%MULTLINEWIDTH",
tagSide: "right",
macros: {bm: ["\\boldsymbol{#1}",1],},
tagIndent: ".8em"
}
};
< / script >
< script id = "MathJax-script" async
src="https://cdn.jsdelivr.net/npm/mathjax@3/es5/tex-svg.js">< / script >
2020-02-25 18:10:20 +01:00
< / head >
< body >
< div id = "org-div-home-and-up" >
2020-02-25 18:21:17 +01:00
< a accesskey = "h" href = "./index.html" > UP < / a >
2020-02-25 18:10:20 +01:00
|
2021-02-20 23:09:27 +01:00
< a accesskey = "H" href = "../../index.html" > HOME < / a >
2020-02-25 18:10:20 +01:00
< / div > < div id = "content" >
< h1 class = "title" > Active Damping with an uni-axial model< / h1 >
< div id = "table-of-contents" >
< h2 > Table of Contents< / h2 >
< div id = "text-table-of-contents" >
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#orgc948d34" > 1. Undamped System< / a >
2020-02-25 18:10:20 +01:00
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#orga36cd06" > 1.1. Init< / a > < / li >
< li > < a href = "#org06ab145" > 1.2. Identification< / a > < / li >
< li > < a href = "#org78add04" > 1.3. Sensitivity to disturbances< / a > < / li >
< li > < a href = "#orga39f4df" > 1.4. Undamped Plant< / a > < / li >
2020-02-25 18:10:20 +01:00
< / ul >
< / li >
2021-02-20 23:09:27 +01:00
< li > < a href = "#orgf08b3bb" > 2. Integral Force Feedback< / a >
2020-02-25 18:10:20 +01:00
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org8b68cc9" > 2.1. One degree-of-freedom example< / a >
2020-02-25 18:10:20 +01:00
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org2b43f3d" > 2.1.1. Equations< / a > < / li >
< li > < a href = "#org4e59f2f" > 2.1.2. Matlab Example< / a > < / li >
2020-02-25 18:10:20 +01:00
< / ul >
< / li >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org4766475" > 2.2. Control Design< / a > < / li >
< li > < a href = "#org14a2b60" > 2.3. Identification of the damped plant< / a > < / li >
< li > < a href = "#orge18a1e0" > 2.4. Sensitivity to disturbances< / a > < / li >
< li > < a href = "#org740fdc1" > 2.5. Damped Plant< / a > < / li >
< li > < a href = "#org1a1d3de" > 2.6. Conclusion< / a > < / li >
2020-02-25 18:10:20 +01:00
< / ul >
< / li >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org9e1866b" > 3. Relative Motion Control< / a >
2020-02-25 18:10:20 +01:00
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org27412f8" > 3.1. One degree-of-freedom example< / a >
2020-02-25 18:10:20 +01:00
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org7d60775" > 3.1.1. Equations< / a > < / li >
< li > < a href = "#org0555f28" > 3.1.2. Matlab Example< / a > < / li >
2020-02-25 18:10:20 +01:00
< / ul >
< / li >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org2512bc1" > 3.2. Control Design< / a > < / li >
< li > < a href = "#org43ecec3" > 3.3. Identification of the damped plant< / a > < / li >
< li > < a href = "#org5752cc8" > 3.4. Sensitivity to disturbances< / a > < / li >
< li > < a href = "#org6edbe38" > 3.5. Damped Plant< / a > < / li >
< li > < a href = "#org0077c6d" > 3.6. Conclusion< / a > < / li >
2020-02-25 18:10:20 +01:00
< / ul >
< / li >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org012ccf7" > 4. Direct Velocity Feedback< / a >
2020-02-25 18:10:20 +01:00
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#orgca0282d" > 4.1. One degree-of-freedom example< / a >
2020-02-25 18:10:20 +01:00
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org827690f" > 4.1.1. Equations< / a > < / li >
< li > < a href = "#org4dbb739" > 4.1.2. Matlab Example< / a > < / li >
2020-02-25 18:10:20 +01:00
< / ul >
< / li >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org31bc936" > 4.2. Control Design< / a > < / li >
< li > < a href = "#org040cbd4" > 4.3. Identification of the damped plant< / a > < / li >
< li > < a href = "#orgcddca6d" > 4.4. Sensitivity to disturbances< / a > < / li >
< li > < a href = "#orga50ffdb" > 4.5. Damped Plant< / a > < / li >
< li > < a href = "#orgfebd36e" > 4.6. Conclusion< / a > < / li >
2020-02-25 18:10:20 +01:00
< / ul >
< / li >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org9eee619" > 5. Comparison< / a >
2020-02-25 18:10:20 +01:00
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#orgbf02110" > 5.1. Load the plants< / a > < / li >
< li > < a href = "#org78f3ac5" > 5.2. Sensitivity to Disturbance< / a > < / li >
< li > < a href = "#org5c6929b" > 5.3. Damped Plant< / a > < / li >
2020-02-25 18:10:20 +01:00
< / ul >
< / li >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org33904c4" > 6. Conclusion< / a > < / li >
2020-02-25 18:10:20 +01:00
< / ul >
< / div >
< / div >
< p >
2021-02-20 23:09:27 +01:00
First, in section < a href = "#org8bb62c3" > 1< / a > , we will looked at the undamped system.
2020-02-25 18:10:20 +01:00
< / p >
< p >
Then, we will compare three active damping techniques:
< / p >
< ul class = "org-ul" >
2021-02-20 23:09:27 +01:00
< li > In section < a href = "#org0f510d3" > 2< / a > : the integral force feedback is used< / li >
< li > In section < a href = "#org360305e" > 3< / a > : the relative motion control is used< / li >
< li > In section < a href = "#orgcbdfd90" > 4< / a > : the direct velocity feedback is used< / li >
2020-02-25 18:10:20 +01:00
< / ul >
< p >
For each of the active damping technique, we will:
< / p >
< ul class = "org-ul" >
< li > Compare the sensitivity from disturbances< / li >
< li > Look at the damped plant< / li >
< / ul >
< p >
The disturbances are:
< / p >
< ul class = "org-ul" >
< li > Ground motion< / li >
< li > Direct forces< / li >
< li > Motion errors of all the stages< / li >
< / ul >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orgc948d34" class = "outline-2" >
< h2 id = "orgc948d34" > < span class = "section-number-2" > 1< / span > Undamped System< / h2 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-2" id = "text-1" >
< p >
2021-02-20 23:09:27 +01:00
< a id = "org8bb62c3" > < / a >
2020-02-25 18:10:20 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div class = "note" id = "org9fea735" >
2020-02-25 18:10:20 +01:00
< p >
All the files (data and Matlab scripts) are accessible < a href = "data/undamped_system.zip" > here< / a > .
< / p >
< / div >
< p >
We first look at the undamped system.
The performance of this undamped system will be compared with the damped system using various techniques.
< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orga36cd06" class = "outline-3" >
< h3 id = "orga36cd06" > < span class = "section-number-3" > 1.1< / span > Init< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-1-1" >
< p >
We initialize all the stages with the default parameters.
The nano-hexapod is a piezoelectric hexapod and the sample has a mass of 50kg.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > initializeReferences();
initializeGround();
initializeGranite();
initializeTy();
initializeRy();
initializeRz();
initializeMicroHexapod();
initializeAxisc();
initializeMirror();
initializeNanoHexapod(< span class = "org-string" > 'actuator'< / span > , < span class = "org-string" > 'piezo'< / span > );
initializeSample(< span class = "org-string" > 'mass'< / span > , 50);
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
All the controllers are set to 0.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > K = tf(zeros(6));
save(< span class = "org-string" > './mat/controllers_uniaxial.mat'< / span > , < span class = "org-string" > 'K'< / span > , < span class = "org-string" > '-append'< / span > );
K_iff = tf(zeros(6));
save(< span class = "org-string" > './mat/controllers_uniaxial.mat'< / span > , < span class = "org-string" > 'K_iff'< / span > , < span class = "org-string" > '-append'< / span > );
K_rmc = tf(zeros(6));
save(< span class = "org-string" > './mat/controllers_uniaxial.mat'< / span > , < span class = "org-string" > 'K_rmc'< / span > , < span class = "org-string" > '-append'< / span > );
K_dvf = tf(zeros(6));
save(< span class = "org-string" > './mat/controllers_uniaxial.mat'< / span > , < span class = "org-string" > 'K_dvf'< / span > , < span class = "org-string" > '-append'< / span > );
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org06ab145" class = "outline-3" >
< h3 id = "org06ab145" > < span class = "section-number-3" > 1.2< / span > Identification< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-1-2" >
< p >
We identify the various transfer functions of the system
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > G = identifyPlant();
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
And we save it for further analysis.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > save(< span class = "org-string" > './mat/active_damping_uniaxial_plants.mat'< / span > , < span class = "org-string" > 'G'< / span > , < span class = "org-string" > '-append'< / span > );
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org78add04" class = "outline-3" >
< h3 id = "org78add04" > < span class = "section-number-3" > 1.3< / span > Sensitivity to disturbances< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-1-3" >
< p >
2021-02-20 23:09:27 +01:00
The sensitivity to disturbances are shown on figure < a href = "#org4118b1b" > 1< / a > .
2020-02-25 18:10:20 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "org4118b1b" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/sensitivity_dist_undamped.png" alt = "sensitivity_dist_undamped.png" / >
< / p >
< p > < span class = "figure-number" > Figure 1: < / span > Undamped sensitivity to disturbances (< a href = "./figs/sensitivity_dist_undamped.png" > png< / a > , < a href = "./figs/sensitivity_dist_undamped.pdf" > pdf< / a > )< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "org9972b34" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/sensitivity_dist_stages.png" alt = "sensitivity_dist_stages.png" / >
< / p >
< p > < span class = "figure-number" > Figure 2: < / span > Sensitivity to force disturbances in various stages (< a href = "./figs/sensitivity_dist_stages.png" > png< / a > , < a href = "./figs/sensitivity_dist_stages.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orga39f4df" class = "outline-3" >
< h3 id = "orga39f4df" > < span class = "section-number-3" > 1.4< / span > Undamped Plant< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-1-4" >
< p >
2021-02-20 23:09:27 +01:00
The “ plant” (transfer function from forces applied by the nano-hexapod to the measured displacement of the sample with respect to the granite) bode plot is shown on figure < a href = "#org4118b1b" > 1< / a > .
2020-02-25 18:10:20 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "orgd465cde" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/plant_undamped.png" alt = "plant_undamped.png" / >
< / p >
< p > < span class = "figure-number" > Figure 3: < / span > Transfer Function from cartesian forces to displacement for the undamped plant (< a href = "./figs/plant_undamped.png" > png< / a > , < a href = "./figs/plant_undamped.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orgf08b3bb" class = "outline-2" >
< h2 id = "orgf08b3bb" > < span class = "section-number-2" > 2< / span > Integral Force Feedback< / h2 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-2" id = "text-2" >
< p >
2021-02-20 23:09:27 +01:00
< a id = "org0f510d3" > < / a >
2020-02-25 18:10:20 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div class = "note" id = "org14e1a23" >
2020-02-25 18:10:20 +01:00
< p >
All the files (data and Matlab scripts) are accessible < a href = "data/iff.zip" > here< / a > .
< / p >
< / div >
< p >
Integral Force Feedback is applied.
2021-02-20 23:09:27 +01:00
In section < a href = "#org7d7b199" > 2.1< / a > , IFF is applied on a uni-axial system to understand its behavior.
2020-02-25 18:10:20 +01:00
Then, it is applied on the simscape model.
< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org8b68cc9" class = "outline-3" >
< h3 id = "org8b68cc9" > < span class = "section-number-3" > 2.1< / span > One degree-of-freedom example< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-2-1" >
< p >
2021-02-20 23:09:27 +01:00
< a id = "org7d7b199" > < / a >
2020-02-25 18:10:20 +01:00
< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org2b43f3d" class = "outline-4" >
< h4 id = "org2b43f3d" > < span class = "section-number-4" > 2.1.1< / span > Equations< / h4 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-4" id = "text-2-1-1" >
2021-02-20 23:09:27 +01:00
< div id = "orgf34321e" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/iff_1dof.png" alt = "iff_1dof.png" / >
< / p >
< p > < span class = "figure-number" > Figure 4: < / span > Integral Force Feedback applied to a 1dof system< / p >
< / div >
< p >
The dynamic of the system is described by the following equation:
< / p >
\begin{equation}
ms^2x = F_d - kx - csx + kw + csw + F
\end{equation}
< p >
The measured force \(F_m\) is:
< / p >
\begin{align}
F_m & = F - kx - csx + kw + csw \\
& = ms^2 x - F_d
\end{align}
< p >
The Integral Force Feedback controller is \(K = -\frac{g}{s}\), and thus the applied force by this controller is:
< / p >
\begin{equation}
F_{\text{IFF}} = -\frac{g}{s} F_m = -\frac{g}{s} (ms^2 x - F_d)
\end{equation}
< p >
Once the IFF is applied, the new dynamics of the system is:
< / p >
\begin{equation}
ms^2x = F_d + F - kx - csx + kw + csw - \frac{g}{s} (ms^2x - F_d)
\end{equation}
< p >
And finally:
< / p >
\begin{equation}
x = F_d \frac{1 + \frac{g}{s}}{ms^2 + (mg + c)s + k} + F \frac{1}{ms^2 + (mg + c)s + k} + w \frac{k + cs}{ms^2 + (mg + c)s + k}
\end{equation}
< p >
We can see that this:
< / p >
< ul class = "org-ul" >
< li > adds damping to the system by a value \(mg\)< / li >
< li > lower the compliance as low frequency by a factor: \(1 + g/s\)< / li >
< / ul >
< p >
If we want critical damping:
< / p >
\begin{equation}
\xi = \frac{1}{2} \frac{c + gm}{\sqrt{km}} = \frac{1}{2}
\end{equation}
< p >
This is attainable if we have:
< / p >
\begin{equation}
g = \frac{\sqrt{km} - c}{m}
\end{equation}
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org4e59f2f" class = "outline-4" >
< h4 id = "org4e59f2f" > < span class = "section-number-4" > 2.1.2< / span > Matlab Example< / h4 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-4" id = "text-2-1-2" >
< p >
Let define the system parameters.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > m = 50; < span class = "org-comment" > % [kg]< / span >
k = 1e6; < span class = "org-comment" > % [N/m]< / span >
c = 1e3; < span class = "org-comment" > % [N/(m/s)]< / span >
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
The state space model of the system is defined below.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > A = [< span class = "org-type" > -< / span > c< span class = "org-type" > /< / span > m < span class = "org-type" > -< / span > k< span class = "org-type" > /< / span > m;
1 0];
2020-02-25 18:10:20 +01:00
2021-02-20 23:09:27 +01:00
B = [1< span class = "org-type" > /< / span > m 1< span class = "org-type" > /< / span > m < span class = "org-type" > -< / span > 1;
0 0 0];
2020-02-25 18:10:20 +01:00
2021-02-20 23:09:27 +01:00
C = [ 0 1;
< span class = "org-type" > -< / span > c < span class = "org-type" > -< / span > k];
2020-02-25 18:10:20 +01:00
2021-02-20 23:09:27 +01:00
D = [0 0 0;
1 0 0];
2020-02-25 18:10:20 +01:00
2021-02-20 23:09:27 +01:00
sys = ss(A, B, C, D);
sys.InputName = {< span class = "org-string" > 'F'< / span > , < span class = "org-string" > 'Fd'< / span > , < span class = "org-string" > 'wddot'< / span > };
sys.OutputName = {< span class = "org-string" > 'd'< / span > , < span class = "org-string" > 'Fm'< / span > };
sys.StateName = {< span class = "org-string" > 'ddot'< / span > , < span class = "org-string" > 'd'< / span > };
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
The controller \(K_\text{IFF}\) is:
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > Kiff = < span class = "org-type" > -< / span > ((sqrt(k< span class = "org-type" > *< / span > m)< span class = "org-type" > -< / span > c)< span class = "org-type" > /< / span > m)< span class = "org-type" > /< / span > s;
Kiff.InputName = {< span class = "org-string" > 'Fm'< / span > };
Kiff.OutputName = {< span class = "org-string" > 'F'< / span > };
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
And the closed loop system is computed below.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > sys_iff = feedback(sys, Kiff, < span class = "org-string" > 'name'< / span > , < span class = "org-type" > +< / span > 1);
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "orgd828d95" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/iff_1dof_sensitivitiy.png" alt = "iff_1dof_sensitivitiy.png" / >
< / p >
< p > < span class = "figure-number" > Figure 5: < / span > Sensitivity to disturbance when IFF is applied on the 1dof system (< a href = "./figs/iff_1dof_sensitivitiy.png" > png< / a > , < a href = "./figs/iff_1dof_sensitivitiy.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org4766475" class = "outline-3" >
< h3 id = "org4766475" > < span class = "section-number-3" > 2.2< / span > Control Design< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-2-2" >
< p >
Let’ s load the undamped plant:
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > load(< span class = "org-string" > './mat/active_damping_uniaxial_plants.mat'< / span > , < span class = "org-string" > 'G'< / span > );
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
2021-02-20 23:09:27 +01:00
Let’ s look at the transfer function from actuator forces in the nano-hexapod to the force sensor in the nano-hexapod legs for all 6 pairs of actuator/sensor (figure < a href = "#orge272523" > 6< / a > ).
2020-02-25 18:10:20 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "orge272523" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/iff_plant.png" alt = "iff_plant.png" / >
< / p >
< p > < span class = "figure-number" > Figure 6: < / span > Transfer function from forces applied in the legs to force sensor (< a href = "./figs/iff_plant.png" > png< / a > , < a href = "./figs/iff_plant.pdf" > pdf< / a > )< / p >
< / div >
< p >
The controller for each pair of actuator/sensor is:
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > K_iff = < span class = "org-type" > -< / span > 1000< span class = "org-type" > /< / span > s;
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
2021-02-20 23:09:27 +01:00
The corresponding loop gains are shown in figure < a href = "#orgffae1f0" > 7< / a > .
2020-02-25 18:10:20 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "orgffae1f0" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/iff_open_loop.png" alt = "iff_open_loop.png" / >
< / p >
< p > < span class = "figure-number" > Figure 7: < / span > Loop Gain for the Integral Force Feedback (< a href = "./figs/iff_open_loop.png" > png< / a > , < a href = "./figs/iff_open_loop.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org14a2b60" class = "outline-3" >
< h3 id = "org14a2b60" > < span class = "section-number-3" > 2.3< / span > Identification of the damped plant< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-2-3" >
< p >
Let’ s initialize the system prior to identification.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > initializeReferences();
initializeGround();
initializeGranite();
initializeTy();
initializeRy();
initializeRz();
initializeMicroHexapod();
initializeAxisc();
initializeMirror();
initializeNanoHexapod(< span class = "org-string" > 'actuator'< / span > , < span class = "org-string" > 'piezo'< / span > );
initializeSample(< span class = "org-string" > 'mass'< / span > , 50);
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
All the controllers are set to 0.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > K = tf(zeros(6));
save(< span class = "org-string" > './mat/controllers_uniaxial.mat'< / span > , < span class = "org-string" > 'K'< / span > , < span class = "org-string" > '-append'< / span > );
K_iff = < span class = "org-type" > -< / span > K_iff< span class = "org-type" > *< / span > eye(6);
save(< span class = "org-string" > './mat/controllers_uniaxial.mat'< / span > , < span class = "org-string" > 'K_iff'< / span > , < span class = "org-string" > '-append'< / span > );
K_rmc = tf(zeros(6));
save(< span class = "org-string" > './mat/controllers_uniaxial.mat'< / span > , < span class = "org-string" > 'K_rmc'< / span > , < span class = "org-string" > '-append'< / span > );
K_dvf = tf(zeros(6));
save(< span class = "org-string" > './mat/controllers_uniaxial.mat'< / span > , < span class = "org-string" > 'K_dvf'< / span > , < span class = "org-string" > '-append'< / span > );
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
We identify the system dynamics now that the IFF controller is ON.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > G_iff = identifyPlant();
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
And we save the damped plant for further analysis
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > save(< span class = "org-string" > './mat/active_damping_uniaxial_plants.mat'< / span > , < span class = "org-string" > 'G_iff'< / span > , < span class = "org-string" > '-append'< / span > );
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orge18a1e0" class = "outline-3" >
< h3 id = "orge18a1e0" > < span class = "section-number-3" > 2.4< / span > Sensitivity to disturbances< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-2-4" >
< p >
2021-02-20 23:09:27 +01:00
As shown on figure < a href = "#orgdfaeb87" > 8< / a > :
2020-02-25 18:10:20 +01:00
< / p >
< ul class = "org-ul" >
< li > The top platform of the nano-hexapod how behaves as a “ free-mass” .< / li >
< li > The transfer function from direct forces \(F_s\) to the relative displacement \(D\) is equivalent to the one of an isolated mass.< / li >
< li > The transfer function from ground motion \(D_g\) to the relative displacement \(D\) tends to the transfer function from \(D_g\) to the displacement of the granite (the sample is being isolated thanks to IFF).
However, as the goal is to make the relative displacement \(D\) as small as possible (e.g. to make the sample motion follows the granite motion), this is not a good thing.< / li >
< / ul >
2021-02-20 23:09:27 +01:00
< div id = "orgdfaeb87" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/sensitivity_dist_iff.png" alt = "sensitivity_dist_iff.png" / >
< / p >
< p > < span class = "figure-number" > Figure 8: < / span > Sensitivity to disturbance once the IFF controller is applied to the system (< a href = "./figs/sensitivity_dist_iff.png" > png< / a > , < a href = "./figs/sensitivity_dist_iff.pdf" > pdf< / a > )< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div class = "warning" id = "orgdbf82f8" >
2020-02-25 18:10:20 +01:00
< p >
The order of the models are very high and thus the plots may be wrong.
For instance, the plots are not the same when using < code > minreal< / code > .
< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "org7cd5eda" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/sensitivity_dist_stages_iff.png" alt = "sensitivity_dist_stages_iff.png" / >
< / p >
< p > < span class = "figure-number" > Figure 9: < / span > Sensitivity to force disturbances in various stages when IFF is applied (< a href = "./figs/sensitivity_dist_stages_iff.png" > png< / a > , < a href = "./figs/sensitivity_dist_stages_iff.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org740fdc1" class = "outline-3" >
< h3 id = "org740fdc1" > < span class = "section-number-3" > 2.5< / span > Damped Plant< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-2-5" >
< p >
Now, look at the new damped plant to control.
< / p >
< p >
2021-02-20 23:09:27 +01:00
It damps the plant (resonance of the nano hexapod as well as other resonances) as shown in figure < a href = "#org4311be3" > 10< / a > .
2020-02-25 18:10:20 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "org4311be3" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/plant_iff_damped.png" alt = "plant_iff_damped.png" / >
< / p >
< p > < span class = "figure-number" > Figure 10: < / span > Damped Plant after IFF is applied (< a href = "./figs/plant_iff_damped.png" > png< / a > , < a href = "./figs/plant_iff_damped.pdf" > pdf< / a > )< / p >
< / div >
< p >
2021-02-20 23:09:27 +01:00
However, it increases coupling at low frequency (figure < a href = "#org73e6345" > 11< / a > ).
2020-02-25 18:10:20 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "org73e6345" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/plant_iff_coupling.png" alt = "plant_iff_coupling.png" / >
< / p >
< p > < span class = "figure-number" > Figure 11: < / span > Coupling induced by IFF (< a href = "./figs/plant_iff_coupling.png" > png< / a > , < a href = "./figs/plant_iff_coupling.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org1a1d3de" class = "outline-3" >
< h3 id = "org1a1d3de" > < span class = "section-number-3" > 2.6< / span > Conclusion< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-2-6" >
2021-02-20 23:09:27 +01:00
< div class = "important" id = "org8194ada" >
2020-02-25 18:10:20 +01:00
< p >
Integral Force Feedback:
< / p >
< ul class = "org-ul" >
< li > Robust (guaranteed stability)< / li >
< li > Acceptable Damping< / li >
< li > Increase the sensitivity to disturbances at low frequencies< / li >
< / ul >
< / div >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org9e1866b" class = "outline-2" >
< h2 id = "org9e1866b" > < span class = "section-number-2" > 3< / span > Relative Motion Control< / h2 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-2" id = "text-3" >
< p >
2021-02-20 23:09:27 +01:00
< a id = "org360305e" > < / a >
2020-02-25 18:10:20 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div class = "note" id = "org6b2e874" >
2020-02-25 18:10:20 +01:00
< p >
All the files (data and Matlab scripts) are accessible < a href = "data/rmc.zip" > here< / a > .
< / p >
< / div >
< p >
In the Relative Motion Control (RMC), a derivative feedback is applied between the measured actuator displacement to the actuator force input.
< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org27412f8" class = "outline-3" >
< h3 id = "org27412f8" > < span class = "section-number-3" > 3.1< / span > One degree-of-freedom example< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-3-1" >
< p >
2021-02-20 23:09:27 +01:00
< a id = "org16b41e1" > < / a >
2020-02-25 18:10:20 +01:00
< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org7d60775" class = "outline-4" >
< h4 id = "org7d60775" > < span class = "section-number-4" > 3.1.1< / span > Equations< / h4 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-4" id = "text-3-1-1" >
2021-02-20 23:09:27 +01:00
< div id = "org6d8332e" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/rmc_1dof.png" alt = "rmc_1dof.png" / >
< / p >
< p > < span class = "figure-number" > Figure 12: < / span > Relative Motion Control applied to a 1dof system< / p >
< / div >
< p >
The dynamic of the system is:
< / p >
\begin{equation}
ms^2x = F_d - kx - csx + kw + csw + F
\end{equation}
< p >
In terms of the stage deformation \(d = x - w\):
< / p >
\begin{equation}
(ms^2 + cs + k) d = -ms^2 w + F_d + F
\end{equation}
< p >
The relative motion control law is:
< / p >
\begin{equation}
K = -g s
\end{equation}
< p >
Thus, the applied force is:
< / p >
\begin{equation}
F = -g s d
\end{equation}
< p >
And the new dynamics will be:
< / p >
\begin{equation}
d = w \frac{-ms^2}{ms^2 + (c + g)s + k} + F_d \frac{1}{ms^2 + (c + g)s + k} + F \frac{1}{ms^2 + (c + g)s + k}
\end{equation}
< p >
And thus damping is added.
< / p >
< p >
If critical damping is wanted:
< / p >
\begin{equation}
\xi = \frac{1}{2}\frac{c + g}{\sqrt{km}} = \frac{1}{2}
\end{equation}
< p >
This corresponds to a gain:
< / p >
\begin{equation}
g = \sqrt{km} - c
\end{equation}
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org0555f28" class = "outline-4" >
< h4 id = "org0555f28" > < span class = "section-number-4" > 3.1.2< / span > Matlab Example< / h4 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-4" id = "text-3-1-2" >
< p >
Let define the system parameters.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > m = 50; < span class = "org-comment" > % [kg]< / span >
k = 1e6; < span class = "org-comment" > % [N/m]< / span >
c = 1e3; < span class = "org-comment" > % [N/(m/s)]< / span >
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
The state space model of the system is defined below.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > A = [< span class = "org-type" > -< / span > c< span class = "org-type" > /< / span > m < span class = "org-type" > -< / span > k< span class = "org-type" > /< / span > m;
1 0];
2020-02-25 18:10:20 +01:00
2021-02-20 23:09:27 +01:00
B = [1< span class = "org-type" > /< / span > m 1< span class = "org-type" > /< / span > m < span class = "org-type" > -< / span > 1;
0 0 0];
2020-02-25 18:10:20 +01:00
2021-02-20 23:09:27 +01:00
C = [ 0 1;
< span class = "org-type" > -< / span > c < span class = "org-type" > -< / span > k];
2020-02-25 18:10:20 +01:00
2021-02-20 23:09:27 +01:00
D = [0 0 0;
1 0 0];
2020-02-25 18:10:20 +01:00
2021-02-20 23:09:27 +01:00
sys = ss(A, B, C, D);
sys.InputName = {< span class = "org-string" > 'F'< / span > , < span class = "org-string" > 'Fd'< / span > , < span class = "org-string" > 'wddot'< / span > };
sys.OutputName = {< span class = "org-string" > 'd'< / span > , < span class = "org-string" > 'Fm'< / span > };
sys.StateName = {< span class = "org-string" > 'ddot'< / span > , < span class = "org-string" > 'd'< / span > };
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
The controller \(K_\text{RMC}\) is:
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > Krmc = < span class = "org-type" > -< / span > (sqrt(k< span class = "org-type" > *< / span > m)< span class = "org-type" > -< / span > c)< span class = "org-type" > *< / span > s;
Krmc.InputName = {< span class = "org-string" > 'd'< / span > };
Krmc.OutputName = {< span class = "org-string" > 'F'< / span > };
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
And the closed loop system is computed below.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > sys_rmc = feedback(sys, Krmc, < span class = "org-string" > 'name'< / span > , < span class = "org-type" > +< / span > 1);
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "org80a99b9" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/rmc_1dof_sensitivitiy.png" alt = "rmc_1dof_sensitivitiy.png" / >
< / p >
< p > < span class = "figure-number" > Figure 13: < / span > Sensitivity to disturbance when RMC is applied on the 1dof system (< a href = "./figs/rmc_1dof_sensitivitiy.png" > png< / a > , < a href = "./figs/rmc_1dof_sensitivitiy.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org2512bc1" class = "outline-3" >
< h3 id = "org2512bc1" > < span class = "section-number-3" > 3.2< / span > Control Design< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-3-2" >
< p >
Let’ s load the undamped plant:
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > load(< span class = "org-string" > './mat/active_damping_uniaxial_plants.mat'< / span > , < span class = "org-string" > 'G'< / span > );
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
2021-02-20 23:09:27 +01:00
Let’ s look at the transfer function from actuator forces in the nano-hexapod to the measured displacement of the actuator for all 6 pairs of actuator/sensor (figure < a href = "#org959a724" > 14< / a > ).
2020-02-25 18:10:20 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "org959a724" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/rmc_plant.png" alt = "rmc_plant.png" / >
< / p >
< p > < span class = "figure-number" > Figure 14: < / span > Transfer function from forces applied in the legs to leg displacement sensor (< a href = "./figs/rmc_plant.png" > png< / a > , < a href = "./figs/rmc_plant.pdf" > pdf< / a > )< / p >
< / div >
< p >
The Relative Motion Controller is defined below.
A Low pass Filter is added to make the controller transfer function proper.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > K_rmc = s< span class = "org-type" > *< / span > 50000< span class = "org-type" > /< / span > (1 < span class = "org-type" > +< / span > s< span class = "org-type" > /< / span > 2< span class = "org-type" > /< / span > < span class = "org-constant" > pi< / span > < span class = "org-type" > /< / span > 10000);
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
2021-02-20 23:09:27 +01:00
The obtained loop gains are shown in figure < a href = "#orgc68cc03" > 15< / a > .
2020-02-25 18:10:20 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "orgc68cc03" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/rmc_open_loop.png" alt = "rmc_open_loop.png" / >
< / p >
< p > < span class = "figure-number" > Figure 15: < / span > Loop Gain for the Integral Force Feedback (< a href = "./figs/rmc_open_loop.png" > png< / a > , < a href = "./figs/rmc_open_loop.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org43ecec3" class = "outline-3" >
< h3 id = "org43ecec3" > < span class = "section-number-3" > 3.3< / span > Identification of the damped plant< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-3-3" >
< p >
Let’ s initialize the system prior to identification.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > initializeReferences();
initializeGround();
initializeGranite();
initializeTy();
initializeRy();
initializeRz();
initializeMicroHexapod();
initializeAxisc();
initializeMirror();
initializeNanoHexapod(< span class = "org-string" > 'actuator'< / span > , < span class = "org-string" > 'piezo'< / span > );
initializeSample(< span class = "org-string" > 'mass'< / span > , 50);
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
And initialize the controllers.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > K = tf(zeros(6));
save(< span class = "org-string" > './mat/controllers_uniaxial.mat'< / span > , < span class = "org-string" > 'K'< / span > , < span class = "org-string" > '-append'< / span > );
K_iff = tf(zeros(6));
save(< span class = "org-string" > './mat/controllers_uniaxial.mat'< / span > , < span class = "org-string" > 'K_iff'< / span > , < span class = "org-string" > '-append'< / span > );
K_rmc = < span class = "org-type" > -< / span > K_rmc< span class = "org-type" > *< / span > eye(6);
save(< span class = "org-string" > './mat/controllers_uniaxial.mat'< / span > , < span class = "org-string" > 'K_rmc'< / span > , < span class = "org-string" > '-append'< / span > );
K_dvf = tf(zeros(6));
save(< span class = "org-string" > './mat/controllers_uniaxial.mat'< / span > , < span class = "org-string" > 'K_dvf'< / span > , < span class = "org-string" > '-append'< / span > );
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
We identify the system dynamics now that the RMC controller is ON.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > G_rmc = identifyPlant();
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
And we save the damped plant for further analysis.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > save(< span class = "org-string" > './mat/active_damping_uniaxial_plants.mat'< / span > , < span class = "org-string" > 'G_rmc'< / span > , < span class = "org-string" > '-append'< / span > );
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org5752cc8" class = "outline-3" >
< h3 id = "org5752cc8" > < span class = "section-number-3" > 3.4< / span > Sensitivity to disturbances< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-3-4" >
< p >
2021-02-20 23:09:27 +01:00
As shown in figure < a href = "#orgbc94b42" > 16< / a > , RMC control succeed in lowering the sensitivity to disturbances near resonance of the system.
2020-02-25 18:10:20 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "orgbc94b42" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/sensitivity_dist_rmc.png" alt = "sensitivity_dist_rmc.png" / >
< / p >
< p > < span class = "figure-number" > Figure 16: < / span > Sensitivity to disturbance once the RMC controller is applied to the system (< a href = "./figs/sensitivity_dist_rmc.png" > png< / a > , < a href = "./figs/sensitivity_dist_rmc.pdf" > pdf< / a > )< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "orgb13f857" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/sensitivity_dist_stages_rmc.png" alt = "sensitivity_dist_stages_rmc.png" / >
< / p >
< p > < span class = "figure-number" > Figure 17: < / span > Sensitivity to force disturbances in various stages when RMC is applied (< a href = "./figs/sensitivity_dist_stages_rmc.png" > png< / a > , < a href = "./figs/sensitivity_dist_stages_rmc.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org6edbe38" class = "outline-3" >
< h3 id = "org6edbe38" > < span class = "section-number-3" > 3.5< / span > Damped Plant< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-3-5" >
2021-02-20 23:09:27 +01:00
< div id = "org108d66e" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/plant_rmc_damped.png" alt = "plant_rmc_damped.png" / >
< / p >
< p > < span class = "figure-number" > Figure 18: < / span > Damped Plant after RMC is applied (< a href = "./figs/plant_rmc_damped.png" > png< / a > , < a href = "./figs/plant_rmc_damped.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org0077c6d" class = "outline-3" >
< h3 id = "org0077c6d" > < span class = "section-number-3" > 3.6< / span > Conclusion< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-3-6" >
2021-02-20 23:09:27 +01:00
< div class = "important" id = "orgd5ac777" >
2020-02-25 18:10:20 +01:00
< p >
Relative Motion Control:
< / p >
< ul class = "org-ul" >
< li > < / li >
< / ul >
< / div >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org012ccf7" class = "outline-2" >
< h2 id = "org012ccf7" > < span class = "section-number-2" > 4< / span > Direct Velocity Feedback< / h2 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-2" id = "text-4" >
< p >
2021-02-20 23:09:27 +01:00
< a id = "orgcbdfd90" > < / a >
2020-02-25 18:10:20 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div class = "note" id = "org31d9c30" >
2020-02-25 18:10:20 +01:00
< p >
All the files (data and Matlab scripts) are accessible < a href = "data/dvf.zip" > here< / a > .
< / p >
< / div >
< p >
In the Relative Motion Control (RMC), a feedback is applied between the measured velocity of the platform to the actuator force input.
< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orgca0282d" class = "outline-3" >
< h3 id = "orgca0282d" > < span class = "section-number-3" > 4.1< / span > One degree-of-freedom example< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-4-1" >
< p >
2021-02-20 23:09:27 +01:00
< a id = "org42bf892" > < / a >
2020-02-25 18:10:20 +01:00
< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org827690f" class = "outline-4" >
< h4 id = "org827690f" > < span class = "section-number-4" > 4.1.1< / span > Equations< / h4 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-4" id = "text-4-1-1" >
2021-02-20 23:09:27 +01:00
< div id = "org427c470" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/dvf_1dof.png" alt = "dvf_1dof.png" / >
< / p >
< p > < span class = "figure-number" > Figure 19: < / span > Direct Velocity Feedback applied to a 1dof system< / p >
< / div >
< p >
The dynamic of the system is:
< / p >
\begin{equation}
ms^2x = F_d - kx - csx + kw + csw + F
\end{equation}
< p >
In terms of the stage deformation \(d = x - w\):
< / p >
\begin{equation}
(ms^2 + cs + k) d = -ms^2 w + F_d + F
\end{equation}
< p >
2021-02-20 23:09:27 +01:00
The direct velocity feedback law shown in figure < a href = "#org427c470" > 19< / a > is:
2020-02-25 18:10:20 +01:00
< / p >
\begin{equation}
K = -g
\end{equation}
< p >
Thus, the applied force is:
< / p >
\begin{equation}
F = -g \dot{x}
\end{equation}
< p >
And the new dynamics will be:
< / p >
\begin{equation}
d = w \frac{-ms^2 - gs}{ms^2 + (c + g)s + k} + F_d \frac{1}{ms^2 + (c + g)s + k} + F \frac{1}{ms^2 + (c + g)s + k}
\end{equation}
< p >
And thus damping is added.
< / p >
< p >
If critical damping is wanted:
< / p >
\begin{equation}
\xi = \frac{1}{2}\frac{c + g}{\sqrt{km}} = \frac{1}{2}
\end{equation}
< p >
This corresponds to a gain:
< / p >
\begin{equation}
g = \sqrt{km} - c
\end{equation}
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org4dbb739" class = "outline-4" >
< h4 id = "org4dbb739" > < span class = "section-number-4" > 4.1.2< / span > Matlab Example< / h4 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-4" id = "text-4-1-2" >
< p >
Let define the system parameters.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > m = 50; < span class = "org-comment" > % [kg]< / span >
k = 1e6; < span class = "org-comment" > % [N/m]< / span >
c = 1e3; < span class = "org-comment" > % [N/(m/s)]< / span >
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
The state space model of the system is defined below.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > A = [< span class = "org-type" > -< / span > c< span class = "org-type" > /< / span > m < span class = "org-type" > -< / span > k< span class = "org-type" > /< / span > m;
1 0];
2020-02-25 18:10:20 +01:00
2021-02-20 23:09:27 +01:00
B = [1< span class = "org-type" > /< / span > m 1< span class = "org-type" > /< / span > m < span class = "org-type" > -< / span > 1;
0 0 0];
2020-02-25 18:10:20 +01:00
2021-02-20 23:09:27 +01:00
C = [1 0;
0 1;
0 0];
2020-02-25 18:10:20 +01:00
2021-02-20 23:09:27 +01:00
D = [0 0 0;
0 0 0;
0 0 1];
2020-02-25 18:10:20 +01:00
2021-02-20 23:09:27 +01:00
sys = ss(A, B, C, D);
sys.InputName = {< span class = "org-string" > 'F'< / span > , < span class = "org-string" > 'Fd'< / span > , < span class = "org-string" > 'wddot'< / span > };
sys.OutputName = {< span class = "org-string" > 'ddot'< / span > , < span class = "org-string" > 'd'< / span > , < span class = "org-string" > 'wddot'< / span > };
sys.StateName = {< span class = "org-string" > 'ddot'< / span > , < span class = "org-string" > 'd'< / span > };
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
Because we need \(\dot{x}\) for feedback, we compute it from the outputs
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > G_xdot = [1, 0, 1< span class = "org-type" > /< / span > s;
0, 1, 0];
G_xdot.InputName = {< span class = "org-string" > 'ddot'< / span > , < span class = "org-string" > 'd'< / span > , < span class = "org-string" > 'wddot'< / span > };
G_xdot.OutputName = {< span class = "org-string" > 'xdot'< / span > , < span class = "org-string" > 'd'< / span > };
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
Finally, the system is described by < code > sys< / code > as defined below.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > sys = series(sys, G_xdot, [1 2 3], [1 2 3]);
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
The controller \(K_\text{DVF}\) is:
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > Kdvf = tf(< span class = "org-type" > -< / span > (sqrt(k< span class = "org-type" > *< / span > m)< span class = "org-type" > -< / span > c));
Kdvf.InputName = {< span class = "org-string" > 'xdot'< / span > };
Kdvf.OutputName = {< span class = "org-string" > 'F'< / span > };
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
And the closed loop system is computed below.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > sys_dvf = feedback(sys, Kdvf, < span class = "org-string" > 'name'< / span > , < span class = "org-type" > +< / span > 1);
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
2021-02-20 23:09:27 +01:00
The obtained sensitivity to disturbances is shown in figure < a href = "#org64c2bd4" > 20< / a > .
2020-02-25 18:10:20 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "org64c2bd4" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/dvf_1dof_sensitivitiy.png" alt = "dvf_1dof_sensitivitiy.png" / >
< / p >
< p > < span class = "figure-number" > Figure 20: < / span > Sensitivity to disturbance when DVF is applied on the 1dof system (< a href = "./figs/dvf_1dof_sensitivitiy.png" > png< / a > , < a href = "./figs/dvf_1dof_sensitivitiy.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org31bc936" class = "outline-3" >
< h3 id = "org31bc936" > < span class = "section-number-3" > 4.2< / span > Control Design< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-4-2" >
< p >
Let’ s load the undamped plant:
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > load(< span class = "org-string" > './mat/active_damping_uniaxial_plants.mat'< / span > , < span class = "org-string" > 'G'< / span > );
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
2021-02-20 23:09:27 +01:00
Let’ s look at the transfer function from actuator forces in the nano-hexapod to the measured velocity of the nano-hexapod platform in the direction of the corresponding actuator for all 6 pairs of actuator/sensor (figure < a href = "#orgb8038b3" > 21< / a > ).
2020-02-25 18:10:20 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "orgb8038b3" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/dvf_plant.png" alt = "dvf_plant.png" / >
< / p >
< p > < span class = "figure-number" > Figure 21: < / span > Transfer function from forces applied in the legs to leg velocity sensor (< a href = "./figs/dvf_plant.png" > png< / a > , < a href = "./figs/dvf_plant.pdf" > pdf< / a > )< / p >
< / div >
< p >
2021-02-20 23:09:27 +01:00
The controller is defined below and the obtained loop gain is shown in figure < a href = "#org0dad7a3" > 22< / a > .
2020-02-25 18:10:20 +01:00
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > K_dvf = tf(3e4);
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "org0dad7a3" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/dvf_open_loop_gain.png" alt = "dvf_open_loop_gain.png" / >
< / p >
< p > < span class = "figure-number" > Figure 22: < / span > Loop Gain for DVF (< a href = "./figs/dvf_open_loop_gain.png" > png< / a > , < a href = "./figs/dvf_open_loop_gain.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org040cbd4" class = "outline-3" >
< h3 id = "org040cbd4" > < span class = "section-number-3" > 4.3< / span > Identification of the damped plant< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-4-3" >
< p >
Let’ s initialize the system prior to identification.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > initializeReferences();
initializeGround();
initializeGranite();
initializeTy();
initializeRy();
initializeRz();
initializeMicroHexapod();
initializeAxisc();
initializeMirror();
initializeNanoHexapod(< span class = "org-string" > 'actuator'< / span > , < span class = "org-string" > 'piezo'< / span > );
initializeSample(< span class = "org-string" > 'mass'< / span > , 50);
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
And initialize the controllers.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > K = tf(zeros(6));
save(< span class = "org-string" > './mat/controllers_uniaxial.mat'< / span > , < span class = "org-string" > 'K'< / span > , < span class = "org-string" > '-append'< / span > );
K_iff = tf(zeros(6));
save(< span class = "org-string" > './mat/controllers_uniaxial.mat'< / span > , < span class = "org-string" > 'K_iff'< / span > , < span class = "org-string" > '-append'< / span > );
K_rmc = tf(zeros(6));
save(< span class = "org-string" > './mat/controllers_uniaxial.mat'< / span > , < span class = "org-string" > 'K_rmc'< / span > , < span class = "org-string" > '-append'< / span > );
K_dvf = < span class = "org-type" > -< / span > K_dvf< span class = "org-type" > *< / span > eye(6);
save(< span class = "org-string" > './mat/controllers_uniaxial.mat'< / span > , < span class = "org-string" > 'K_dvf'< / span > , < span class = "org-string" > '-append'< / span > );
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
We identify the system dynamics now that the RMC controller is ON.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > G_dvf = identifyPlant();
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< p >
And we save the damped plant for further analysis.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > save(< span class = "org-string" > './mat/active_damping_uniaxial_plants.mat'< / span > , < span class = "org-string" > 'G_dvf'< / span > , < span class = "org-string" > '-append'< / span > );
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orgcddca6d" class = "outline-3" >
< h3 id = "orgcddca6d" > < span class = "section-number-3" > 4.4< / span > Sensitivity to disturbances< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-4-4" >
2021-02-20 23:09:27 +01:00
< div id = "orgfb708fd" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/sensitivity_dist_dvf.png" alt = "sensitivity_dist_dvf.png" / >
< / p >
< p > < span class = "figure-number" > Figure 23: < / span > Sensitivity to disturbance once the DVF controller is applied to the system (< a href = "./figs/sensitivity_dist_dvf.png" > png< / a > , < a href = "./figs/sensitivity_dist_dvf.pdf" > pdf< / a > )< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "orgdb95e6c" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/sensitivity_dist_stages_dvf.png" alt = "sensitivity_dist_stages_dvf.png" / >
< / p >
< p > < span class = "figure-number" > Figure 24: < / span > Sensitivity to force disturbances in various stages when DVF is applied (< a href = "./figs/sensitivity_dist_stages_dvf.png" > png< / a > , < a href = "./figs/sensitivity_dist_stages_dvf.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orga50ffdb" class = "outline-3" >
< h3 id = "orga50ffdb" > < span class = "section-number-3" > 4.5< / span > Damped Plant< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-4-5" >
2021-02-20 23:09:27 +01:00
< div id = "org3dabbdc" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/plant_dvf_damped.png" alt = "plant_dvf_damped.png" / >
< / p >
< p > < span class = "figure-number" > Figure 25: < / span > Damped Plant after DVF is applied (< a href = "./figs/plant_dvf_damped.png" > png< / a > , < a href = "./figs/plant_dvf_damped.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orgfebd36e" class = "outline-3" >
< h3 id = "orgfebd36e" > < span class = "section-number-3" > 4.6< / span > Conclusion< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-4-6" >
2021-02-20 23:09:27 +01:00
< div class = "important" id = "orga87e8e0" >
2020-02-25 18:10:20 +01:00
< p >
Direct Velocity Feedback:
< / p >
< / div >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org9eee619" class = "outline-2" >
< h2 id = "org9eee619" > < span class = "section-number-2" > 5< / span > Comparison< / h2 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-2" id = "text-5" >
< p >
2021-02-20 23:09:27 +01:00
< a id = "org906ac25" > < / a >
2020-02-25 18:10:20 +01:00
< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orgbf02110" class = "outline-3" >
< h3 id = "orgbf02110" > < span class = "section-number-3" > 5.1< / span > Load the plants< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-5-1" >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > load(< span class = "org-string" > './mat/active_damping_uniaxial_plants.mat'< / span > , < span class = "org-string" > 'G'< / span > , < span class = "org-string" > 'G_iff'< / span > , < span class = "org-string" > 'G_rmc'< / span > , < span class = "org-string" > 'G_dvf'< / span > );
2020-02-25 18:10:20 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org78f3ac5" class = "outline-3" >
< h3 id = "org78f3ac5" > < span class = "section-number-3" > 5.2< / span > Sensitivity to Disturbance< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-5-2" >
2021-02-20 23:09:27 +01:00
< div id = "org5b6dd3b" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/sensitivity_comp_ground_motion_z.png" alt = "sensitivity_comp_ground_motion_z.png" / >
< / p >
< p > < span class = "figure-number" > Figure 26: < / span > caption (< a href = "./figs/sensitivity_comp_ground_motion_z.png" > png< / a > , < a href = "./figs/sensitivity_comp_ground_motion_z.pdf" > pdf< / a > )< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "org28db176" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/sensitivity_comp_direct_forces_z.png" alt = "sensitivity_comp_direct_forces_z.png" / >
< / p >
< p > < span class = "figure-number" > Figure 27: < / span > caption (< a href = "./figs/sensitivity_comp_direct_forces_z.png" > png< / a > , < a href = "./figs/sensitivity_comp_direct_forces_z.pdf" > pdf< / a > )< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "orge995607" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/sensitivity_comp_spindle_z.png" alt = "sensitivity_comp_spindle_z.png" / >
< / p >
< p > < span class = "figure-number" > Figure 28: < / span > caption (< a href = "./figs/sensitivity_comp_spindle_z.png" > png< / a > , < a href = "./figs/sensitivity_comp_spindle_z.pdf" > pdf< / a > )< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "org34da384" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/sensitivity_comp_ty_z.png" alt = "sensitivity_comp_ty_z.png" / >
< / p >
< p > < span class = "figure-number" > Figure 29: < / span > caption (< a href = "./figs/sensitivity_comp_ty_z.png" > png< / a > , < a href = "./figs/sensitivity_comp_ty_z.pdf" > pdf< / a > )< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "org34ea31b" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/sensitivity_comp_ty_x.png" alt = "sensitivity_comp_ty_x.png" / >
< / p >
< p > < span class = "figure-number" > Figure 30: < / span > caption (< a href = "./figs/sensitivity_comp_ty_x.png" > png< / a > , < a href = "./figs/sensitivity_comp_ty_x.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org5c6929b" class = "outline-3" >
< h3 id = "org5c6929b" > < span class = "section-number-3" > 5.3< / span > Damped Plant< / h3 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-3" id = "text-5-3" >
2021-02-20 23:09:27 +01:00
< div id = "orgdaa8315" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/plant_comp_damping_z.png" alt = "plant_comp_damping_z.png" / >
< / p >
< p > < span class = "figure-number" > Figure 31: < / span > Plant for the \(z\) direction for different active damping technique used (< a href = "./figs/plant_comp_damping_z.png" > png< / a > , < a href = "./figs/plant_comp_damping_z.pdf" > pdf< / a > )< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "org57a5281" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/plant_comp_damping_x.png" alt = "plant_comp_damping_x.png" / >
< / p >
< p > < span class = "figure-number" > Figure 32: < / span > Plant for the \(x\) direction for different active damping technique used (< a href = "./figs/plant_comp_damping_x.png" > png< / a > , < a href = "./figs/plant_comp_damping_x.pdf" > pdf< / a > )< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "org891f34b" class = "figure" >
2020-02-25 18:10:20 +01:00
< p > < img src = "figs/plant_comp_damping_coupling.png" alt = "plant_comp_damping_coupling.png" / >
< / p >
< p > < span class = "figure-number" > Figure 33: < / span > Comparison of one off-diagonal plant for different damping technique applied (< a href = "./figs/plant_comp_damping_coupling.png" > png< / a > , < a href = "./figs/plant_comp_damping_coupling.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org33904c4" class = "outline-2" >
< h2 id = "org33904c4" > < span class = "section-number-2" > 6< / span > Conclusion< / h2 >
2020-02-25 18:10:20 +01:00
< div class = "outline-text-2" id = "text-6" >
< p >
2021-02-20 23:09:27 +01:00
< a id = "org80f91ae" > < / a >
2020-02-25 18:10:20 +01:00
< / p >
< / div >
< / div >
< / div >
< div id = "postamble" class = "status" >
< p class = "author" > Author: Dehaeze Thomas< / p >
2021-02-20 23:09:27 +01:00
< p class = "date" > Created: 2021-02-20 sam. 23:08< / p >
2020-02-25 18:10:20 +01:00
< / div >
< / body >
< / html >
