2020-03-23 10:05:32 +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-03-23 10:05:32 +01:00
< meta http-equiv = "Content-Type" content = "text/html;charset=utf-8" / >
< title > Cascade Control applied on the Simscape 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-03-23 10:05:32 +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-23 10:05:32 +01:00
< / div > < div id = "content" >
< h1 class = "title" > Cascade Control applied on the Simscape 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 = "#org61c020f" > 1. Initialization< / a > < / li >
< li > < a href = "#orgabcff63" > 2. Low Authority Control - Integral Force Feedback \(\bm{K}_\text{IFF}\)< / a >
2020-03-23 10:05:32 +01:00
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org340d5c4" > 2.1. Identification< / a > < / li >
< li > < a href = "#orga3a6bfe" > 2.2. Plant< / a > < / li >
< li > < a href = "#org08443b2" > 2.3. Root Locus< / a > < / li >
< li > < a href = "#orgfcc764a" > 2.4. Controller and Loop Gain< / a > < / li >
2020-03-23 10:05:32 +01:00
< / ul >
< / li >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org5f8f119" > 3. High Authority Control in the joint space - \(\bm{K}_\mathcal{L}\)< / a >
2020-03-23 10:05:32 +01:00
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org4c8cb18" > 3.1. Identification of the damped plant< / a > < / li >
< li > < a href = "#org8ad1542" > 3.2. Obtained Plant< / a > < / li >
< li > < a href = "#orge39ae16" > 3.3. Controller Design and Loop Gain< / a > < / li >
2020-03-23 10:05:32 +01:00
< / ul >
< / li >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org11a22c2" > 4. Primary Controller in the task space - \(\bm{K}_\mathcal{X}\)< / a >
2020-03-23 10:05:32 +01:00
< ul >
2021-02-20 23:09:27 +01:00
< li > < a href = "#orgfc45f6f" > 4.1. Identification of the linearized plant< / a > < / li >
< li > < a href = "#org170c73f" > 4.2. Obtained Plant< / a > < / li >
< li > < a href = "#orge97b630" > 4.3. Controller Design< / a > < / li >
2020-03-23 10:05:32 +01:00
< / ul >
< / li >
2021-02-20 23:09:27 +01:00
< li > < a href = "#org07fbc52" > 5. Simulation< / a > < / li >
< li > < a href = "#org3e9cd70" > 6. Results< / a > < / li >
2020-03-23 10:05:32 +01:00
< / ul >
< / div >
< / div >
< p >
2021-02-20 23:09:27 +01:00
The control architecture we wish here to study is shown in Figure < a href = "#orga0c68cb" > 1< / a > .
2020-03-23 10:05:32 +01:00
< / p >
2021-02-20 23:09:27 +01:00
< div id = "orga0c68cb" class = "figure" >
2020-03-23 10:05:32 +01:00
< p > < img src = "figs/cascade_control_architecture.png" alt = "cascade_control_architecture.png" / >
< / p >
< p > < span class = "figure-number" > Figure 1: < / span > Cascaded Control consisting of (from inner to outer loop): IFF, Linearization Loop, Tracking Control in the frame of the Legs< / p >
< / div >
< p >
This cascade control is designed in three steps:
< / p >
< ul class = "org-ul" >
2021-02-20 23:09:27 +01:00
< li > In section < a href = "#orgbc2e2fd" > 2< / a > : an active damping controller is designed.
2020-03-23 10:05:32 +01:00
This is based on the Integral Force Feedback and applied in a decentralized way< / li >
2021-02-20 23:09:27 +01:00
< li > In section < a href = "#orgd16580b" > 3< / a > : a decentralized tracking control is designed in the frame of the legs.
2020-03-23 10:05:32 +01:00
This controller is based on the displacement of each of the legs< / li >
2021-02-20 23:09:27 +01:00
< li > In section < a href = "#org20bc645" > 4< / a > : a controller is designed in the task space in order to follow the wanted reference path corresponding to the sample position with respect to the granite< / li >
2020-03-23 10:05:32 +01:00
< / ul >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org61c020f" class = "outline-2" >
< h2 id = "org61c020f" > < span class = "section-number-2" > 1< / span > Initialization< / h2 >
2020-03-23 10:05:32 +01:00
< div class = "outline-text-2" id = "text-1" >
< p >
We initialize all the stages with the default parameters.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > initializeGround();
initializeGranite();
initializeTy();
initializeRy();
initializeRz();
initializeMicroHexapod();
initializeAxisc();
initializeMirror();
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
< p >
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" > initializeNanoHexapod(< span class = "org-string" > 'actuator'< / span > , < span class = "org-string" > 'piezo'< / span > );
initializeSample(< span class = "org-string" > 'mass'< / span > , 1);
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
< p >
We set the references that corresponds to a tomography experiment.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > initializeReferences(< span class = "org-string" > 'Rz_type'< / span > , < span class = "org-string" > 'rotating'< / span > , < span class = "org-string" > 'Rz_period'< / span > , 1);
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > initializeDisturbances();
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
< p >
Open Loop.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > initializeController(< span class = "org-string" > 'type'< / span > , < span class = "org-string" > 'cascade-hac-lac'< / span > );
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
< p >
And we put some gravity.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > initializeSimscapeConfiguration(< span class = "org-string" > 'gravity'< / span > , < span class = "org-constant" > true< / span > );
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
< p >
We log the signals.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > initializeLoggingConfiguration(< span class = "org-string" > 'log'< / span > , < span class = "org-string" > 'all'< / span > );
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > Kp = tf(zeros(6));
Kl = tf(zeros(6));
Kiff = tf(zeros(6));
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orgabcff63" class = "outline-2" >
< h2 id = "orgabcff63" > < span class = "section-number-2" > 2< / span > Low Authority Control - Integral Force Feedback \(\bm{K}_\text{IFF}\)< / h2 >
2020-03-23 10:05:32 +01:00
< div class = "outline-text-2" id = "text-2" >
< p >
2021-02-20 23:09:27 +01:00
< a id = "orgbc2e2fd" > < / a >
2020-03-23 10:05:32 +01:00
< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org340d5c4" class = "outline-3" >
< h3 id = "org340d5c4" > < span class = "section-number-3" > 2.1< / span > Identification< / h3 >
2020-03-23 10:05:32 +01:00
< div class = "outline-text-3" id = "text-2-1" >
< p >
Let’ s first identify the plant for the IFF controller.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > < span class = "org-matlab-cellbreak" > < span class = "org-comment" > %% Name of the Simulink File< / span > < / span >
mdl = < span class = "org-string" > 'nass_model'< / span > ;
< span class = "org-matlab-cellbreak" > < span class = "org-comment" > %% Input/Output definition< / span > < / span >
clear io; io_i = 1;
io(io_i) = linio([mdl, < span class = "org-string" > '/Controller'< / span > ], 1, < span class = "org-string" > 'openinput'< / span > ); io_i = io_i < span class = "org-type" > +< / span > 1; < span class = "org-comment" > % Actuator Inputs< / span >
io(io_i) = linio([mdl, < span class = "org-string" > '/Micro-Station'< / span > ], 3, < span class = "org-string" > 'openoutput'< / span > , [], < span class = "org-string" > 'Fnlm'< / span > ); io_i = io_i < span class = "org-type" > +< / span > 1; < span class = "org-comment" > % Force Sensors< / span >
< span class = "org-matlab-cellbreak" > < span class = "org-comment" > %% Run the linearization< / span > < / span >
G_iff = linearize(mdl, io, 0);
G_iff.InputName = {< span class = "org-string" > 'Fnl1'< / span > , < span class = "org-string" > 'Fnl2'< / span > , < span class = "org-string" > 'Fnl3'< / span > , < span class = "org-string" > 'Fnl4'< / span > , < span class = "org-string" > 'Fnl5'< / span > , < span class = "org-string" > 'Fnl6'< / span > };
G_iff.OutputName = {< span class = "org-string" > 'Fnlm1'< / span > , < span class = "org-string" > 'Fnlm2'< / span > , < span class = "org-string" > 'Fnlm3'< / span > , < span class = "org-string" > 'Fnlm4'< / span > , < span class = "org-string" > 'Fnlm5'< / span > , < span class = "org-string" > 'Fnlm6'< / span > };
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orga3a6bfe" class = "outline-3" >
< h3 id = "orga3a6bfe" > < span class = "section-number-3" > 2.2< / span > Plant< / h3 >
2020-03-23 10:05:32 +01:00
< div class = "outline-text-3" id = "text-2-2" >
2021-02-20 23:09:27 +01:00
< div id = "orgdfa60cc" class = "figure" >
2020-03-23 10:05:32 +01:00
< p > < img src = "figs/cascade_iff_plant.png" alt = "cascade_iff_plant.png" / >
< / p >
< p > < span class = "figure-number" > Figure 2: < / span > IFF Plant (< a href = "./figs/cascade_iff_plant.png" > png< / a > , < a href = "./figs/cascade_iff_plant.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org08443b2" class = "outline-3" >
< h3 id = "org08443b2" > < span class = "section-number-3" > 2.3< / span > Root Locus< / h3 >
2020-03-23 10:05:32 +01:00
< div class = "outline-text-3" id = "text-2-3" >
2021-02-20 23:09:27 +01:00
< div id = "org6320a7a" class = "figure" >
2020-03-23 10:05:32 +01:00
< p > < img src = "figs/cascade_iff_root_locus.png" alt = "cascade_iff_root_locus.png" / >
< / p >
< p > < span class = "figure-number" > Figure 3: < / span > Root Locus for the IFF control (< a href = "./figs/cascade_iff_root_locus.png" > png< / a > , < a href = "./figs/cascade_iff_root_locus.pdf" > pdf< / a > )< / p >
< / div >
< p >
The maximum damping is obtained for a control gain of \(\approx 3000\).
< / p >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orgfcc764a" class = "outline-3" >
< h3 id = "orgfcc764a" > < span class = "section-number-3" > 2.4< / span > Controller and Loop Gain< / h3 >
2020-03-23 10:05:32 +01:00
< div class = "outline-text-3" id = "text-2-4" >
< p >
We create the \(6 \times 6\) diagonal Integral Force Feedback controller.
2021-02-20 23:09:27 +01:00
The obtained loop gain is shown in Figure < a href = "#org59e605f" > 4< / a > .
2020-03-23 10:05:32 +01:00
< / p >
< 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 > 50;
Kiff = < span class = "org-type" > -< / span > 3000< span class = "org-type" > /< / span > s< span class = "org-type" > *< / span > eye(6);
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "org59e605f" class = "figure" >
2020-03-23 10:05:32 +01:00
< p > < img src = "figs/cascade_iff_loop_gain.png" alt = "cascade_iff_loop_gain.png" / >
< / p >
< p > < span class = "figure-number" > Figure 4: < / span > Obtained Loop gain the IFF Control (< a href = "./figs/cascade_iff_loop_gain.png" > png< / a > , < a href = "./figs/cascade_iff_loop_gain.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org5f8f119" class = "outline-2" >
< h2 id = "org5f8f119" > < span class = "section-number-2" > 3< / span > High Authority Control in the joint space - \(\bm{K}_\mathcal{L}\)< / h2 >
2020-03-23 10:05:32 +01:00
< div class = "outline-text-2" id = "text-3" >
< p >
2021-02-20 23:09:27 +01:00
< a id = "orgd16580b" > < / a >
2020-03-23 10:05:32 +01:00
< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org4c8cb18" class = "outline-3" >
< h3 id = "org4c8cb18" > < span class = "section-number-3" > 3.1< / span > Identification of the damped plant< / h3 >
2020-03-23 10:05:32 +01:00
< div class = "outline-text-3" id = "text-3-1" >
< p >
2021-02-20 23:09:27 +01:00
We now identify the transfer function from \(\tau^\prime\) to \(d\bm{\mathcal{L}}\) as shown in Figure < a href = "#orga0c68cb" > 1< / a > .
2020-03-23 10:05:32 +01:00
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > < span class = "org-matlab-cellbreak" > < span class = "org-comment" > %% Name of the Simulink File< / span > < / span >
mdl = < span class = "org-string" > 'nass_model'< / span > ;
< span class = "org-matlab-cellbreak" > < span class = "org-comment" > %% Input/Output definition< / span > < / span >
clear io; io_i = 1;
io(io_i) = linio([mdl, < span class = "org-string" > '/Controller'< / span > ], 1, < span class = "org-string" > 'input'< / span > ); io_i = io_i < span class = "org-type" > +< / span > 1; < span class = "org-comment" > % Actuator Inputs< / span >
io(io_i) = linio([mdl, < span class = "org-string" > '/Micro-Station'< / span > ], 3, < span class = "org-string" > 'output'< / span > , [], < span class = "org-string" > 'Dnlm'< / span > ); io_i = io_i < span class = "org-type" > +< / span > 1; < span class = "org-comment" > % Leg Displacement< / span >
< span class = "org-matlab-cellbreak" > < span class = "org-comment" > %% Run the linearization< / span > < / span >
Gl = linearize(mdl, io, 0);
Gl.InputName = {< span class = "org-string" > 'Fnl1'< / span > , < span class = "org-string" > 'Fnl2'< / span > , < span class = "org-string" > 'Fnl3'< / span > , < span class = "org-string" > 'Fnl4'< / span > , < span class = "org-string" > 'Fnl5'< / span > , < span class = "org-string" > 'Fnl6'< / span > };
Gl.OutputName = {< span class = "org-string" > 'Dnlm1'< / span > , < span class = "org-string" > 'Dnlm2'< / span > , < span class = "org-string" > 'Dnlm3'< / span > , < span class = "org-string" > 'Dnlm4'< / span > , < span class = "org-string" > 'Dnlm5'< / span > , < span class = "org-string" > 'Dnlm6'< / span > };
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
< p >
There are some unstable poles in the Plant with very small imaginary parts.
These unstable poles are probably not physical, and they disappear when taking the minimum realization of the plant.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > isstable(Gl)
Gl = minreal(Gl);
isstable(Gl)
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org8ad1542" class = "outline-3" >
< h3 id = "org8ad1542" > < span class = "section-number-3" > 3.2< / span > Obtained Plant< / h3 >
2020-03-23 10:05:32 +01:00
< div class = "outline-text-3" id = "text-3-2" >
< p >
2021-02-20 23:09:27 +01:00
The obtain plant is shown in Figure < a href = "#org5030d6d" > 5< / a > .
2020-03-23 10:05:32 +01:00
< / p >
< p >
We can see that the plant is quite well decoupled.
< / p >
2021-02-20 23:09:27 +01:00
< div id = "org5030d6d" class = "figure" >
2020-03-23 10:05:32 +01:00
< p > < img src = "figs/cascade_hac_joint_plant.png" alt = "cascade_hac_joint_plant.png" / >
< / p >
< p > < span class = "figure-number" > Figure 5: < / span > Plant for the High Authority Control in the Joint Space (< a href = "./figs/cascade_hac_joint_plant.png" > png< / a > , < a href = "./figs/cascade_hac_joint_plant.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orge39ae16" class = "outline-3" >
< h3 id = "orge39ae16" > < span class = "section-number-3" > 3.3< / span > Controller Design and Loop Gain< / h3 >
2020-03-23 10:05:32 +01:00
< div class = "outline-text-3" id = "text-3-3" >
< p >
The controller consists of:
< / p >
< ul class = "org-ul" >
< li > A pure integrator< / li >
< li > A Second integrator up to half the wanted bandwidth< / li >
< li > A Lead around the cross-over frequency< / li >
< li > A low pass filter with a cut-off equal to two times the wanted bandwidth< / li >
< / ul >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > wc = 2< span class = "org-type" > *< / span > < span class = "org-constant" > pi< / span > < span class = "org-type" > *< / span > 400; < span class = "org-comment" > % Bandwidth Bandwidth [rad/s]< / span >
2020-03-23 10:05:32 +01:00
2021-02-20 23:09:27 +01:00
h = 2; < span class = "org-comment" > % Lead parameter< / span >
2020-03-23 10:05:32 +01:00
2021-02-20 23:09:27 +01:00
< span class = "org-comment" > % Kl = (1/h) * (1 + s/wc*h)/(1 + s/wc/h) * wc/s * ((s/wc*2 + 1)/(s/wc*2)) * (1/(1 + s/wc/2));< / span >
Kl = (1< span class = "org-type" > /< / span > h) < span class = "org-type" > *< / span > (1 < span class = "org-type" > +< / span > s< span class = "org-type" > /< / span > wc< span class = "org-type" > *< / span > h)< span class = "org-type" > /< / span > (1 < span class = "org-type" > +< / span > s< span class = "org-type" > /< / span > wc< span class = "org-type" > /< / span > h) < span class = "org-type" > *< / span > (1< span class = "org-type" > /< / span > h) < span class = "org-type" > *< / span > (1 < span class = "org-type" > +< / span > s< span class = "org-type" > /< / span > wc< span class = "org-type" > *< / span > h)< span class = "org-type" > /< / span > (1 < span class = "org-type" > +< / span > s< span class = "org-type" > /< / span > wc< span class = "org-type" > /< / span > h) < span class = "org-type" > *< / span > wc< span class = "org-type" > /< / span > s;
2020-03-23 10:05:32 +01:00
2021-02-20 23:09:27 +01:00
< span class = "org-comment" > % Normalization of the gain of have a loop gain of 1 at frequency wc< / span >
Kl = Kl< span class = "org-type" > .*< / span > diag(1< span class = "org-type" > ./< / span > diag(abs(freqresp(Gl< span class = "org-type" > *< / span > Kl, wc))));
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "org3b106c4" class = "figure" >
2020-03-23 10:05:32 +01:00
< p > < img src = "figs/cascade_hac_joint_loop_gain.png" alt = "cascade_hac_joint_loop_gain.png" / >
< / p >
< p > < span class = "figure-number" > Figure 6: < / span > Loop Gain for the High Autority Control in the joint space (< a href = "./figs/cascade_hac_joint_loop_gain.png" > png< / a > , < a href = "./figs/cascade_hac_joint_loop_gain.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org11a22c2" class = "outline-2" >
< h2 id = "org11a22c2" > < span class = "section-number-2" > 4< / span > Primary Controller in the task space - \(\bm{K}_\mathcal{X}\)< / h2 >
2020-03-23 10:05:32 +01:00
< div class = "outline-text-2" id = "text-4" >
< p >
2021-02-20 23:09:27 +01:00
< a id = "org20bc645" > < / a >
2020-03-23 10:05:32 +01:00
< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orgfc45f6f" class = "outline-3" >
< h3 id = "orgfc45f6f" > < span class = "section-number-3" > 4.1< / span > Identification of the linearized plant< / h3 >
2020-03-23 10:05:32 +01:00
< div class = "outline-text-3" id = "text-4-1" >
< p >
We know identify the dynamics between \(\bm{r}_{\mathcal{X}_n}\) and \(\bm{r}_\mathcal{X}\).
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > < span class = "org-matlab-cellbreak" > < span class = "org-comment" > %% Name of the Simulink File< / span > < / span >
mdl = < span class = "org-string" > 'nass_model'< / span > ;
< span class = "org-matlab-cellbreak" > < span class = "org-comment" > %% Input/Output definition< / span > < / span >
clear io; io_i = 1;
io(io_i) = linio([mdl, < span class = "org-string" > '/Controller/Cascade-HAC-LAC/Kp'< / span > ], 1, < span class = "org-string" > 'input'< / span > ); io_i = io_i < span class = "org-type" > +< / span > 1;
io(io_i) = linio([mdl, < span class = "org-string" > '/Tracking Error'< / span > ], 1, < span class = "org-string" > 'output'< / span > , [], < span class = "org-string" > 'En'< / span > ); io_i = io_i < span class = "org-type" > +< / span > 1; < span class = "org-comment" > % Position Errror< / span >
< span class = "org-matlab-cellbreak" > < span class = "org-comment" > %% Run the linearization< / span > < / span >
Gx = linearize(mdl, io, 0);
Gx.InputName = {< span class = "org-string" > 'rL1'< / span > , < span class = "org-string" > 'rL2'< / span > , < span class = "org-string" > 'rL3'< / span > , < span class = "org-string" > 'rL4'< / span > , < span class = "org-string" > 'rL5'< / span > , < span class = "org-string" > 'rL6'< / span > };
Gx.OutputName = {< span class = "org-string" > 'Ex'< / span > , < span class = "org-string" > 'Ey'< / span > , < span class = "org-string" > 'Ez'< / span > , < span class = "org-string" > 'Erx'< / span > , < span class = "org-string" > 'Ery'< / span > , < span class = "org-string" > 'Erz'< / span > };
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
< p >
As before, we take the minimum realization.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > isstable(Gx)
Gx = minreal(Gx);
isstable(Gx)
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org170c73f" class = "outline-3" >
< h3 id = "org170c73f" > < span class = "section-number-3" > 4.2< / span > Obtained Plant< / h3 >
2020-03-23 10:05:32 +01:00
< div class = "outline-text-3" id = "text-4-2" >
2021-02-20 23:09:27 +01:00
< div id = "org9c2e85a" class = "figure" >
2020-03-23 10:05:32 +01:00
< p > < img src = "figs/cascade_primary_plant.png" alt = "cascade_primary_plant.png" / >
< / p >
< p > < span class = "figure-number" > Figure 7: < / span > Plant for the Primary Controller (< a href = "./figs/cascade_primary_plant.png" > png< / a > , < a href = "./figs/cascade_primary_plant.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-orge97b630" class = "outline-3" >
< h3 id = "orge97b630" > < span class = "section-number-3" > 4.3< / span > Controller Design< / h3 >
2020-03-23 10:05:32 +01:00
< div class = "outline-text-3" id = "text-4-3" >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > wc = 2< span class = "org-type" > *< / span > < span class = "org-constant" > pi< / span > < span class = "org-type" > *< / span > 10; < span class = "org-comment" > % Bandwidth Bandwidth [rad/s]< / span >
2020-03-23 10:05:32 +01:00
2021-02-20 23:09:27 +01:00
h = 2; < span class = "org-comment" > % Lead parameter< / span >
2020-03-23 10:05:32 +01:00
2021-02-20 23:09:27 +01:00
Kp = (1< span class = "org-type" > /< / span > h) < span class = "org-type" > *< / span > (1 < span class = "org-type" > +< / span > s< span class = "org-type" > /< / span > wc< span class = "org-type" > *< / span > h)< span class = "org-type" > /< / span > (1 < span class = "org-type" > +< / span > s< span class = "org-type" > /< / span > wc< span class = "org-type" > /< / span > h) < span class = "org-type" > *< / span > wc< span class = "org-type" > /< / span > s < 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 > 5)< span class = "org-type" > /< / span > s < 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 > 20);
2020-03-23 10:05:32 +01:00
2021-02-20 23:09:27 +01:00
< span class = "org-comment" > % Normalization of the gain of have a loop gain of 1 at frequency wc< / span >
Kp = Kp< span class = "org-type" > .*< / span > diag(1< span class = "org-type" > ./< / span > diag(abs(freqresp(Gx< span class = "org-type" > *< / span > Kp, wc))));
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "org37a2534" class = "figure" >
2020-03-23 10:05:32 +01:00
< p > < img src = "figs/cascade_primary_loop_gain.png" alt = "cascade_primary_loop_gain.png" / >
< / p >
< p > < span class = "figure-number" > Figure 8: < / span > Loop Gain for the primary controller (outer loop) (< a href = "./figs/cascade_primary_loop_gain.png" > png< / a > , < a href = "./figs/cascade_primary_loop_gain.pdf" > pdf< / a > )< / p >
< / div >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org07fbc52" class = "outline-2" >
< h2 id = "org07fbc52" > < span class = "section-number-2" > 5< / span > Simulation< / h2 >
2020-03-23 10:05:32 +01:00
< div class = "outline-text-2" id = "text-5" >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > load(< span class = "org-string" > 'mat/conf_simulink.mat'< / span > );
< span class = "org-matlab-simulink-keyword" > set_param< / span > (< span class = "org-variable-name" > conf_simulink< / span > , < span class = "org-string" > 'StopTime'< / span > , < span class = "org-string" > '2'< / span > );
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
< p >
And we simulate the system.
< / p >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > < span class = "org-matlab-simulink-keyword" > sim< / span > (< span class = "org-string" > 'nass_model'< / span > );
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > cascade_hac_lac = simout;
save(< span class = "org-string" > './mat/cascade_hac_lac.mat'< / span > , < span class = "org-string" > 'cascade_hac_lac'< / span > );
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
< / div >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "outline-container-org3e9cd70" class = "outline-2" >
< h2 id = "org3e9cd70" > < span class = "section-number-2" > 6< / span > Results< / h2 >
2020-03-23 10:05:32 +01:00
< div class = "outline-text-2" id = "text-6" >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > load(< span class = "org-string" > './mat/experiment_tomography.mat'< / span > , < span class = "org-string" > 'tomo_align_dist'< / span > );
load(< span class = "org-string" > './mat/cascade_hac_lac.mat'< / span > , < span class = "org-string" > 'cascade_hac_lac'< / span > );
2020-03-23 10:05:32 +01:00
< / pre >
< / div >
2020-03-25 19:23:22 +01:00
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > n_av = 4;
han_win = hanning(ceil(length(cascade_hac_lac.Em.En.Data(< span class = "org-type" > :< / span > ,1))< span class = "org-type" > /< / span > n_av));
2020-03-25 19:23:22 +01:00
< / pre >
< / div >
< div class = "org-src-container" >
2021-02-20 23:09:27 +01:00
< pre class = "src src-matlab" > t = cascade_hac_lac.Em.En.Time;
Ts = t(2)< span class = "org-type" > -< / span > t(1);
2020-03-25 19:23:22 +01:00
2021-02-20 23:09:27 +01:00
[pxx_ol, f] = pwelch(tomo_align_dist.Em.En.Data, han_win, [], [], 1< span class = "org-type" > /< / span > Ts);
[pxx_ca, < span class = "org-type" > ~< / span > ] = pwelch(cascade_hac_lac.Em.En.Data, han_win, [], [], 1< span class = "org-type" > /< / span > Ts);
2020-03-25 19:23:22 +01:00
< / pre >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "orgb068123" class = "figure" >
2020-03-25 19:23:22 +01:00
< p > < img src = "figs/cascade_hac_lac_tomography_psd.png" alt = "cascade_hac_lac_tomography_psd.png" / >
< / p >
< p > < span class = "figure-number" > Figure 9: < / span > ASD of the position error (< a href = "./figs/cascade_hac_lac_tomography_psd.png" > png< / a > , < a href = "./figs/cascade_hac_lac_tomography_psd.pdf" > pdf< / a > )< / p >
< / div >
2021-02-20 23:09:27 +01:00
< div id = "orgb10044c" class = "figure" >
2020-03-25 19:23:22 +01:00
< p > < img src = "figs/cascade_hac_lac_tomography_cas.png" alt = "cascade_hac_lac_tomography_cas.png" / >
< / p >
< p > < span class = "figure-number" > Figure 10: < / span > Cumulative Amplitude Spectrum of the position error (< a href = "./figs/cascade_hac_lac_tomography_cas.png" > png< / a > , < a href = "./figs/cascade_hac_lac_tomography_cas.pdf" > pdf< / a > )< / p >
< / div >
2020-03-23 10:05:32 +01:00
2021-02-20 23:09:27 +01:00
< div id = "orgd639abb" class = "figure" >
2020-03-23 10:05:32 +01:00
< p > < img src = "figs/cascade_hac_lac_tomography.png" alt = "cascade_hac_lac_tomography.png" / >
< / p >
2020-03-25 19:23:22 +01:00
< p > < span class = "figure-number" > Figure 11: < / span > Results of the Tomography Experiment (< a href = "./figs/cascade_hac_lac_tomography.png" > png< / a > , < a href = "./figs/cascade_hac_lac_tomography.pdf" > pdf< / a > )< / p >
2020-03-23 10:05:32 +01:00
< / div >
< / 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-03-23 10:05:32 +01:00
< / div >
< / body >
< / html >
