2020-03-13 17:40:22 +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:09 -->
2020-03-13 17:40:22 +01:00
< meta http-equiv = "Content-Type" content = "text/html;charset=utf-8" / >
< title > Control Requirements< / 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-03-13 17:40:22 +01:00
< / head >
< body >
< div id = "org-div-home-and-up" >
< a accesskey = "h" href = "./index.html" > UP < / a >
|
2021-02-20 23:09:27 +01:00
< a accesskey = "H" href = "../../index.html" > HOME < / a >
2020-03-13 17:40:22 +01:00
< / div > < div id = "content" >
< h1 class = "title" > Control Requirements< / 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 = "#orga2b82d5" > 1. Simplify Model for the Nano-Hexapod< / a >
2020-03-13 17:40:22 +01:00
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org91b05ab" > 1.1. Model of the nano-hexapod< / a > < / li >
< li > < a href = "#orgd4cde5a" > 1.2. How to include Ground Motion in the model?< / a > < / li >
< li > < a href = "#orgfbfdea6" > 1.3. Motion of the micro-station< / a > < / li >
2020-03-13 17:40:22 +01:00
< / ul >
< / li >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org1587049" > 2. Control with the Stiff Nano-Hexapod< / a >
2020-03-17 11:23:47 +01:00
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org2755fd8" > 2.1. Definition of the values< / a > < / li >
< li > < a href = "#orgfe39988" > 2.2. Control using \(d\)< / a >
2020-03-13 17:40:22 +01:00
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org8c7033c" > 2.2.1. Control Architecture< / a > < / li >
< li > < a href = "#org7ae71af" > 2.2.2. Analytical Analysis< / a > < / li >
2020-03-13 17:40:22 +01:00
< / ul >
< / li >
2021-02-20 23:09:27 +01:00
< li > < a href = "#orgc8538ae" > 2.3. Control using \(F_m\)< / a >
2020-03-13 17:40:22 +01:00
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org78657b0" > 2.3.1. Control Architecture< / a > < / li >
< li > < a href = "#org541549a" > 2.3.2. Pure Integrator< / a > < / li >
< li > < a href = "#org7528b09" > 2.3.3. Low pass filter< / a > < / li >
2020-03-13 17:40:22 +01:00
< / ul >
< / li >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org61c8fa0" > 2.4. Comparison< / a > < / li >
< li > < a href = "#org7d757e0" > 2.5. Control using \(x\)< / a >
2020-03-13 17:40:22 +01:00
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org616e1cc" > 2.5.1. Analytical analysis< / a > < / li >
< li > < a href = "#org03b4b61" > 2.5.2. Control implementation< / a > < / li >
< li > < a href = "#orga972dfd" > 2.5.3. Results< / a > < / li >
2020-03-13 17:40:22 +01:00
< / ul >
< / li >
2020-03-17 11:23:47 +01:00
< / ul >
< / li >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org4c09e57" > 3. Comparison with the use of a Soft nano-hexapod< / a > < / li >
< li > < a href = "#orgdb89cb5" > 4. Estimate the level of vibration< / a > < / li >
< li > < a href = "#orgf03c5a6" > 5. Requirements on the norm of closed-loop transfer functions< / a >
2020-03-13 17:40:22 +01:00
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org607da90" > 5.1. Approximation of the ASD of perturbations< / a > < / li >
< li > < a href = "#orge547462" > 5.2. Wanted ASD of outputs< / a > < / li >
< li > < a href = "#orga95353c" > 5.3. Limiting the bandwidth< / a > < / li >
< li > < a href = "#orgb3d8660" > 5.4. Generalized Weighted plant< / a > < / li >
< li > < a href = "#org5cc7197" > 5.5. Synthesis< / a > < / li >
< li > < a href = "#org1747e58" > 5.6. Loop Gain< / a > < / li >
< li > < a href = "#orgee72143" > 5.7. Results< / a > < / li >
< li > < a href = "#org50ebd42" > 5.8. Requirements< / a > < / li >
2020-03-13 17:40:22 +01:00
< / ul >
< / li >
< / ul >
< / div >
< / div >
< p >
The goal here is to write clear specifications for the NASS.
< / p >
< p >
This can then be used for the control synthesis and for the design of the nano-hexapod.
< / p >
< p >
Ideal, specifications on the norm of closed loop transfer function should be written.
< / p >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orga2b82d5" class = "outline-2" >
< h2 id = "orga2b82d5" > < span class = "section-number-2" > 1< / span > Simplify Model for the Nano-Hexapod< / h2 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-2" id = "text-1" >
2020-03-13 17:40:22 +01:00
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org91b05ab" class = "outline-3" >
< h3 id = "org91b05ab" > < span class = "section-number-3" > 1.1< / span > Model of the nano-hexapod< / h3 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-3" id = "text-1-1" >
2020-03-13 17:40:22 +01:00
< p >
2021-02-20 23:09:27 +01:00
Let’ s consider the simple mechanical system in Figure < a href = "#org287cdf4" > 1< / a > .
2020-03-13 17:40:22 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "org287cdf4" class = "figure" >
2020-03-13 17:40:22 +01:00
< p > < img src = "figs/nass_simple_model.png" alt = "nass_simple_model.png" / >
< / p >
< p > < span class = "figure-number" > Figure 1: < / span > Simplified mechanical system for the nano-hexapod< / p >
< / div >
< p >
2021-02-20 23:09:27 +01:00
The signals are described in table < a href = "#org7a3ad92" > 1< / a > .
2020-03-13 17:40:22 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< table id = "org7a3ad92" border = "2" cellspacing = "0" cellpadding = "6" rules = "groups" frame = "hsides" >
2020-03-13 17:40:22 +01:00
< caption class = "t-above" > < span class = "table-number" > Table 1:< / span > Signals definition for the generalized plant< / caption >
< colgroup >
< col class = "org-left" / >
< col class = "org-left" / >
< col class = "org-left" / >
< / colgroup >
< thead >
< tr >
< th scope = "col" class = "org-left" >   < / th >
< th scope = "col" class = "org-left" > < b > Symbol< / b > < / th >
< th scope = "col" class = "org-left" > < b > Meaning< / b > < / th >
< / tr >
< / thead >
< tbody >
< tr >
< td class = "org-left" > < b > Exogenous Inputs< / b > < / td >
< td class = "org-left" > \(x_\mu\)< / td >
< td class = "org-left" > Motion of the $ν $-hexapod’ s base< / td >
< / tr >
< tr >
< td class = "org-left" >   < / td >
< td class = "org-left" > \(F_d\)< / td >
< td class = "org-left" > External Forces applied to the Payload< / td >
< / tr >
< tr >
< td class = "org-left" >   < / td >
< td class = "org-left" > \(r\)< / td >
< td class = "org-left" > Reference signal for tracking< / td >
< / tr >
< / tbody >
< tbody >
< tr >
< td class = "org-left" > < b > Exogenous Outputs< / b > < / td >
< td class = "org-left" > \(x\)< / td >
< td class = "org-left" > Absolute Motion of the Payload< / td >
< / tr >
< / tbody >
< tbody >
< tr >
< td class = "org-left" > < b > Sensed Outputs< / b > < / td >
< td class = "org-left" > \(F_m\)< / td >
< td class = "org-left" > Force Sensors in each leg< / td >
< / tr >
< tr >
< td class = "org-left" >   < / td >
< td class = "org-left" > \(d\)< / td >
< td class = "org-left" > Measured displacement of each leg< / td >
< / tr >
< tr >
< td class = "org-left" >   < / td >
< td class = "org-left" > \(x\)< / td >
< td class = "org-left" > Absolute Motion of the Payload< / td >
< / tr >
< / tbody >
< tbody >
< tr >
< td class = "org-left" > < b > Control Signals< / b > < / td >
< td class = "org-left" > \(F\)< / td >
< td class = "org-left" > Actuator Inputs< / td >
< / tr >
< / tbody >
< / table >
< p >
For the nano-hexapod alone, we have the following equations:
\[ \begin{align*}
x & = \frac{1}{ms^2 + k} F + \frac{1}{ms^2 + k} F_d + \frac{k}{ms^2 + k} x_\mu \\
F_m & = \frac{ms^2}{ms^2 + k} F - \frac{k}{ms^2 + k} F_d + \frac{k m s^2}{ms^2 + k} x_\mu \\
d & = \frac{1}{ms^2 + k} F + \frac{1}{ms^2 + k} F_d - \frac{ms^2}{ms^2 + k} x_\mu
\end{align*} \]
< / p >
< p >
We can write the equations function of \(\omega_\nu = \sqrt{\frac{k}{m}}\):
\[ \begin{align*}
x & = \frac{1/k}{1 + \frac{s^2}{\omega_\nu^2}} F + \frac{1/k}{1 + \frac{s^2}{\omega_\nu^2}} F_d + \frac{1}{1 + \frac{s^2}{\omega_\nu^2}} x_\mu \\
F_m & = \frac{\frac{s^2}{\omega_\nu^2}}{1 + \frac{s^2}{\omega_\nu^2}} F - \frac{1}{1 + \frac{s^2}{\omega_\nu^2}} F_d + \frac{k \frac{s^2}{\omega_\nu^2}}{1 + \frac{s^2}{\omega_\nu^2}} x_\mu \\
d & = \frac{1/k}{1 + \frac{s^2}{\omega_\nu^2}} F + \frac{1/k}{1 + \frac{s^2}{\omega_\nu^2}} F_d - \frac{\frac{s^2}{\omega_\nu^2}}{1 + \frac{s^2}{\omega_\nu^2}} x_\mu
\end{align*} \]
< / p >
< p >
< b > Assumptions< / b > :
< / p >
< ul class = "org-ul" >
< li > the forces applied by the nano-hexapod have no influence on the micro-station, specifically on the displacement of the top platform of the micro-hexapod.< / li >
< / ul >
< p >
This means that the nano-hexapod can be considered separately from the micro-station and that the motion \(x_\mu\) is imposed and considered as an external input.
< / p >
< p >
2021-02-20 23:09:27 +01:00
The nano-hexapod can thus be represented as in Figure < a href = "#org76a142f" > 2< / a > .
2020-03-13 17:40:22 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "org76a142f" class = "figure" >
2020-03-13 17:40:22 +01:00
< p > < img src = "figs/nano_station_inputs_outputs.png" alt = "nano_station_inputs_outputs.png" / >
< / p >
< p > < span class = "figure-number" > Figure 2: < / span > Block representation of the nano-hexapod< / p >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orgd4cde5a" class = "outline-3" >
< h3 id = "orgd4cde5a" > < span class = "section-number-3" > 1.2< / span > How to include Ground Motion in the model?< / h3 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-3" id = "text-1-2" >
2020-03-13 17:40:22 +01:00
< p >
What we measure is not the absolute motion \(x\), but the relative motion \(x - w\) where \(w\) is the motion of the granite.
< / p >
< p >
Also, \(w\) induces some motion \(x_\mu\) through the transmissibility of the micro-station.
< / p >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orgfbfdea6" class = "outline-3" >
< h3 id = "orgfbfdea6" > < span class = "section-number-3" > 1.3< / span > Motion of the micro-station< / h3 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-3" id = "text-1-3" >
2020-03-13 17:40:22 +01:00
< p >
As explained, we consider \(x_\mu\) as an external input (\(F\) has no influence on \(x_\mu\)).
< / p >
< p >
\(x_\mu\) is the motion of the micro-station’ s top platform due to the motion of each stage of the micro-station.
< / p >
< p >
We consider that \(x_\mu\) has the following form:
\[ x_\mu = T_\mu r + d_\mu \]
where:
< / p >
< ul class = "org-ul" >
< li > \(T_\mu r\) corresponds to the response of the stages due to the reference \(r\)< / li >
< li > \(d_\mu\) is the motion of the hexapod due to all the vibrations of the stages< / li >
< / ul >
< p >
\(T_\mu\) can be considered to be a low pass filter with a bandwidth corresponding approximatively to the bandwidth of the micro-station’ s stages.
To simplify, we can consider \(T_\mu\) to be a first order low pass filter:
\[ T_\mu = \frac{1}{1 + s/\omega_\mu} \]
where \(\omega_\mu\) corresponds to the tracking speed of the micro-station.
< / p >
< p >
What is important to note is that while \(x_\mu\) is viewed as a perturbation from the nano-hexapod point of view, \(x_\mu\) < b > does< / b > depend on the reference signal \(r\).
< / p >
< p >
Also, here, we suppose that the granite is not moving.
< / p >
< p >
2021-02-20 23:09:27 +01:00
If we now include the motion of the granite \(w\), we obtain the block diagram shown in Figure < a href = "#org1711254" > 3< / a > .
2020-03-13 17:40:22 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "org1711254" class = "figure" >
2020-03-13 17:40:22 +01:00
< p > < img src = "figs/nano_station_ground_motion.png" alt = "nano_station_ground_motion.png" / >
< / p >
2020-03-17 11:23:47 +01:00
< p > < span class = "figure-number" > Figure 3: < / span > Ground Motion \(w\) included< / p >
2020-03-13 17:40:22 +01:00
< / div >
< p >
\(T_w\) is the mechanical transmissibility of the micro-station.
We can approximate this transfer function by a second order low pass filter:
\[ T_w = \frac{1}{1 + 2 \xi s/\omega_0 + s^2/\omega_0^2} \]
< / p >
< / div >
< / div >
2020-03-17 11:23:47 +01:00
< / div >
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org1587049" class = "outline-2" >
< h2 id = "org1587049" > < span class = "section-number-2" > 2< / span > Control with the Stiff Nano-Hexapod< / h2 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-2" id = "text-2" >
2020-03-13 17:40:22 +01:00
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org2755fd8" class = "outline-3" >
< h3 id = "org2755fd8" > < span class = "section-number-3" > 2.1< / span > Definition of the values< / h3 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-3" id = "text-2-1" >
2020-03-13 17:40:22 +01:00
< p >
Let’ s define the mass and stiffness of the nano-hexapod.
< / 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 = 1e7; < span class = "org-comment" > % [N/m]< / span >
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
< p >
2021-02-20 23:09:27 +01:00
Let’ s define the Plant as shown in Figure < a href = "#org76a142f" > 2< / a > :
2020-03-13 17:40:22 +01:00
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > Gn = 1< span class = "org-type" > /< / span > (m< span class = "org-type" > *< / span > s< span class = "org-type" > ^< / span > 2 < span class = "org-type" > +< / span > k)< span class = "org-type" > *< / span > [< span class = "org-type" > -< / span > k, k< span class = "org-type" > *< / span > m< span class = "org-type" > *< / span > s< span class = "org-type" > ^< / span > 2, m< span class = "org-type" > *< / span > s< span class = "org-type" > ^< / span > 2; 1, < span class = "org-type" > -< / span > m< span class = "org-type" > *< / span > s< span class = "org-type" > ^< / span > 2, 1; 1, k, 1];
Gn.InputName = {< span class = "org-string" > 'Fd'< / span > , < span class = "org-string" > 'xmu'< / span > , < span class = "org-string" > 'F'< / span > };
Gn.OutputName = {< span class = "org-string" > 'Fm'< / span > , < span class = "org-string" > 'd'< / span > , < span class = "org-string" > 'x'< / span > };
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
< p >
Now, define the transmissibility transfer function \(T_\mu\) corresponding to the micro-station motion.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > wmu = 2< span class = "org-type" > *< / span > < span class = "org-constant" > pi< / span > < span class = "org-type" > *< / span > 50; < span class = "org-comment" > % [rad/s]< / span >
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
Tmu = 1< span class = "org-type" > /< / span > (1 < span class = "org-type" > +< / span > s< span class = "org-type" > /< / span > wmu);
Tmu.InputName = {< span class = "org-string" > 'r1'< / span > };
Tmu.OutputName = {< span class = "org-string" > 'ymu'< / span > };
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > w0 = 2< span class = "org-type" > *< / span > < span class = "org-constant" > pi< / span > < span class = "org-type" > *< / span > 40;
xi = 0.5;
Tw = 1< span class = "org-type" > /< / span > (1 < span class = "org-type" > +< / span > 2< span class = "org-type" > *< / span > xi< span class = "org-type" > *< / span > s< span class = "org-type" > /< / span > w0 < span class = "org-type" > +< / span > s< span class = "org-type" > ^< / span > 2< span class = "org-type" > /< / span > w0< span class = "org-type" > ^< / span > 2);
Tw.InputName = {< span class = "org-string" > 'w1'< / span > };
Tw.OutputName = {< span class = "org-string" > 'dw'< / span > };
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
< p >
We add the fact that \(x_\mu = d_\mu + T_\mu r + T_w w\):
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > Wsplit = [tf(1); tf(1)];
Wsplit.InputName = {< span class = "org-string" > 'w'< / span > };
Wsplit.OutputName = {< span class = "org-string" > 'w1'< / span > , < span class = "org-string" > 'w2'< / span > };
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
S = sumblk(< span class = "org-string" > 'xmu = ymu + dmu + dw'< / span > );
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
Sw = sumblk(< span class = "org-string" > 'y = x - w2'< / span > );
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
Gpz = connect(Gn, S, Wsplit, Tw, Tmu, Sw, {< span class = "org-string" > 'Fd'< / span > , < span class = "org-string" > 'dmu'< / span > , < span class = "org-string" > 'r1'< / span > , < span class = "org-string" > 'F'< / span > , < span class = "org-string" > 'w'< / span > }, {< span class = "org-string" > 'Fm'< / span > , < span class = "org-string" > 'd'< / span > , < span class = "org-string" > 'y'< / span > });
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orgfe39988" class = "outline-3" >
< h3 id = "orgfe39988" > < span class = "section-number-3" > 2.2< / span > Control using \(d\)< / h3 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-3" id = "text-2-2" >
2020-03-13 17:40:22 +01:00
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org8c7033c" class = "outline-4" >
< h4 id = "org8c7033c" > < span class = "section-number-4" > 2.2.1< / span > Control Architecture< / h4 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-4" id = "text-2-2-1" >
2020-03-13 17:40:22 +01:00
< p >
2021-02-20 23:09:27 +01:00
Let’ s consider a feedback loop using \(d\) as shown in Figure < a href = "#orgc09a262" > 4< / a > .
2020-03-13 17:40:22 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "orgc09a262" class = "figure" >
2020-03-13 17:40:22 +01:00
< p > < img src = "figs/nano_station_control_d.png" alt = "nano_station_control_d.png" / >
< / p >
2020-03-17 11:23:47 +01:00
< p > < span class = "figure-number" > Figure 4: < / span > Feedback diagram using \(d\)< / p >
2020-03-13 17:40:22 +01:00
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org7ae71af" class = "outline-4" >
< h4 id = "org7ae71af" > < span class = "section-number-4" > 2.2.2< / span > Analytical Analysis< / h4 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-4" id = "text-2-2-2" >
2020-03-13 17:40:22 +01:00
< p >
Let’ s apply a direct velocity feedback by deriving \(d\):
\[ F = F^\prime - g s d \]
< / p >
< p >
Thus:
\[ d = \frac{1}{ms^2 + gs + k} F^\prime + \frac{1}{ms^2 + gs + k} F_d - \frac{ms^2}{ms^2 + gs + k} x_\mu \]
< / p >
< p >
\[ F = \frac{ms^2 + k}{ms^2 + gs + k} F^\prime - \frac{gs}{ms^2 + gs + k} F_d + \frac{mgs^3}{ms^2 + gs + k} x_\mu \]
< / p >
< p >
and
\[ x = \frac{1}{ms^2 + k} (\frac{ms^2 + k}{ms^2 + gs + k} F^\prime - \frac{gs}{ms^2 + gs + k} F_d + \frac{mgs^3}{ms^2 + gs + k} x_\mu) + \frac{1}{ms^2 + k} F_d + \frac{k}{ms^2 + k} x_\mu \]
< / p >
< p >
\[ x = \frac{ms^2 + k}{(ms^2 + k) (ms^2 + gs + k)} F^\prime + \frac{ms^2 + k}{(ms^2 + k) (ms^2 + gs + k)} F_d + \frac{mgs^3 + k(ms^2 + gs + k)}{(ms^2 + k) (ms^2 + gs + k)} x_\mu \]
< / p >
< p >
And we finally obtain:
\[ x = \frac{1}{ms^2 + gs + k} F^\prime + \frac{1}{ms^2 + gs + k} F_d + \frac{gs + k}{ms^2 + gs + k} x_\mu \]
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > K_dvf = 2< span class = "org-type" > *< / span > sqrt(k< span class = "org-type" > *< / span > m)< span class = "org-type" > *< / span > s;
K_dvf.InputName = {< span class = "org-string" > 'd'< / span > };
K_dvf.OutputName = {< span class = "org-string" > 'F'< / span > };
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
Gpz_dvf = feedback(Gpz, K_dvf, < span class = "org-string" > 'name'< / span > );
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
< p >
Now let’ s consider that \(x_\mu = d_\mu + T_\mu r\)
< / p >
< p >
\[ x = \frac{1}{ms^2 + gs + k} F^\prime + \frac{1}{ms^2 + gs + k} F_d + \frac{gs + k}{ms^2 + gs + k} d_\mu + T_\mu \frac{gs + k}{ms^2 + gs + k} r \]
< / p >
< p >
And \(\epsilon = r - x\):
\[ \epsilon = \frac{1}{ms^2 + gs + k} F^\prime + \frac{1}{ms^2 + gs + k} F_d + \frac{gs + k}{ms^2 + gs + k} d_\mu + \frac{ms^2 + gs + k - T_\mu (gs + k)}{ms^2 + gs + k} r \]
< / p >
2021-02-20 23:09:27 +01:00
< div class = "important" id = "orga8c9e65" >
2020-03-13 17:40:22 +01:00
< p >
\[ \epsilon = \frac{1}{ms^2 + gs + k} F^\prime + \frac{1}{ms^2 + gs + k} F_d + \frac{gs + k}{ms^2 + gs + k} d_\mu + \frac{ms^2 - S_\mu(gs + k)}{ms^2 + gs + k} r \]
< / p >
< / div >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orgc8538ae" class = "outline-3" >
< h3 id = "orgc8538ae" > < span class = "section-number-3" > 2.3< / span > Control using \(F_m\)< / h3 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-3" id = "text-2-3" >
2020-03-13 17:40:22 +01:00
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org78657b0" class = "outline-4" >
< h4 id = "org78657b0" > < span class = "section-number-4" > 2.3.1< / span > Control Architecture< / h4 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-4" id = "text-2-3-1" >
2020-03-13 17:40:22 +01:00
< p >
2021-02-20 23:09:27 +01:00
Let’ s consider a feedback loop using \(Fm\) as shown in Figure < a href = "#org88d18fb" > 5< / a > .
2020-03-13 17:40:22 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "org88d18fb" class = "figure" >
2020-03-13 17:40:22 +01:00
< p > < img src = "figs/nano_station_control_Fm.png" alt = "nano_station_control_Fm.png" / >
< / p >
2020-03-17 11:23:47 +01:00
< p > < span class = "figure-number" > Figure 5: < / span > Feedback diagram using \(F_m\)< / p >
2020-03-13 17:40:22 +01:00
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org541549a" class = "outline-4" >
< h4 id = "org541549a" > < span class = "section-number-4" > 2.3.2< / span > Pure Integrator< / h4 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-4" id = "text-2-3-2" >
2020-03-13 17:40:22 +01:00
< p >
Let’ s apply integral force feedback by integration \(F_m\):
\[ F = F^\prime - \frac{g}{s} F_m \]
< / p >
< p >
And we finally obtain:
\[ x = \frac{1}{ms^2 + mgs + k} F^\prime + \frac{1 + \frac{g}{s}}{ms^2 + mgs + k} F_d + \frac{k}{ms^2 + mgs + k} x_\mu \]
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > K_iff = 2< span class = "org-type" > *< / span > sqrt(k< span class = "org-type" > /< / span > m)< span class = "org-type" > /< / span > s;
K_iff.InputName = {< span class = "org-string" > 'Fm'< / span > };
K_iff.OutputName = {< span class = "org-string" > 'F'< / span > };
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
Gpz_iff = feedback(Gpz, K_iff, < span class = "org-string" > 'name'< / span > );
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
< p >
Now let’ s consider that \(x_\mu = d_\mu + T_\mu r\)
< / p >
< p >
\[ x = \frac{1}{ms^2 + mgs + k} F^\prime + \frac{1 + \frac{g}{s}}{ms^2 + mgs + k} F_d + \frac{k}{ms^2 + mgs + k} d_\mu + \frac{T_\mu k}{ms^2 + mgs + k} r \]
< / p >
< p >
And \(\epsilon = r - x\):
\[ \epsilon = \frac{1}{ms^2 + mgs + k} F^\prime + \frac{1 + \frac{g}{s}}{ms^2 + mgs + k} F_d + \frac{k}{ms^2 + mgs + k} d_\mu + \frac{ms^2 + mgs + k - T_\mu k}{ms^2 + mgs + k} r \]
< / p >
2021-02-20 23:09:27 +01:00
< div class = "important" id = "orge7c73f9" >
2020-03-13 17:40:22 +01:00
< p >
\[ \epsilon = \frac{1}{ms^2 + mgs + k} F^\prime + \frac{1 + \frac{g}{s}}{ms^2 + mgs + k} F_d + \frac{k}{ms^2 + mgs + k} d_\mu + \frac{ms^2 + mgs + S_\mu k}{ms^2 + mgs + k} r \]
< / p >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org7528b09" class = "outline-4" >
< h4 id = "org7528b09" > < span class = "section-number-4" > 2.3.3< / span > Low pass filter< / h4 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-4" id = "text-2-3-3" >
2020-03-13 17:40:22 +01:00
< p >
Instead of a pure integrator, let’ s use a low pass filter with a cut-off frequency above the bandwidth of the micro-station \(\omega_mu\)
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > < span class = "org-comment" > % K_iff = (2*sqrt(k/m)/(2*wmu))*(1/(1 + s/(2*wmu)));< / span >
< span class = "org-comment" > % K_iff.InputName = {'Fm'};< / span >
< span class = "org-comment" > % K_iff.OutputName = {'F'};< / span >
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
< span class = "org-comment" > % Gpz_iff = feedback(Gpz, K_iff, 'name');< / span >
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org61c8fa0" class = "outline-3" >
< h3 id = "org61c8fa0" > < span class = "section-number-3" > 2.4< / span > Comparison< / h3 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-3" id = "text-2-4" >
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
< div id = "org113a984" class = "figure" >
2020-03-13 17:40:22 +01:00
< p > < img src = "figs/comp_iff_dvf_simplified.png" alt = "comp_iff_dvf_simplified.png" / >
< / p >
2020-03-17 11:23:47 +01:00
< p > < span class = "figure-number" > Figure 6: < / span > Obtained transfer functions for DVF and IFF (< a href = "./figs/comp_iff_dvf_simplified.png" > png< / a > , < a href = "./figs/comp_iff_dvf_simplified.pdf" > pdf< / a > )< / p >
2020-03-13 17:40:22 +01:00
< / div >
< table border = "2" cellspacing = "0" cellpadding = "6" rules = "groups" frame = "hsides" >
< colgroup >
< col class = "org-left" / >
< col class = "org-left" / >
< col class = "org-left" / >
< col class = "org-left" / >
< / colgroup >
< thead >
< tr >
< th scope = "col" class = "org-left" >   < / th >
< th scope = "col" class = "org-left" > \(d_\mu\)< / th >
< th scope = "col" class = "org-left" > \(F_d\)< / th >
< th scope = "col" class = "org-left" > \(w\)< / th >
< / tr >
< / thead >
< tbody >
< tr >
< td class = "org-left" > IFF< / td >
< td class = "org-left" > Better filtering of the vibrations< / td >
< td class = "org-left" > More sensitive to External forces< / td >
< td class = "org-left" >   < / td >
< / tr >
< tr >
< td class = "org-left" > DVF< / td >
2020-03-26 17:25:43 +01:00
< td class = "org-left" > Opposite< / td >
< td class = "org-left" > Opposite< / td >
2020-03-13 17:40:22 +01:00
< td class = "org-left" > Little bit better at low frequencies< / td >
< / tr >
< / tbody >
< / table >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org7d757e0" class = "outline-3" >
< h3 id = "org7d757e0" > < span class = "section-number-3" > 2.5< / span > Control using \(x\)< / h3 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-3" id = "text-2-5" >
2020-03-13 17:40:22 +01:00
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org616e1cc" class = "outline-4" >
< h4 id = "org616e1cc" > < span class = "section-number-4" > 2.5.1< / span > Analytical analysis< / h4 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-4" id = "text-2-5-1" >
2020-03-13 17:40:22 +01:00
< p >
2021-02-20 23:09:27 +01:00
Let’ s first consider that only the output \(x\) is used for feedback (Figure < a href = "#orgfac78e5" > 7< / a > )
2020-03-13 17:40:22 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "orgfac78e5" class = "figure" >
2020-03-13 17:40:22 +01:00
< p > < img src = "figs/nano_station_control_x.png" alt = "nano_station_control_x.png" / >
< / p >
2020-03-17 11:23:47 +01:00
< p > < span class = "figure-number" > Figure 7: < / span > Feedback diagram using \(x\)< / p >
2020-03-13 17:40:22 +01:00
< / div >
< p >
We then have:
\[ \epsilon & = r - G_{\frac{x}{F}} K \epsilon - G_{\frac{x}{F_d}} F_d - G_{\frac{x}{x_\mu}} d_\mu - G_{\frac{x}{x_\mu}} T_\mu r \]
< / p >
< p >
And then:
< / p >
2021-02-20 23:09:27 +01:00
< div class = "important" id = "org09a2d28" >
2020-03-13 17:40:22 +01:00
< p >
\[ \epsilon = \frac{-G_{\frac{x}{F_d}}}{1 + G_{\frac{x}{F}}K} F_d + \frac{-G_{\frac{x}{x_\mu}}}{1 + G_{\frac{x}{F}}K} d_\mu + \frac{1 - G_{\frac{x}{x_\mu}} T_\mu}{1 + G_{\frac{x}{F}}K} r \]
< / p >
< / div >
< p >
With \(S = \frac{1}{1 + G_{\frac{x}{F}} K}\), we have:
\[ \epsilon = - S G_{\frac{x}{F_d}} F_d - S G_{\frac{x}{x_\mu}} d_\mu + S (1 - G_{\frac{x}{x_\mu}} T_\mu) r \]
< / p >
< p >
We have 3 terms that we would like to have small by design:
< / p >
< ul class = "org-ul" >
< li > \(G_{\frac{x}{F_d}} = \frac{1}{ms^2 + k}\): thus \(k\) and \(m\) should be high to lower the effect of direct forces \(F_d\)< / li >
< li > \(G_{\frac{x}{x_\mu}} = \frac{k}{ms^2 + k} = \frac{1}{1 + \frac{s^2}{\omega_\nu^2}}\): \(\omega_\nu\) should be small enough such that it filters out the vibrations of the micro-station< / li >
< li > \(1 - G_{\frac{x}{x_\mu}} T_\mu\)< / li >
< / ul >
< p >
\[ 1 - G_{\frac{x}{x_\mu}} T_\mu = 1 - \frac{1}{1 + \frac{s^2}{\omega_\nu^2}} T_\mu \]
< / p >
< p >
We can approximate \(T_\mu \approx \frac{1}{1 + \frac{s}{\omega_\mu}}\) to have:
< / p >
\begin{align*}
1 - G_{\frac{x}{x_\mu}} T_\mu & = 1 - \frac{1}{1 + \frac{s^2}{\omega_\nu^2}} \frac{1}{1 + \frac{s}{\omega_\mu}} \\
& \approx \frac{\frac{s}{\omega_\mu}}{1 + \frac{s}{\omega_\mu}} = S_\mu \text{ if } \omega_\nu > \omega_\mu \\
& \approx \frac{\frac{s^2}{\omega_\nu^2}}{1 + \frac{s^2}{\omega_\nu^2}} = \text{ if } \omega_\nu < \omega_\mu
\end{align*}
< p >
In our case, we have \(\omega_\nu > \omega_\mu\) and thus we cannot lower this term.
< / p >
< p >
2021-02-20 23:09:27 +01:00
Some implications on the design are summarized on table < a href = "#orgcaed7d3" > 2< / a > .
2020-03-13 17:40:22 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< table id = "orgcaed7d3" border = "2" cellspacing = "0" cellpadding = "6" rules = "groups" frame = "hsides" >
2020-03-13 17:40:22 +01:00
< caption class = "t-above" > < span class = "table-number" > Table 2:< / span > Design recommendation< / caption >
< colgroup >
< col class = "org-left" / >
< col class = "org-left" / >
< / colgroup >
< thead >
< tr >
< th scope = "col" class = "org-left" > Exogenous Outputs< / th >
< th scope = "col" class = "org-left" > Design recommendation< / th >
< / tr >
< / thead >
< tbody >
< tr >
< td class = "org-left" > \(F_d\)< / td >
< td class = "org-left" > high \(k\), high \(m\)< / td >
< / tr >
< tr >
< td class = "org-left" > \(d_\mu\)< / td >
< td class = "org-left" > low \(k\), high \(m\)< / td >
< / tr >
< tr >
< td class = "org-left" > \(r\)< / td >
< td class = "org-left" > no influence if \(\omega_\nu > \omega_\mu\)< / td >
< / tr >
< / tbody >
< / table >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org03b4b61" class = "outline-4" >
< h4 id = "org03b4b61" > < span class = "section-number-4" > 2.5.2< / span > Control implementation< / h4 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-4" id = "text-2-5-2" >
2020-03-13 17:40:22 +01:00
< p >
Controller for the damped plant using DVF.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > wb = 2< span class = "org-type" > *< / span > < span class = "org-constant" > pi< / span > < span class = "org-type" > *< / span > 50; < span class = "org-comment" > % control bandwidth [rad/s]< / span >
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
< span class = "org-comment" > % Lead< / span >
h = 2.0;
wz = wb< span class = "org-type" > /< / span > h; < span class = "org-comment" > % [rad/s]< / span >
wp = wb< span class = "org-type" > *< / span > h; < span class = "org-comment" > % [rad/s]< / span >
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
H = 1< span class = "org-type" > /< / span > h< span class = "org-type" > *< / span > (1 < span class = "org-type" > +< / span > s< span class = "org-type" > /< / span > wz)< span class = "org-type" > /< / span > (1 < span class = "org-type" > +< / span > s< span class = "org-type" > /< / span > wp);
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
< span class = "org-comment" > % Integrator until 10Hz< / span >
Hi = (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 > 10)< 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 > 10);
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
K = Hi< span class = "org-type" > *< / span > H< span class = "org-type" > *< / span > (1< span class = "org-type" > /< / span > s);
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
Kpz_dvf = K< span class = "org-type" > /< / span > abs(freqresp(K< span class = "org-type" > *< / span > Gpz_dvf(< span class = "org-string" > 'y'< / span > , < span class = "org-string" > 'F'< / span > ), wb));
Kpz_dvf.InputName = {< span class = "org-string" > 'e'< / span > };
Kpz_dvf.OutputName = {< span class = "org-string" > 'Fi'< / span > };
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
< p >
Controller for the damped plant using IFF.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > wb = 2< span class = "org-type" > *< / span > < span class = "org-constant" > pi< / span > < span class = "org-type" > *< / span > 50; < span class = "org-comment" > % control bandwidth [rad/s]< / span >
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
< span class = "org-comment" > % Lead< / span >
h = 2.0;
wz = wb< span class = "org-type" > /< / span > h; < span class = "org-comment" > % [rad/s]< / span >
wp = wb< span class = "org-type" > *< / span > h; < span class = "org-comment" > % [rad/s]< / span >
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
H = 1< span class = "org-type" > /< / span > h< span class = "org-type" > *< / span > (1 < span class = "org-type" > +< / span > s< span class = "org-type" > /< / span > wz)< span class = "org-type" > /< / span > (1 < span class = "org-type" > +< / span > s< span class = "org-type" > /< / span > wp);
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
< span class = "org-comment" > % Integrator until 10Hz< / span >
Hi = (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 > 10)< 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 > 10);
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
K = Hi< span class = "org-type" > *< / span > H< span class = "org-type" > *< / span > (1< span class = "org-type" > /< / span > s);
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
Kpz_iff = K< span class = "org-type" > /< / span > abs(freqresp(K< span class = "org-type" > *< / span > Gpz_iff(< span class = "org-string" > 'y'< / span > , < span class = "org-string" > 'F'< / span > ), wb));
Kpz_iff.InputName = {< span class = "org-string" > 'e'< / span > };
Kpz_iff.OutputName = {< span class = "org-string" > 'Fi'< / span > };
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
< p >
Loop gain
< / p >
2021-02-20 23:09:27 +01:00
< div id = "orge426ac0" class = "figure" >
2020-03-13 17:40:22 +01:00
< p > < img src = "figs/simple_loop_gain_pz.png" alt = "simple_loop_gain_pz.png" / >
< / p >
2020-03-17 11:23:47 +01:00
< p > < span class = "figure-number" > Figure 8: < / span > Loop Gain (< a href = "./figs/simple_loop_gain_pz.png" > png< / a > , < a href = "./figs/simple_loop_gain_pz.pdf" > pdf< / a > )< / p >
2020-03-13 17:40:22 +01:00
< / div >
< p >
2021-02-20 23:09:27 +01:00
Let’ s connect all the systems as shown in Figure < a href = "#orgfac78e5" > 7< / a > .
2020-03-13 17:40:22 +01:00
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > Sfb = sumblk(< span class = "org-string" > 'e = r2 - y'< / span > );
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
R = [tf(1); tf(1)];
R.InputName = {< span class = "org-string" > 'r'< / span > };
R.OutputName = {< span class = "org-string" > 'r1'< / span > , < span class = "org-string" > 'r2'< / span > };
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
F = [tf(1); tf(1)];
F.InputName = {< span class = "org-string" > 'Fi'< / span > };
F.OutputName = {< span class = "org-string" > 'F'< / span > , < span class = "org-string" > 'Fu'< / span > };
2020-03-17 11:23:47 +01:00
2021-02-20 23:09:27 +01:00
Gpz_fb_dvf = connect(Gpz_dvf, Kpz_dvf, R, Sfb, F, {< span class = "org-string" > 'r'< / span > , < span class = "org-string" > 'dmu'< / span > , < span class = "org-string" > 'Fd'< / span > , < span class = "org-string" > 'w'< / span > }, {< span class = "org-string" > 'y'< / span > , < span class = "org-string" > 'e'< / span > , < span class = "org-string" > 'Fm'< / span > , < span class = "org-string" > 'd'< / span > , < span class = "org-string" > 'Fu'< / span > });
Gpz_fb_iff = connect(Gpz_iff, Kpz_iff, R, Sfb, F, {< span class = "org-string" > 'r'< / span > , < span class = "org-string" > 'dmu'< / span > , < span class = "org-string" > 'Fd'< / span > , < span class = "org-string" > 'w'< / span > }, {< span class = "org-string" > 'y'< / span > , < span class = "org-string" > 'e'< / span > , < span class = "org-string" > 'Fm'< / span > , < span class = "org-string" > 'd'< / span > , < span class = "org-string" > 'Fu'< / span > });
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orga972dfd" class = "outline-4" >
< h4 id = "orga972dfd" > < span class = "section-number-4" > 2.5.3< / span > Results< / h4 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-4" id = "text-2-5-3" >
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
< div id = "org5505a62" class = "figure" >
2020-03-13 17:40:22 +01:00
< p > < img src = "figs/simple_hac_lac_results.png" alt = "simple_hac_lac_results.png" / >
< / p >
2020-03-17 11:23:47 +01:00
< p > < span class = "figure-number" > Figure 9: < / span > Obtained closed-loop transfer functions (< a href = "./figs/simple_hac_lac_results.png" > png< / a > , < a href = "./figs/simple_hac_lac_results.pdf" > pdf< / a > )< / p >
2020-03-13 17:40:22 +01:00
< / div >
2020-03-17 11:23:47 +01:00
< table border = "2" cellspacing = "0" cellpadding = "6" rules = "groups" frame = "hsides" >
2020-03-13 17:40:22 +01:00
2020-03-17 11:23:47 +01:00
< colgroup >
< col class = "org-left" / >
2020-03-13 17:40:22 +01:00
2020-03-17 11:23:47 +01:00
< col class = "org-left" / >
2020-03-13 17:40:22 +01:00
2020-03-17 11:23:47 +01:00
< col class = "org-left" / >
2020-03-13 17:40:22 +01:00
2020-03-17 11:23:47 +01:00
< col class = "org-left" / >
< / colgroup >
< thead >
< tr >
< th scope = "col" class = "org-left" >   < / th >
< th scope = "col" class = "org-left" > Reference Tracking< / th >
< th scope = "col" class = "org-left" > Vibration Filtering< / th >
< th scope = "col" class = "org-left" > Compliance< / th >
< / tr >
< / thead >
< tbody >
< tr >
< td class = "org-left" > DVF< / td >
< td class = "org-left" > Similar behavior< / td >
< td class = "org-left" >   < / td >
< td class = "org-left" > Better for \(\omega < \omega_\nu\)< / td >
< / tr >
2020-03-13 17:40:22 +01:00
2020-03-17 11:23:47 +01:00
< tr >
< td class = "org-left" > IFF< / td >
< td class = "org-left" > Similar behavior< / td >
< td class = "org-left" > Better for \(\omega > \omega_\nu\)< / td >
< td class = "org-left" >   < / td >
< / tr >
< / tbody >
< / table >
< / div >
2020-03-13 17:40:22 +01:00
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org4c09e57" class = "outline-2" >
< h2 id = "org4c09e57" > < span class = "section-number-2" > 3< / span > Comparison with the use of a Soft nano-hexapod< / h2 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-2" id = "text-3" >
2020-03-13 17:40:22 +01:00
< 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 = 1e3; < span class = "org-comment" > % [N/m]< / span >
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
Gn = 1< span class = "org-type" > /< / span > (m< span class = "org-type" > *< / span > s< span class = "org-type" > ^< / span > 2 < span class = "org-type" > +< / span > k)< span class = "org-type" > *< / span > [< span class = "org-type" > -< / span > k, k< span class = "org-type" > *< / span > m< span class = "org-type" > *< / span > s< span class = "org-type" > ^< / span > 2, m< span class = "org-type" > *< / span > s< span class = "org-type" > ^< / span > 2; 1, < span class = "org-type" > -< / span > m< span class = "org-type" > *< / span > s< span class = "org-type" > ^< / span > 2, 1; 1, k, 1];
Gn.InputName = {< span class = "org-string" > 'Fd'< / span > , < span class = "org-string" > 'xmu'< / span > , < span class = "org-string" > 'F'< / span > };
Gn.OutputName = {< span class = "org-string" > 'Fm'< / span > , < span class = "org-string" > 'd'< / span > , < span class = "org-string" > 'x'< / span > };
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > wmu = 2< span class = "org-type" > *< / span > < span class = "org-constant" > pi< / span > < span class = "org-type" > *< / span > 50; < span class = "org-comment" > % [rad/s]< / span >
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
Tmu = 1< span class = "org-type" > /< / span > (1 < span class = "org-type" > +< / span > s< span class = "org-type" > /< / span > wmu);
Tmu.InputName = {< span class = "org-string" > 'r1'< / span > };
Tmu.OutputName = {< span class = "org-string" > 'ymu'< / span > };
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > w0 = 2< span class = "org-type" > *< / span > < span class = "org-constant" > pi< / span > < span class = "org-type" > *< / span > 40;
xi = 0.5;
Tw = 1< span class = "org-type" > /< / span > (1 < span class = "org-type" > +< / span > 2< span class = "org-type" > *< / span > xi< span class = "org-type" > *< / span > s< span class = "org-type" > /< / span > w0 < span class = "org-type" > +< / span > s< span class = "org-type" > ^< / span > 2< span class = "org-type" > /< / span > w0< span class = "org-type" > ^< / span > 2);
Tw.InputName = {< span class = "org-string" > 'w1'< / span > };
Tw.OutputName = {< span class = "org-string" > 'dw'< / span > };
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > Wsplit = [tf(1); tf(1)];
Wsplit.InputName = {< span class = "org-string" > 'w'< / span > };
Wsplit.OutputName = {< span class = "org-string" > 'w1'< / span > , < span class = "org-string" > 'w2'< / span > };
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
S = sumblk(< span class = "org-string" > 'xmu = ymu + dmu + dw'< / span > );
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
Sw = sumblk(< span class = "org-string" > 'y = x - w2'< / span > );
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
Gvc = connect(Gn, S, Wsplit, Tw, Tmu, Sw, {< span class = "org-string" > 'Fd'< / span > , < span class = "org-string" > 'dmu'< / span > , < span class = "org-string" > 'r1'< / span > , < span class = "org-string" > 'F'< / span > , < span class = "org-string" > 'w'< / span > }, {< span class = "org-string" > 'Fm'< / span > , < span class = "org-string" > 'd'< / span > , < span class = "org-string" > 'y'< / span > });
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > Kvc_dvf = 2< span class = "org-type" > *< / span > sqrt(k< span class = "org-type" > *< / span > m)< span class = "org-type" > *< / span > s;
Kvc_dvf.InputName = {< span class = "org-string" > 'd'< / span > };
Kvc_dvf.OutputName = {< span class = "org-string" > 'F'< / span > };
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
Gvc_dvf = feedback(Gvc, Kvc_dvf, < span class = "org-string" > 'name'< / span > );
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
Kvc_iff = 2< span class = "org-type" > *< / span > sqrt(k< span class = "org-type" > /< / span > m)< span class = "org-type" > /< / span > s;
Kvc_iff.InputName = {< span class = "org-string" > 'Fm'< / span > };
Kvc_iff.OutputName = {< span class = "org-string" > 'F'< / span > };
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
Gvc_iff = feedback(Gvc, Kvc_iff, < span class = "org-string" > 'name'< / span > );
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > wb = 2< span class = "org-type" > *< / span > < span class = "org-constant" > pi< / span > < span class = "org-type" > *< / span > 100; < span class = "org-comment" > % control bandwidth [rad/s]< / span >
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
< span class = "org-comment" > % Lead< / span >
h = 2.0;
wz = wb< span class = "org-type" > /< / span > h; < span class = "org-comment" > % [rad/s]< / span >
wp = wb< span class = "org-type" > *< / span > h; < span class = "org-comment" > % [rad/s]< / span >
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
H = 1< span class = "org-type" > /< / span > h< span class = "org-type" > *< / span > (1 < span class = "org-type" > +< / span > s< span class = "org-type" > /< / span > wz)< span class = "org-type" > /< / span > (1 < span class = "org-type" > +< / span > s< span class = "org-type" > /< / span > wp);
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
Kvc_dvf = H< span class = "org-type" > /< / span > abs(freqresp(H< span class = "org-type" > *< / span > Gvc_dvf(< span class = "org-string" > 'y'< / span > , < span class = "org-string" > 'F'< / span > ), wb));
Kvc_dvf.InputName = {< span class = "org-string" > 'e'< / span > };
Kvc_dvf.OutputName = {< span class = "org-string" > 'Fi'< / span > };
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
Kvc_iff = H< span class = "org-type" > /< / span > abs(freqresp(H< span class = "org-type" > *< / span > Gvc_iff(< span class = "org-string" > 'y'< / span > , < span class = "org-string" > 'F'< / span > ), wb));
Kvc_iff.InputName = {< span class = "org-string" > 'e'< / span > };
Kvc_iff.OutputName = {< span class = "org-string" > 'Fi'< / span > };
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > Sfb = sumblk(< span class = "org-string" > 'e = r2 - y'< / span > );
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
R = [tf(1); tf(1)];
R.InputName = {< span class = "org-string" > 'r'< / span > };
R.OutputName = {< span class = "org-string" > 'r1'< / span > , < span class = "org-string" > 'r2'< / span > };
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
F = [tf(1); tf(1)];
F.InputName = {< span class = "org-string" > 'Fi'< / span > };
F.OutputName = {< span class = "org-string" > 'F'< / span > , < span class = "org-string" > 'Fu'< / span > };
2020-03-17 11:23:47 +01:00
2021-02-20 23:09:27 +01:00
Gvc_fb_dvf = connect(Gvc_dvf, Kvc_dvf, R, Sfb, F, {< span class = "org-string" > 'r'< / span > , < span class = "org-string" > 'dmu'< / span > , < span class = "org-string" > 'Fd'< / span > , < span class = "org-string" > 'w'< / span > }, {< span class = "org-string" > 'y'< / span > , < span class = "org-string" > 'e'< / span > , < span class = "org-string" > 'Fm'< / span > , < span class = "org-string" > 'd'< / span > , < span class = "org-string" > 'Fu'< / span > });
Gvc_fb_iff = connect(Gvc_iff, Kvc_iff, R, Sfb, F, {< span class = "org-string" > 'r'< / span > , < span class = "org-string" > 'dmu'< / span > , < span class = "org-string" > 'Fd'< / span > , < span class = "org-string" > 'w'< / span > }, {< span class = "org-string" > 'y'< / span > , < span class = "org-string" > 'e'< / span > , < span class = "org-string" > 'Fm'< / span > , < span class = "org-string" > 'd'< / span > , < span class = "org-string" > 'Fu'< / span > });
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "org3e0c8bb" class = "figure" >
2020-03-13 17:40:22 +01:00
< p > < img src = "figs/simple_hac_lac_results_soft.png" alt = "simple_hac_lac_results_soft.png" / >
< / p >
2020-03-17 11:23:47 +01:00
< p > < span class = "figure-number" > Figure 10: < / span > Obtained closed-loop transfer functions (< a href = "./figs/simple_hac_lac_results_soft.png" > png< / a > , < a href = "./figs/simple_hac_lac_results_soft.pdf" > pdf< / a > )< / p >
2020-03-13 17:40:22 +01:00
< / div >
2020-03-17 11:23:47 +01:00
< table border = "2" cellspacing = "0" cellpadding = "6" rules = "groups" frame = "hsides" >
< colgroup >
< col class = "org-left" / >
< col class = "org-left" / >
< col class = "org-left" / >
< col class = "org-left" / >
< / colgroup >
< thead >
< tr >
< th scope = "col" class = "org-left" >   < / th >
< th scope = "col" class = "org-left" > Reference Tracking< / th >
< th scope = "col" class = "org-left" > Vibration Filtering< / th >
< th scope = "col" class = "org-left" > Compliance< / th >
< / tr >
< / thead >
< tbody >
< tr >
< td class = "org-left" > DVF< / td >
< td class = "org-left" > Similar behavior< / td >
< td class = "org-left" >   < / td >
< td class = "org-left" > Better for \(\omega < \omega_\nu\)< / td >
< / tr >
< tr >
< td class = "org-left" > IFF< / td >
< td class = "org-left" > Similar behavior< / td >
< td class = "org-left" > Better for \(\omega > \omega_\nu\)< / td >
< td class = "org-left" >   < / td >
< / tr >
< / tbody >
< / table >
2020-03-13 17:40:22 +01:00
2021-02-20 23:09:27 +01:00
< div id = "orgda0c8fc" class = "figure" >
2020-03-13 17:40:22 +01:00
< p > < img src = "figs/simple_comp_vc_pz.png" alt = "simple_comp_vc_pz.png" / >
< / p >
2020-03-17 11:23:47 +01:00
< p > < span class = "figure-number" > Figure 11: < / span > Comparison of the closed-loop transfer functions for Soft and Stiff nano-hexapod (< a href = "./figs/simple_comp_vc_pz.png" > png< / a > , < a href = "./figs/simple_comp_vc_pz.pdf" > pdf< / a > )< / p >
2020-03-13 17:40:22 +01:00
< / div >
< table border = "2" cellspacing = "0" cellpadding = "6" rules = "groups" frame = "hsides" >
< colgroup >
< col class = "org-left" / >
< col class = "org-center" / >
< col class = "org-center" / >
< / colgroup >
< thead >
< tr >
< th scope = "col" class = "org-left" >   < / th >
< th scope = "col" class = "org-center" > < b > Soft< / b > < / th >
< th scope = "col" class = "org-center" > < b > Stiff< / b > < / th >
< / tr >
< / thead >
< tbody >
< tr >
< td class = "org-left" > < b > Reference Tracking< / b > < / td >
< td class = "org-center" > =< / td >
< td class = "org-center" > =< / td >
< / tr >
2020-03-17 11:23:47 +01:00
< tr >
< td class = "org-left" > < b > Ground Motion< / b > < / td >
< td class = "org-center" > =< / td >
< td class = "org-center" > =< / td >
< / tr >
2020-03-13 17:40:22 +01:00
< tr >
< td class = "org-left" > < b > Vibration Isolation< / b > < / td >
< td class = "org-center" > +< / td >
< td class = "org-center" > -< / td >
< / tr >
< tr >
< td class = "org-left" > < b > Compliance< / b > < / td >
< td class = "org-center" > -< / td >
< td class = "org-center" > +< / td >
< / tr >
< / tbody >
< / table >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orgdb89cb5" class = "outline-2" >
< h2 id = "orgdb89cb5" > < span class = "section-number-2" > 4< / span > Estimate the level of vibration< / h2 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-2" id = "text-4" >
2020-03-13 17:40:22 +01:00
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > gm = load(< span class = "org-string" > './mat/psd_gm.mat'< / span > , < span class = "org-string" > 'f'< / span > , < span class = "org-string" > 'psd_gm'< / span > );
rz = load(< span class = "org-string" > './mat/pxsp_r.mat'< / span > , < span class = "org-string" > 'f'< / span > , < span class = "org-string" > 'pxsp_r'< / span > );
tyz = load(< span class = "org-string" > './mat/pxz_ty_r.mat'< / span > , < span class = "org-string" > 'f'< / span > , < span class = "org-string" > 'pxz_ty_r'< / span > );
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
2020-03-17 11:23:47 +01:00
< p >
If we note the PSD \(\Gamma\):
\[ \Gamma_y = |G_{\frac{y}{w}}|^2 \Gamma_w + |G_{\frac{y}{x_\mu}}|^2 \Gamma_{x_\mu} \]
< / p >
2020-03-13 17:40:22 +01:00
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > x_pz = abs(squeeze(freqresp(Gpz_fb_iff(< span class = "org-string" > 'y'< / span > , < span class = "org-string" > 'dmu'< / span > ), f, < span class = "org-string" > 'Hz'< / span > )))< span class = "org-type" > .^< / span > 2< span class = "org-type" > .*< / span > (psd_rz < span class = "org-type" > +< / span > psd_ty) < span class = "org-type" > +< / span > abs(squeeze(freqresp(Gpz_fb_iff(< span class = "org-string" > 'y'< / span > , < span class = "org-string" > 'w'< / span > ), f, < span class = "org-string" > 'Hz'< / span > )))< span class = "org-type" > .^< / span > 2< span class = "org-type" > .*< / span > (psd_gm);
x_vc = abs(squeeze(freqresp(Gvc_fb_iff(< span class = "org-string" > 'y'< / span > , < span class = "org-string" > 'dmu'< / span > ), f, < span class = "org-string" > 'Hz'< / span > )))< span class = "org-type" > .^< / span > 2< span class = "org-type" > .*< / span > (psd_rz < span class = "org-type" > +< / span > psd_ty) < span class = "org-type" > +< / span > abs(squeeze(freqresp(Gvc_fb_iff(< span class = "org-string" > 'y'< / span > , < span class = "org-string" > 'w'< / span > ), f, < span class = "org-string" > 'Hz'< / span > )))< span class = "org-type" > .^< / span > 2< span class = "org-type" > .*< / span > (psd_gm);
2020-03-13 17:40:22 +01:00
< / pre >
< / div >
2020-03-17 11:23:47 +01:00
2021-02-20 23:09:27 +01:00
< div id = "org816b875" class = "figure" >
2020-03-17 11:23:47 +01:00
< p > < img src = "figs/simple_asd_motion_error.png" alt = "simple_asd_motion_error.png" / >
< / p >
< p > < span class = "figure-number" > Figure 12: < / span > ASD of the position error due to Ground Motion and Vibration (< a href = "./figs/simple_asd_motion_error.png" > png< / a > , < a href = "./figs/simple_asd_motion_error.pdf" > pdf< / a > )< / p >
< / div >
< p >
Actuator usage
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > F_pz = abs(squeeze(freqresp(Gpz_fb_iff(< span class = "org-string" > 'Fu'< / span > , < span class = "org-string" > 'dmu'< / span > ), f, < span class = "org-string" > 'Hz'< / span > )))< span class = "org-type" > .^< / span > 2< span class = "org-type" > .*< / span > (psd_rz < span class = "org-type" > +< / span > psd_ty) < span class = "org-type" > +< / span > abs(squeeze(freqresp(Gpz_fb_iff(< span class = "org-string" > 'Fu'< / span > , < span class = "org-string" > 'w'< / span > ), f, < span class = "org-string" > 'Hz'< / span > )))< span class = "org-type" > .^< / span > 2< span class = "org-type" > .*< / span > (psd_gm);
F_vc = abs(squeeze(freqresp(Gvc_fb_iff(< span class = "org-string" > 'Fu'< / span > , < span class = "org-string" > 'dmu'< / span > ), f, < span class = "org-string" > 'Hz'< / span > )))< span class = "org-type" > .^< / span > 2< span class = "org-type" > .*< / span > (psd_rz < span class = "org-type" > +< / span > psd_ty) < span class = "org-type" > +< / span > abs(squeeze(freqresp(Gvc_fb_iff(< span class = "org-string" > 'Fu'< / span > , < span class = "org-string" > 'w'< / span > ), f, < span class = "org-string" > 'Hz'< / span > )))< span class = "org-type" > .^< / span > 2< span class = "org-type" > .*< / span > (psd_gm);
2020-03-17 11:23:47 +01:00
< / pre >
< / div >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > sqrt(trapz(f, F_pz))
sqrt(trapz(f, F_vc))
2020-03-17 11:23:47 +01:00
< / pre >
< / div >
< pre class = "example" >
sqrt(trapz(f, F_pz))
ans =
84.8961762069446
sqrt(trapz(f, F_vc))
ans =
0.0387785981815527
< / pre >
2020-03-13 17:40:22 +01:00
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orgf03c5a6" class = "outline-2" >
< h2 id = "orgf03c5a6" > < span class = "section-number-2" > 5< / span > Requirements on the norm of closed-loop transfer functions< / h2 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-2" id = "text-5" >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org607da90" class = "outline-3" >
< h3 id = "org607da90" > < span class = "section-number-3" > 5.1< / span > Approximation of the ASD of perturbations< / h3 >
2020-03-17 11:23:47 +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" > G_rz = 1e< span class = "org-type" > -< / span > 9< span class = "org-type" > *< / span > 1< 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 > 0.5)< span class = "org-type" > ^< / span > 2< 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 > 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 > 10)< span class = "org-type" > *< / span > (1< 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 > 100)< span class = "org-type" > ^< / span > 2));
2020-03-17 11:23:47 +01:00
< / pre >
< / div >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > G_gm = 1e< span class = "org-type" > -< / span > 8< span class = "org-type" > *< / span > 1< span class = "org-type" > /< / span > s< span class = "org-type" > ^< / span > 2< 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 > 1)< span class = "org-type" > ^< / span > 2< span class = "org-type" > *< / span > (1< 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 > 10)< span class = "org-type" > ^< / span > 3));
2020-03-17 11:23:47 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orge547462" class = "outline-3" >
< h3 id = "orge547462" > < span class = "section-number-3" > 5.2< / span > Wanted ASD of outputs< / h3 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-3" id = "text-5-2" >
< p >
Wanted ASD of motion error
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > y_wanted = 100e< span class = "org-type" > -< / span > 9; < span class = "org-comment" > % 10nm rms wanted< / span >
y_bw = 2< span class = "org-type" > *< / span > < span class = "org-constant" > pi< / span > < span class = "org-type" > *< / span > 100; < span class = "org-comment" > % bandwidth [rad/s]< / span >
2020-03-17 11:23:47 +01:00
2021-02-20 23:09:27 +01:00
G_y = 2< span class = "org-type" > *< / span > y_wanted< span class = "org-type" > /< / span > sqrt(y_bw) < span class = "org-type" > *< / span > (1 < span class = "org-type" > +< / span > s< span class = "org-type" > /< / span > y_bw< span class = "org-type" > /< / span > 10) < span class = "org-type" > /< / span > (1 < span class = "org-type" > +< / span > s< span class = "org-type" > /< / span > y_bw);
2020-03-17 11:23:47 +01:00
< / pre >
< / div >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > sqrt(trapz(f, abs(squeeze(freqresp(G_y, f, < span class = "org-string" > 'Hz'< / span > )))< span class = "org-type" > .^< / span > 2))
2020-03-17 11:23:47 +01:00
< / pre >
< / div >
< pre class = "example" >
sqrt(trapz(f, abs(squeeze(freqresp(G_y, f, 'Hz'))).^2))
ans =
9.47118350214793e-08
< / pre >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orga95353c" class = "outline-3" >
< h3 id = "orga95353c" > < span class = "section-number-3" > 5.3< / span > Limiting the bandwidth< / h3 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-3" id = "text-5-3" >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > wF = 2< span class = "org-type" > *< / span > < span class = "org-constant" > pi< / span > < span class = "org-type" > *< / span > 10;
G_F = 100000< span class = "org-type" > *< / span > (wF < span class = "org-type" > +< / span > s)< span class = "org-type" > ^< / span > 2;
2020-03-17 11:23:47 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orgb3d8660" class = "outline-3" >
< h3 id = "orgb3d8660" > < span class = "section-number-3" > 5.4< / span > Generalized Weighted plant< / h3 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-3" id = "text-5-4" >
< p >
Let’ s create a generalized weighted plant for controller synthesis.
< / p >
< p >
Let’ s start simple:
< / p >
< table border = "2" cellspacing = "0" cellpadding = "6" rules = "groups" frame = "hsides" >
< colgroup >
< col class = "org-left" / >
< col class = "org-left" / >
< col class = "org-left" / >
< / colgroup >
< thead >
< tr >
< th scope = "col" class = "org-left" >   < / th >
< th scope = "col" class = "org-left" > < b > Symbol< / b > < / th >
< th scope = "col" class = "org-left" > < b > Meaning< / b > < / th >
< / tr >
< / thead >
< tbody >
< tr >
< td class = "org-left" > < b > Exogenous Inputs< / b > < / td >
< td class = "org-left" > \(x_\mu\)< / td >
< td class = "org-left" > Motion of the $ν $-hexapod’ s base< / td >
< / tr >
< / tbody >
< tbody >
< tr >
< td class = "org-left" > < b > Exogenous Outputs< / b > < / td >
< td class = "org-left" > \(y\)< / td >
< td class = "org-left" > Motion error of the Payload< / td >
< / tr >
< / tbody >
< tbody >
< tr >
< td class = "org-left" > < b > Sensed Outputs< / b > < / td >
< td class = "org-left" > \(y\)< / td >
< td class = "org-left" > Motion error of the Payload< / td >
< / tr >
< / tbody >
< tbody >
< tr >
< td class = "org-left" > < b > Control Signals< / b > < / td >
< td class = "org-left" > \(F\)< / td >
< td class = "org-left" > Actuator Inputs< / td >
< / tr >
< / tbody >
< / table >
< p >
Add \(F\) as output.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > F = [tf(1); tf(1)];
F.InputName = {< span class = "org-string" > 'Fi'< / span > };
F.OutputName = {< span class = "org-string" > 'F'< / span > , < span class = "org-string" > 'Fu'< / span > };
2020-03-17 11:23:47 +01:00
2021-02-20 23:09:27 +01:00
P_pz = connect(F, Gpz_dvf, {< span class = "org-string" > 'dmu'< / span > , < span class = "org-string" > 'Fi'< / span > }, {< span class = "org-string" > 'y'< / span > , < span class = "org-string" > 'Fu'< / span > , < span class = "org-string" > 'y'< / span > })
P_vc = connect(F, Gvc_dvf, {< span class = "org-string" > 'dmu'< / span > , < span class = "org-string" > 'Fi'< / span > }, {< span class = "org-string" > 'y'< / span > , < span class = "org-string" > 'Fu'< / span > , < span class = "org-string" > 'y'< / span > })
2020-03-17 11:23:47 +01:00
< / pre >
< / div >
< p >
Normalization.
< / p >
< p >
We multiply the plant input by \(G_{rz}\) and the plant output by \(G_y^{-1}\):
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > P_pz_norm = blkdiag(inv(G_y), inv(G_F), 1)< span class = "org-type" > *< / span > P_pz< span class = "org-type" > *< / span > blkdiag(G_rz, 1);
P_pz_norm.OutputName = {< span class = "org-string" > 'z'< / span > , < span class = "org-string" > 'F'< / span > , < span class = "org-string" > 'y'< / span > };
P_pz_norm.InputName = {< span class = "org-string" > 'w'< / span > , < span class = "org-string" > 'u'< / span > };
2020-03-17 11:23:47 +01:00
2021-02-20 23:09:27 +01:00
P_vc_norm = blkdiag(inv(G_y), inv(G_F), 1)< span class = "org-type" > *< / span > P_vc< span class = "org-type" > *< / span > blkdiag(G_rz, 1);
P_vc_norm.OutputName = {< span class = "org-string" > 'z'< / span > , < span class = "org-string" > 'F'< / span > , < span class = "org-string" > 'y'< / span > };
P_vc_norm.InputName = {< span class = "org-string" > 'w'< / span > , < span class = "org-string" > 'u'< / span > };
2020-03-17 11:23:47 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org5cc7197" class = "outline-3" >
< h3 id = "org5cc7197" > < span class = "section-number-3" > 5.5< / span > Synthesis< / h3 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-3" id = "text-5-5" >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > [Kpz_dvf,CL_vc,< span class = "org-type" > ~< / span > ] = hinfsyn(minreal(P_pz_norm), 1, 1, < span class = "org-string" > 'TOLGAM'< / span > , 0.001, < span class = "org-string" > 'METHOD'< / span > , < span class = "org-string" > 'LMI'< / span > , < span class = "org-string" > 'DISPLAY'< / span > , < span class = "org-string" > 'on'< / span > );
Kpz_dvf.InputName = {< span class = "org-string" > 'e'< / span > };
Kpz_dvf.OutputName = {< span class = "org-string" > 'Fi'< / span > };
2020-03-17 11:23:47 +01:00
2021-02-20 23:09:27 +01:00
[Kvc_dvf,CL_pz,< span class = "org-type" > ~< / span > ] = hinfsyn(minreal(P_vc_norm), 1, 1, < span class = "org-string" > 'TOLGAM'< / span > , 0.001, < span class = "org-string" > 'METHOD'< / span > , < span class = "org-string" > 'LMI'< / span > , < span class = "org-string" > 'DISPLAY'< / span > , < span class = "org-string" > 'on'< / span > );
Kvc_dvf.InputName = {< span class = "org-string" > 'e'< / span > };
Kvc_dvf.OutputName = {< span class = "org-string" > 'Fi'< / span > };
2020-03-17 11:23:47 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org1747e58" class = "outline-3" >
< h3 id = "org1747e58" > < span class = "section-number-3" > 5.6< / span > Loop Gain< / h3 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-3" id = "text-5-6" >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > Sfb = sumblk(< span class = "org-string" > 'e = r2 - y'< / span > );
2020-03-17 11:23:47 +01:00
2021-02-20 23:09:27 +01:00
R = [tf(1); tf(1)];
R.InputName = {< span class = "org-string" > 'r'< / span > };
R.OutputName = {< span class = "org-string" > 'r1'< / span > , < span class = "org-string" > 'r2'< / span > };
2020-03-17 11:23:47 +01:00
2021-02-20 23:09:27 +01:00
F = [tf(1); tf(1)];
F.InputName = {< span class = "org-string" > 'Fi'< / span > };
F.OutputName = {< span class = "org-string" > 'F'< / span > , < span class = "org-string" > 'Fu'< / span > };
2020-03-17 11:23:47 +01:00
2021-02-20 23:09:27 +01:00
Gpz_fb_dvf = connect(Gpz_dvf, < span class = "org-type" > -< / span > Kpz_dvf, R, Sfb, F, {< span class = "org-string" > 'r'< / span > , < span class = "org-string" > 'dmu'< / span > , < span class = "org-string" > 'Fd'< / span > , < span class = "org-string" > 'w'< / span > }, {< span class = "org-string" > 'y'< / span > , < span class = "org-string" > 'e'< / span > , < span class = "org-string" > 'Fm'< / span > , < span class = "org-string" > 'd'< / span > , < span class = "org-string" > 'Fu'< / span > });
Gvc_fb_dvf = connect(Gvc_dvf, < span class = "org-type" > -< / span > Kvc_dvf, R, Sfb, F, {< span class = "org-string" > 'r'< / span > , < span class = "org-string" > 'dmu'< / span > , < span class = "org-string" > 'Fd'< / span > , < span class = "org-string" > 'w'< / span > }, {< span class = "org-string" > 'y'< / span > , < span class = "org-string" > 'e'< / span > , < span class = "org-string" > 'Fm'< / span > , < span class = "org-string" > 'd'< / span > , < span class = "org-string" > 'Fu'< / span > });
2020-03-17 11:23:47 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orgee72143" class = "outline-3" >
< h3 id = "orgee72143" > < span class = "section-number-3" > 5.7< / span > Results< / h3 >
2020-03-17 11:23:47 +01:00
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org50ebd42" class = "outline-3" >
< h3 id = "org50ebd42" > < span class = "section-number-3" > 5.8< / span > Requirements< / h3 >
2020-03-17 11:23:47 +01:00
< div class = "outline-text-3" id = "text-5-8" >
2020-03-13 17:40:22 +01:00
< table border = "2" cellspacing = "0" cellpadding = "6" rules = "groups" frame = "hsides" >
< colgroup >
< col class = "org-left" / >
< col class = "org-left" / >
< col class = "org-left" / >
< / colgroup >
< tbody >
< tr >
< td class = "org-left" > reference tracking< / td >
< td class = "org-left" > \(\epsilon/r\)< / td >
< td class = "org-left" > -120dB at 1Hz< / td >
< / tr >
< tr >
< td class = "org-left" > vibration isolation< / td >
< td class = "org-left" > \(x/x_\mu\)< / td >
< td class = "org-left" > -60dB above 10Hz< / td >
< / tr >
< tr >
< td class = "org-left" > compliance< / td >
< td class = "org-left" > \(x/F_d\)< / td >
< td class = "org-left" >   < / td >
< / tr >
< / tbody >
< / table >
< / div >
< / div >
< / div >
2020-03-17 11:23:47 +01:00
< / div >
2020-03-13 17:40:22 +01:00
< 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:09< / p >
2020-03-13 17:40:22 +01:00
< / div >
< / body >
< / html >
