1586 lines
82 KiB
HTML
1586 lines
82 KiB
HTML
<?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>
|
|
<!-- 2019-06-04 mar. 10:16 -->
|
|
<meta http-equiv="Content-Type" content="text/html;charset=utf-8" />
|
|
<meta name="viewport" content="width=device-width, initial-scale=1" />
|
|
<title>Control in a rotating frame</title>
|
|
<meta name="generator" content="Org mode" />
|
|
<meta name="author" content="Dehaeze Thomas" />
|
|
<style type="text/css">
|
|
<!--/*--><![CDATA[/*><!--*/
|
|
.title { text-align: center;
|
|
margin-bottom: .2em; }
|
|
.subtitle { text-align: center;
|
|
font-size: medium;
|
|
font-weight: bold;
|
|
margin-top:0; }
|
|
.todo { font-family: monospace; color: red; }
|
|
.done { font-family: monospace; color: green; }
|
|
.priority { font-family: monospace; color: orange; }
|
|
.tag { background-color: #eee; font-family: monospace;
|
|
padding: 2px; font-size: 80%; font-weight: normal; }
|
|
.timestamp { color: #bebebe; }
|
|
.timestamp-kwd { color: #5f9ea0; }
|
|
.org-right { margin-left: auto; margin-right: 0px; text-align: right; }
|
|
.org-left { margin-left: 0px; margin-right: auto; text-align: left; }
|
|
.org-center { margin-left: auto; margin-right: auto; text-align: center; }
|
|
.underline { text-decoration: underline; }
|
|
#postamble p, #preamble p { font-size: 90%; margin: .2em; }
|
|
p.verse { margin-left: 3%; }
|
|
pre {
|
|
border: 1px solid #ccc;
|
|
box-shadow: 3px 3px 3px #eee;
|
|
padding: 8pt;
|
|
font-family: monospace;
|
|
overflow: auto;
|
|
margin: 1.2em;
|
|
}
|
|
pre.src {
|
|
position: relative;
|
|
overflow: visible;
|
|
padding-top: 1.2em;
|
|
}
|
|
pre.src:before {
|
|
display: none;
|
|
position: absolute;
|
|
background-color: white;
|
|
top: -10px;
|
|
right: 10px;
|
|
padding: 3px;
|
|
border: 1px solid black;
|
|
}
|
|
pre.src:hover:before { display: inline;}
|
|
/* Languages per Org manual */
|
|
pre.src-asymptote:before { content: 'Asymptote'; }
|
|
pre.src-awk:before { content: 'Awk'; }
|
|
pre.src-C:before { content: 'C'; }
|
|
/* pre.src-C++ doesn't work in CSS */
|
|
pre.src-clojure:before { content: 'Clojure'; }
|
|
pre.src-css:before { content: 'CSS'; }
|
|
pre.src-D:before { content: 'D'; }
|
|
pre.src-ditaa:before { content: 'ditaa'; }
|
|
pre.src-dot:before { content: 'Graphviz'; }
|
|
pre.src-calc:before { content: 'Emacs Calc'; }
|
|
pre.src-emacs-lisp:before { content: 'Emacs Lisp'; }
|
|
pre.src-fortran:before { content: 'Fortran'; }
|
|
pre.src-gnuplot:before { content: 'gnuplot'; }
|
|
pre.src-haskell:before { content: 'Haskell'; }
|
|
pre.src-hledger:before { content: 'hledger'; }
|
|
pre.src-java:before { content: 'Java'; }
|
|
pre.src-js:before { content: 'Javascript'; }
|
|
pre.src-latex:before { content: 'LaTeX'; }
|
|
pre.src-ledger:before { content: 'Ledger'; }
|
|
pre.src-lisp:before { content: 'Lisp'; }
|
|
pre.src-lilypond:before { content: 'Lilypond'; }
|
|
pre.src-lua:before { content: 'Lua'; }
|
|
pre.src-matlab:before { content: 'MATLAB'; }
|
|
pre.src-mscgen:before { content: 'Mscgen'; }
|
|
pre.src-ocaml:before { content: 'Objective Caml'; }
|
|
pre.src-octave:before { content: 'Octave'; }
|
|
pre.src-org:before { content: 'Org mode'; }
|
|
pre.src-oz:before { content: 'OZ'; }
|
|
pre.src-plantuml:before { content: 'Plantuml'; }
|
|
pre.src-processing:before { content: 'Processing.js'; }
|
|
pre.src-python:before { content: 'Python'; }
|
|
pre.src-R:before { content: 'R'; }
|
|
pre.src-ruby:before { content: 'Ruby'; }
|
|
pre.src-sass:before { content: 'Sass'; }
|
|
pre.src-scheme:before { content: 'Scheme'; }
|
|
pre.src-screen:before { content: 'Gnu Screen'; }
|
|
pre.src-sed:before { content: 'Sed'; }
|
|
pre.src-sh:before { content: 'shell'; }
|
|
pre.src-sql:before { content: 'SQL'; }
|
|
pre.src-sqlite:before { content: 'SQLite'; }
|
|
/* additional languages in org.el's org-babel-load-languages alist */
|
|
pre.src-forth:before { content: 'Forth'; }
|
|
pre.src-io:before { content: 'IO'; }
|
|
pre.src-J:before { content: 'J'; }
|
|
pre.src-makefile:before { content: 'Makefile'; }
|
|
pre.src-maxima:before { content: 'Maxima'; }
|
|
pre.src-perl:before { content: 'Perl'; }
|
|
pre.src-picolisp:before { content: 'Pico Lisp'; }
|
|
pre.src-scala:before { content: 'Scala'; }
|
|
pre.src-shell:before { content: 'Shell Script'; }
|
|
pre.src-ebnf2ps:before { content: 'ebfn2ps'; }
|
|
/* additional language identifiers per "defun org-babel-execute"
|
|
in ob-*.el */
|
|
pre.src-cpp:before { content: 'C++'; }
|
|
pre.src-abc:before { content: 'ABC'; }
|
|
pre.src-coq:before { content: 'Coq'; }
|
|
pre.src-groovy:before { content: 'Groovy'; }
|
|
/* additional language identifiers from org-babel-shell-names in
|
|
ob-shell.el: ob-shell is the only babel language using a lambda to put
|
|
the execution function name together. */
|
|
pre.src-bash:before { content: 'bash'; }
|
|
pre.src-csh:before { content: 'csh'; }
|
|
pre.src-ash:before { content: 'ash'; }
|
|
pre.src-dash:before { content: 'dash'; }
|
|
pre.src-ksh:before { content: 'ksh'; }
|
|
pre.src-mksh:before { content: 'mksh'; }
|
|
pre.src-posh:before { content: 'posh'; }
|
|
/* Additional Emacs modes also supported by the LaTeX listings package */
|
|
pre.src-ada:before { content: 'Ada'; }
|
|
pre.src-asm:before { content: 'Assembler'; }
|
|
pre.src-caml:before { content: 'Caml'; }
|
|
pre.src-delphi:before { content: 'Delphi'; }
|
|
pre.src-html:before { content: 'HTML'; }
|
|
pre.src-idl:before { content: 'IDL'; }
|
|
pre.src-mercury:before { content: 'Mercury'; }
|
|
pre.src-metapost:before { content: 'MetaPost'; }
|
|
pre.src-modula-2:before { content: 'Modula-2'; }
|
|
pre.src-pascal:before { content: 'Pascal'; }
|
|
pre.src-ps:before { content: 'PostScript'; }
|
|
pre.src-prolog:before { content: 'Prolog'; }
|
|
pre.src-simula:before { content: 'Simula'; }
|
|
pre.src-tcl:before { content: 'tcl'; }
|
|
pre.src-tex:before { content: 'TeX'; }
|
|
pre.src-plain-tex:before { content: 'Plain TeX'; }
|
|
pre.src-verilog:before { content: 'Verilog'; }
|
|
pre.src-vhdl:before { content: 'VHDL'; }
|
|
pre.src-xml:before { content: 'XML'; }
|
|
pre.src-nxml:before { content: 'XML'; }
|
|
/* add a generic configuration mode; LaTeX export needs an additional
|
|
(add-to-list 'org-latex-listings-langs '(conf " ")) in .emacs */
|
|
pre.src-conf:before { content: 'Configuration File'; }
|
|
|
|
table { border-collapse:collapse; }
|
|
caption.t-above { caption-side: top; }
|
|
caption.t-bottom { caption-side: bottom; }
|
|
td, th { vertical-align:top; }
|
|
th.org-right { text-align: center; }
|
|
th.org-left { text-align: center; }
|
|
th.org-center { text-align: center; }
|
|
td.org-right { text-align: right; }
|
|
td.org-left { text-align: left; }
|
|
td.org-center { text-align: center; }
|
|
dt { font-weight: bold; }
|
|
.footpara { display: inline; }
|
|
.footdef { margin-bottom: 1em; }
|
|
.figure { padding: 1em; }
|
|
.figure p { text-align: center; }
|
|
.equation-container {
|
|
display: table;
|
|
text-align: center;
|
|
width: 100%;
|
|
}
|
|
.equation {
|
|
vertical-align: middle;
|
|
}
|
|
.equation-label {
|
|
display: table-cell;
|
|
text-align: right;
|
|
vertical-align: middle;
|
|
}
|
|
.inlinetask {
|
|
padding: 10px;
|
|
border: 2px solid gray;
|
|
margin: 10px;
|
|
background: #ffffcc;
|
|
}
|
|
#org-div-home-and-up
|
|
{ text-align: right; font-size: 70%; white-space: nowrap; }
|
|
textarea { overflow-x: auto; }
|
|
.linenr { font-size: smaller }
|
|
.code-highlighted { background-color: #ffff00; }
|
|
.org-info-js_info-navigation { border-style: none; }
|
|
#org-info-js_console-label
|
|
{ font-size: 10px; font-weight: bold; white-space: nowrap; }
|
|
.org-info-js_search-highlight
|
|
{ background-color: #ffff00; color: #000000; font-weight: bold; }
|
|
.org-svg { width: 90%; }
|
|
/*]]>*/-->
|
|
</style>
|
|
<link rel="stylesheet" type="text/css" href="./css/htmlize.css"/>
|
|
<link rel="stylesheet" type="text/css" href="./css/readtheorg.css"/>
|
|
<script type="text/javascript" src="./js/jquery.min.js"></script>
|
|
<script type="text/javascript" src="./js/bootstrap.min.js"></script>
|
|
<script type="text/javascript" src="./js/jquery.stickytableheaders.min.js"></script>
|
|
<script type="text/javascript" src="./js/readtheorg.js"></script>
|
|
<script type="text/javascript">
|
|
/*
|
|
@licstart The following is the entire license notice for the
|
|
JavaScript code in this tag.
|
|
|
|
Copyright (C) 2012-2019 Free Software Foundation, Inc.
|
|
|
|
The JavaScript code in this tag is free software: you can
|
|
redistribute it and/or modify it under the terms of the GNU
|
|
General Public License (GNU GPL) as published by the Free Software
|
|
Foundation, either version 3 of the License, or (at your option)
|
|
any later version. The code is distributed WITHOUT ANY WARRANTY;
|
|
without even the implied warranty of MERCHANTABILITY or FITNESS
|
|
FOR A PARTICULAR PURPOSE. See the GNU GPL for more details.
|
|
|
|
As additional permission under GNU GPL version 3 section 7, you
|
|
may distribute non-source (e.g., minimized or compacted) forms of
|
|
that code without the copy of the GNU GPL normally required by
|
|
section 4, provided you include this license notice and a URL
|
|
through which recipients can access the Corresponding Source.
|
|
|
|
|
|
@licend The above is the entire license notice
|
|
for the JavaScript code in this tag.
|
|
*/
|
|
<!--/*--><![CDATA[/*><!--*/
|
|
function CodeHighlightOn(elem, id)
|
|
{
|
|
var target = document.getElementById(id);
|
|
if(null != target) {
|
|
elem.cacheClassElem = elem.className;
|
|
elem.cacheClassTarget = target.className;
|
|
target.className = "code-highlighted";
|
|
elem.className = "code-highlighted";
|
|
}
|
|
}
|
|
function CodeHighlightOff(elem, id)
|
|
{
|
|
var target = document.getElementById(id);
|
|
if(elem.cacheClassElem)
|
|
elem.className = elem.cacheClassElem;
|
|
if(elem.cacheClassTarget)
|
|
target.className = elem.cacheClassTarget;
|
|
}
|
|
/*]]>*///-->
|
|
</script>
|
|
<script type="text/x-mathjax-config">
|
|
MathJax.Hub.Config({
|
|
displayAlign: "center",
|
|
displayIndent: "0em",
|
|
|
|
"HTML-CSS": { scale: 100,
|
|
linebreaks: { automatic: "false" },
|
|
webFont: "TeX"
|
|
},
|
|
SVG: {scale: 100,
|
|
linebreaks: { automatic: "false" },
|
|
font: "TeX"},
|
|
NativeMML: {scale: 100},
|
|
TeX: { equationNumbers: {autoNumber: "AMS"},
|
|
MultLineWidth: "85%",
|
|
TagSide: "right",
|
|
TagIndent: ".8em"
|
|
}
|
|
});
|
|
</script>
|
|
<script type="text/javascript"
|
|
src="https://cdnjs.cloudflare.com/ajax/libs/mathjax/2.7.0/MathJax.js?config=TeX-AMS_HTML"></script>
|
|
</head>
|
|
<body>
|
|
<div id="content">
|
|
<h1 class="title">Control in a rotating frame</h1>
|
|
<div id="table-of-contents">
|
|
<h2>Table of Contents</h2>
|
|
<div id="text-table-of-contents">
|
|
<ul>
|
|
<li><a href="#org0ca35e5">1. System Description and Analysis</a>
|
|
<ul>
|
|
<li><a href="#orgbbf8020">1.1. System description</a></li>
|
|
<li><a href="#orgb2da7f2">1.2. Equations</a></li>
|
|
<li><a href="#org69a8ef3">1.3. Numerical Values for the NASS</a></li>
|
|
<li><a href="#org9c32c21">1.4. Euler and Coriolis forces - Numerical Result</a></li>
|
|
<li><a href="#org7c0235b">1.5. Negative Spring Effect - Numerical Result</a></li>
|
|
<li><a href="#orgfca3a34">1.6. Limitations due to coupling</a>
|
|
<ul>
|
|
<li><a href="#org8002743">1.6.1. Numerical Analysis</a></li>
|
|
</ul>
|
|
</li>
|
|
<li><a href="#org6b54e6c">1.7. Limitations due to negative stiffness effect</a></li>
|
|
<li><a href="#org826e5cb">1.8. Effect of rotation speed on the plant</a>
|
|
<ul>
|
|
<li><a href="#org280b535">1.8.1. Voice coil actuator</a></li>
|
|
<li><a href="#orgba58a6c">1.8.2. Piezoelectric actuator</a></li>
|
|
<li><a href="#orge104640">1.8.3. Analysis</a></li>
|
|
<li><a href="#orgf3ec82a">1.8.4. Campbell diagram</a></li>
|
|
</ul>
|
|
</li>
|
|
</ul>
|
|
</li>
|
|
<li><a href="#orgd3aebd3">2. Control Strategies</a>
|
|
<ul>
|
|
<li><a href="#org55c90a2">2.1. Measurement in the fixed reference frame</a></li>
|
|
<li><a href="#org76e17f2">2.2. Measurement in the rotating frame</a></li>
|
|
</ul>
|
|
</li>
|
|
<li><a href="#org379c58c">3. Multi Body Model - Simscape</a>
|
|
<ul>
|
|
<li><a href="#orgd629ab2">3.1. Initialization</a></li>
|
|
<li><a href="#org4495e34">3.2. Identification in the rotating referenced frame</a></li>
|
|
<li><a href="#org1fb0c24">3.3. Coupling ratio between \(f_{uv}\) and \(d_{uv}\)</a></li>
|
|
<li><a href="#org0344c6e">3.4. Plant Control - SISO approach</a>
|
|
<ul>
|
|
<li><a href="#orgbd17c9a">3.4.1. Plant identification</a></li>
|
|
<li><a href="#org34f917c">3.4.2. Effect of rotation speed</a></li>
|
|
<li><a href="#org4142099">3.4.3. Controller design</a></li>
|
|
<li><a href="#org64519ad">3.4.4. Controlling the rotating system</a></li>
|
|
<li><a href="#org6d2873c">3.4.5. Close loop performance</a></li>
|
|
<li><a href="#org88a2f7e">3.4.6. Conclusion</a></li>
|
|
</ul>
|
|
</li>
|
|
<li><a href="#orgb513744">3.5. <span class="todo BKMK">BKMK</span> Plant Control - MIMO approach</a>
|
|
<ul>
|
|
<li><a href="#org0527579">3.5.1. Analysis - SVD</a></li>
|
|
</ul>
|
|
</li>
|
|
</ul>
|
|
</li>
|
|
<li><a href="#org46ce269">4. Control Implementation</a></li>
|
|
</ul>
|
|
</div>
|
|
</div>
|
|
|
|
<p>
|
|
The objective of this note it to highlight some control problems that arises when controlling the position of an object using actuators that are rotating with respect to a fixed reference frame.
|
|
</p>
|
|
|
|
<p>
|
|
In section <a href="#orgf354109">1</a>, a simple system composed of a spindle and a translation stage is defined and the equations of motion are written.
|
|
The rotation induces some coupling between the actuators and their displacement, and modifies the dynamics of the system.
|
|
This is studied using the equations, and some numerical computations are used to compare the use of voice coil and piezoelectric actuators.
|
|
</p>
|
|
|
|
<p>
|
|
Then, in section <a href="#org9763554">2</a>, two different control approach are compared where:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>the measurement is made in the fixed frame</li>
|
|
<li>the measurement is made in the rotating frame</li>
|
|
</ul>
|
|
|
|
<p>
|
|
In section <a href="#org5f1b78c">3</a>, the analytical study will be validated using a multi body model of the studied system.
|
|
</p>
|
|
|
|
<p>
|
|
Finally, in section <a href="#orgd39f226">4</a>, the control strategies are implemented using Simulink and Simscape and compared.
|
|
</p>
|
|
|
|
<div id="outline-container-org0ca35e5" class="outline-2">
|
|
<h2 id="org0ca35e5"><span class="section-number-2">1</span> System Description and Analysis</h2>
|
|
<div class="outline-text-2" id="text-1">
|
|
<p>
|
|
<a id="orgf354109"></a>
|
|
</p>
|
|
</div>
|
|
<div id="outline-container-orgbbf8020" class="outline-3">
|
|
<h3 id="orgbbf8020"><span class="section-number-3">1.1</span> System description</h3>
|
|
<div class="outline-text-3" id="text-1-1">
|
|
<p>
|
|
The system consists of one 2 degree of freedom translation stage on top of a spindle (figure <a href="#orgf3c3049">1</a>).
|
|
</p>
|
|
|
|
<p>
|
|
The control inputs are the forces applied by the actuators of the translation stage (\(F_u\) and \(F_v\)).
|
|
As the translation stage is rotating around the Z axis due to the spindle, the forces are applied along \(u\) and \(v\).
|
|
</p>
|
|
|
|
<p>
|
|
The measurement is either the \(x-y\) displacement of the object located on top of the translation stage or the \(u-v\) displacement of the sample with respect to a fixed reference frame.
|
|
</p>
|
|
|
|
|
|
<div id="orgf3c3049" class="figure">
|
|
<p><img src="./figs/rotating_frame_2dof.png" alt="rotating_frame_2dof.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 1: </span>Schematic of the mecanical system</p>
|
|
</div>
|
|
|
|
<p>
|
|
In the following block diagram:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>\(G\) is the transfer function from the forces applied in the actuators to the measurement</li>
|
|
<li>\(K\) is the controller to design</li>
|
|
<li>\(J\) is a Jacobian matrix usually used to change the reference frame</li>
|
|
</ul>
|
|
|
|
<p>
|
|
Indices \(x\) and \(y\) corresponds to signals in the fixed reference frame (along \(\vec{i}_x\) and \(\vec{i}_y\)):
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>\(D_x\) is the measured position of the sample</li>
|
|
<li>\(r_x\) is the reference signal which corresponds to the wanted \(D_x\)</li>
|
|
<li>\(\epsilon_x\) is the position error</li>
|
|
</ul>
|
|
|
|
<p>
|
|
Indices \(u\) and \(v\) corresponds to signals in the rotating reference frame (\(\vec{i}_u\) and \(\vec{i}_v\)):
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>\(F_u\) and \(F_v\) are forces applied by the actuators</li>
|
|
<li>\(\epsilon_u\) and \(\epsilon_v\) are position error of the sample along \(\vec{i}_u\) and \(\vec{i}_v\)</li>
|
|
</ul>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgb2da7f2" class="outline-3">
|
|
<h3 id="orgb2da7f2"><span class="section-number-3">1.2</span> Equations</h3>
|
|
<div class="outline-text-3" id="text-1-2">
|
|
<p>
|
|
<a id="orga275e9b"></a>
|
|
Based on the figure <a href="#orgf3c3049">1</a>, we can write the equations of motion of the system.
|
|
</p>
|
|
|
|
<p>
|
|
Let's express the kinetic energy \(T\) and the potential energy \(V\) of the mass \(m\):
|
|
</p>
|
|
\begin{align}
|
|
\label{orgea74efb}
|
|
T & = \frac{1}{2} m \left( \dot{x}^2 + \dot{y}^2 \right) \\
|
|
V & = \frac{1}{2} k \left( x^2 + y^2 \right)
|
|
\end{align}
|
|
|
|
<p>
|
|
The Lagrangian is the kinetic energy minus the potential energy.
|
|
</p>
|
|
\begin{equation}
|
|
\label{org31791c4}
|
|
L = T-V = \frac{1}{2} m \left( \dot{x}^2 + \dot{y}^2 \right) - \frac{1}{2} k \left( x^2 + y^2 \right)
|
|
\end{equation}
|
|
|
|
|
|
<p>
|
|
The partial derivatives of the Lagrangian with respect to the variables \((x, y)\) are:
|
|
</p>
|
|
\begin{align*}
|
|
\label{org8251906}
|
|
\frac{\partial L}{\partial x} & = -kx \\
|
|
\frac{\partial L}{\partial y} & = -ky \\
|
|
\frac{d}{dt}\frac{\partial L}{\partial \dot{x}} & = m\ddot{x} \\
|
|
\frac{d}{dt}\frac{\partial L}{\partial \dot{y}} & = m\ddot{y}
|
|
\end{align*}
|
|
|
|
<p>
|
|
The external forces applied to the mass are:
|
|
</p>
|
|
\begin{align*}
|
|
F_{\text{ext}, x} &= F_u \cos{\theta} - F_v \sin{\theta}\\
|
|
F_{\text{ext}, y} &= F_u \sin{\theta} + F_v \cos{\theta}
|
|
\end{align*}
|
|
|
|
<p>
|
|
By appling the Lagrangian equations, we obtain:
|
|
</p>
|
|
\begin{align}
|
|
m\ddot{x} + kx = F_u \cos{\theta} - F_v \sin{\theta}\\
|
|
m\ddot{y} + ky = F_u \sin{\theta} + F_v \cos{\theta}
|
|
\end{align}
|
|
|
|
<p>
|
|
We then change coordinates from \((x, y)\) to \((d_x, d_y, \theta)\).
|
|
</p>
|
|
\begin{align*}
|
|
x & = d_u \cos{\theta} - d_v \sin{\theta}\\
|
|
y & = d_u \sin{\theta} + d_v \cos{\theta}
|
|
\end{align*}
|
|
|
|
<p>
|
|
We obtain:
|
|
</p>
|
|
\begin{align*}
|
|
\ddot{x} & = \ddot{d_u} \cos{\theta} - 2\dot{d_u}\dot{\theta}\sin{\theta} - d_u\ddot{\theta}\sin{\theta} - d_u\dot{\theta}^2 \cos{\theta}
|
|
- \ddot{d_v} \sin{\theta} - 2\dot{d_v}\dot{\theta}\cos{\theta} - d_v\ddot{\theta}\cos{\theta} + d_v\dot{\theta}^2 \sin{\theta} \\
|
|
\ddot{y} & = \ddot{d_u} \sin{\theta} + 2\dot{d_u}\dot{\theta}\cos{\theta} + d_u\ddot{\theta}\cos{\theta} - d_u\dot{\theta}^2 \sin{\theta}
|
|
+ \ddot{d_v} \cos{\theta} - 2\dot{d_v}\dot{\theta}\sin{\theta} - d_v\ddot{\theta}\sin{\theta} - d_v\dot{\theta}^2 \cos{\theta} \\
|
|
\end{align*}
|
|
|
|
<p>
|
|
By injecting the previous result into the Lagrangian equation, we obtain:
|
|
</p>
|
|
\begin{align*}
|
|
m \ddot{d_u} \cos{\theta} - 2m\dot{d_u}\dot{\theta}\sin{\theta} - m d_u\ddot{\theta}\sin{\theta} - m d_u\dot{\theta}^2 \cos{\theta}
|
|
-m \ddot{d_v} \sin{\theta} - 2m\dot{d_v}\dot{\theta}\cos{\theta} - m d_v\ddot{\theta}\cos{\theta} + m d_v\dot{\theta}^2 \sin{\theta}
|
|
+ k d_u \cos{\theta} - k d_v \sin{\theta} = F_u \cos{\theta} - F_v \sin{\theta} \\
|
|
m \ddot{d_u} \sin{\theta} + 2m\dot{d_u}\dot{\theta}\cos{\theta} + m d_u\ddot{\theta}\cos{\theta} - m d_u\dot{\theta}^2 \sin{\theta}
|
|
+ m \ddot{d_v} \cos{\theta} - 2m\dot{d_v}\dot{\theta}\sin{\theta} - m d_v\ddot{\theta}\sin{\theta} - m d_v\dot{\theta}^2 \cos{\theta}
|
|
+ k d_u \sin{\theta} + k d_v \cos{\theta} = F_u \sin{\theta} + F_v \cos{\theta}
|
|
\end{align*}
|
|
|
|
<p>
|
|
Which is equivalent to:
|
|
</p>
|
|
\begin{align*}
|
|
m \ddot{d_u} - 2m\dot{d_u}\dot{\theta}\frac{\sin{\theta}}{\cos{\theta}} - m d_u\ddot{\theta}\frac{\sin{\theta}}{\cos{\theta}} - m d_u\dot{\theta}^2
|
|
-m \ddot{d_v} \frac{\sin{\theta}}{\cos{\theta}} - 2m\dot{d_v}\dot{\theta} - m d_v\ddot{\theta} + m d_v\dot{\theta}^2 \frac{\sin{\theta}}{\cos{\theta}}
|
|
+ k d_u - k d_v \frac{\sin{\theta}}{\cos{\theta}} = F_u - F_v \frac{\sin{\theta}}{\cos{\theta}} \\
|
|
m \ddot{d_u} + 2m\dot{d_u}\dot{\theta}\frac{\cos{\theta}}{\sin{\theta}} + m d_u\ddot{\theta}\frac{\cos{\theta}}{\sin{\theta}} - m d_u\dot{\theta}^2
|
|
+ m \ddot{d_v} \frac{\cos{\theta}}{\sin{\theta}} - 2m\dot{d_v}\dot{\theta} - m d_v\ddot{\theta} - m d_v\dot{\theta}^2 \frac{\cos{\theta}}{\sin{\theta}}
|
|
+ k d_u + k d_v \frac{\cos{\theta}}{\sin{\theta}} = F_u + F_v \frac{\cos{\theta}}{\sin{\theta}}
|
|
\end{align*}
|
|
|
|
<p>
|
|
We can then subtract and add the previous equations to obtain the following equations:
|
|
</p>
|
|
<div class="important">
|
|
\begin{equation}
|
|
\label{org953c633}
|
|
m \ddot{d_u} + (k - m\dot{\theta}^2) d_u = F_u + 2 m\dot{d_v}\dot{\theta} + m d_v\ddot{\theta}
|
|
\end{equation}
|
|
\begin{equation}
|
|
\label{org84282f4}
|
|
m \ddot{d_v} + (k - m\dot{\theta}^2) d_v = F_v - 2 m\dot{d_u}\dot{\theta} - m d_u\ddot{\theta}
|
|
\end{equation}
|
|
|
|
</div>
|
|
|
|
<p>
|
|
We obtain two differential equations that are coupled through:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li><b>Euler forces</b>: \(m d_v \ddot{\theta}\)</li>
|
|
<li><b>Coriolis forces</b>: \(2 m \dot{d_v} \dot{\theta}\)</li>
|
|
</ul>
|
|
|
|
<p>
|
|
Without the coupling terms, each equation is the equation of a one degree of freedom mass-spring system with mass \(m\) and stiffness \(k- m\dot{\theta}^2\).
|
|
Thus, the term \(- m\dot{\theta}^2\) acts like a negative stiffness (due to <b>centrifugal forces</b>).
|
|
</p>
|
|
|
|
<p>
|
|
The forces induced by the rotating reference frame are independent of the stiffness of the actuator.
|
|
The resulting effect of those forces should then be higher when using softer actuators.
|
|
</p>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org69a8ef3" class="outline-3">
|
|
<h3 id="org69a8ef3"><span class="section-number-3">1.3</span> Numerical Values for the NASS</h3>
|
|
<div class="outline-text-3" id="text-1-3">
|
|
<p>
|
|
Let's define the parameters for the NASS.
|
|
</p>
|
|
<table border="2" cellspacing="0" cellpadding="6" rules="groups" frame="hsides">
|
|
|
|
|
|
<colgroup>
|
|
<col class="org-left" />
|
|
|
|
<col class="org-right" />
|
|
</colgroup>
|
|
<tbody>
|
|
<tr>
|
|
<td class="org-left">Light sample mass [kg]</td>
|
|
<td class="org-right">3.5e+01</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">Heavy sample mass [kg]</td>
|
|
<td class="org-right">8.5e+01</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">Max rot. speed - light [rpm]</td>
|
|
<td class="org-right">6.0e+01</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">Max rot. speed - heavy [rpm]</td>
|
|
<td class="org-right">1.0e+00</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">Voice Coil Stiffness [N/m]</td>
|
|
<td class="org-right">1.0e+03</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">Piezo Stiffness [N/m]</td>
|
|
<td class="org-right">1.0e+08</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">Max rot. acceleration [rad/s2]</td>
|
|
<td class="org-right">1.0e+00</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">Max mass excentricity [m]</td>
|
|
<td class="org-right">1.0e-02</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">Max Horizontal speed [m/s]</td>
|
|
<td class="org-right">2.0e-01</td>
|
|
</tr>
|
|
</tbody>
|
|
</table>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org9c32c21" class="outline-3">
|
|
<h3 id="org9c32c21"><span class="section-number-3">1.4</span> Euler and Coriolis forces - Numerical Result</h3>
|
|
<div class="outline-text-3" id="text-1-4">
|
|
<p>
|
|
First we will determine the value for Euler and Coriolis forces during regular experiment.
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li><b>Euler forces</b>: \(m d_v \ddot{\theta}\)</li>
|
|
<li><b>Coriolis forces</b>: \(2 m \dot{d_v} \dot{\theta}\)</li>
|
|
</ul>
|
|
|
|
<p>
|
|
The obtained values are displayed in table <a href="#org5c49fb5">1</a>.
|
|
</p>
|
|
|
|
<table id="org5c49fb5" border="2" cellspacing="0" cellpadding="6" rules="groups" frame="hsides">
|
|
<caption class="t-above"><span class="table-number">Table 1:</span> Euler and Coriolis forces for the NASS</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">Light</th>
|
|
<th scope="col" class="org-left">Heavy</th>
|
|
</tr>
|
|
</thead>
|
|
<tbody>
|
|
<tr>
|
|
<td class="org-left">Coriolis</td>
|
|
<td class="org-left">88.0N</td>
|
|
<td class="org-left">3.6N</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">Euler</td>
|
|
<td class="org-left">0.4N</td>
|
|
<td class="org-left">0.8N</td>
|
|
</tr>
|
|
</tbody>
|
|
</table>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org7c0235b" class="outline-3">
|
|
<h3 id="org7c0235b"><span class="section-number-3">1.5</span> Negative Spring Effect - Numerical Result</h3>
|
|
<div class="outline-text-3" id="text-1-5">
|
|
<p>
|
|
The negative stiffness due to the rotation is equal to \(-m{\omega_0}^2\).
|
|
</p>
|
|
|
|
<p>
|
|
The values for the negative spring effect are displayed in table <a href="#orgf52e52c">2</a>.
|
|
</p>
|
|
|
|
<p>
|
|
This is definitely negligible when using piezoelectric actuators. It may not be the case when using voice coil actuators.
|
|
</p>
|
|
|
|
<table id="orgf52e52c" border="2" cellspacing="0" cellpadding="6" rules="groups" frame="hsides">
|
|
<caption class="t-above"><span class="table-number">Table 2:</span> Negative Spring effect</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">Light</th>
|
|
<th scope="col" class="org-left">Heavy</th>
|
|
</tr>
|
|
</thead>
|
|
<tbody>
|
|
<tr>
|
|
<td class="org-left">Neg. Spring</td>
|
|
<td class="org-left">1381.7[N/m]</td>
|
|
<td class="org-left">0.9[N/m]</td>
|
|
</tr>
|
|
</tbody>
|
|
</table>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgfca3a34" class="outline-3">
|
|
<h3 id="orgfca3a34"><span class="section-number-3">1.6</span> Limitations due to coupling</h3>
|
|
<div class="outline-text-3" id="text-1-6">
|
|
<p>
|
|
To simplify, we consider a constant rotating speed \(\dot{\theta} = \omega_0\) and thus \(\ddot{\theta} = 0\).
|
|
</p>
|
|
|
|
<p>
|
|
From equations \eqref{org953c633} and \eqref{org84282f4}, we obtain:
|
|
</p>
|
|
\begin{align*}
|
|
(m s^2 + (k - m{\omega_0}^2)) d_u &= F_u + 2 m {\omega_0} s d_v \\
|
|
(m s^2 + (k - m{\omega_0}^2)) d_v &= F_v - 2 m {\omega_0} s d_u \\
|
|
\end{align*}
|
|
|
|
<p>
|
|
From second equation:
|
|
\[ d_v = \frac{1}{m s^2 + (k - m{\omega_0}^2)} F_v - \frac{2 m {\omega_0} s}{m s^2 + (k - m{\omega_0}^2)} d_u \]
|
|
</p>
|
|
|
|
<p>
|
|
And we re-inject \(d_v\) into the first equation:
|
|
</p>
|
|
\begin{equation*}
|
|
(m s^2 + (k - m{\omega_0}^2)) d_u = F_u + \frac{2 m {\omega_0} s}{m s^2 + (k - m{\omega_0}^2)} F_v - \frac{(2 m {\omega_0} s)^2}{m s^2 + (k - m{\omega_0}^2)} d_u
|
|
\end{equation*}
|
|
|
|
\begin{equation*}
|
|
\frac{(m s^2 + (k - m{\omega_0}^2))^2 + (2 m {\omega_0} s)^2}{m s^2 + (k - m{\omega_0}^2)} d_u = F_u + \frac{2 m {\omega_0} s}{m s^2 + (k - m{\omega_0}^2)} F_v
|
|
\end{equation*}
|
|
|
|
<p>
|
|
Finally we obtain \(d_u\) function of \(F_u\) and \(F_v\).
|
|
\[ d_u = \frac{m s^2 + (k - m{\omega_0}^2)}{(m s^2 + (k - m{\omega_0}^2))^2 + (2 m {\omega_0} s)^2} F_u + \frac{2 m {\omega_0} s}{(m s^2 + (k - m{\omega_0}^2))^2 + (2 m {\omega_0} s)^2} F_v \]
|
|
</p>
|
|
|
|
<p>
|
|
Similarly we can obtain \(d_v\) function of \(F_u\) and \(F_v\):
|
|
\[ d_v = \frac{m s^2 + (k - m{\omega_0}^2)}{(m s^2 + (k - m{\omega_0}^2))^2 + (2 m {\omega_0} s)^2} F_v - \frac{2 m {\omega_0} s}{(m s^2 + (k - m{\omega_0}^2))^2 + (2 m {\omega_0} s)^2} F_u \]
|
|
</p>
|
|
|
|
<p>
|
|
The two previous equations can be written in a matrix form:
|
|
</p>
|
|
<div class="important">
|
|
\begin{equation}
|
|
\label{orgb104ecd}
|
|
\begin{bmatrix} d_u \\ d_v \end{bmatrix} =
|
|
\frac{1}{(m s^2 + (k - m{\omega_0}^2))^2 + (2 m {\omega_0} s)^2}
|
|
\begin{bmatrix}
|
|
ms^2 + (k-m{\omega_0}^2) & 2 m \omega_0 s \\
|
|
-2 m \omega_0 s & ms^2 + (k-m{\omega_0}^2) \\
|
|
\end{bmatrix}
|
|
\begin{bmatrix} F_u \\ F_v \end{bmatrix}
|
|
\end{equation}
|
|
|
|
</div>
|
|
|
|
<p>
|
|
Then, coupling is negligible if \(|-m \omega^2 + (k - m{\omega_0}^2)| \gg |2 m {\omega_0} \omega|\).
|
|
</p>
|
|
</div>
|
|
|
|
<div id="outline-container-org8002743" class="outline-4">
|
|
<h4 id="org8002743"><span class="section-number-4">1.6.1</span> Numerical Analysis</h4>
|
|
<div class="outline-text-4" id="text-1-6-1">
|
|
<p>
|
|
We plot on the same graph \(\frac{|-m \omega^2 + (k - m {\omega_0}^2)|}{|2 m \omega_0 \omega|}\) for the voice coil and the piezo:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>with the light sample (figure <a href="#org882b7da">2</a>).</li>
|
|
<li>with the heavy sample (figure <a href="#org618a5fd">3</a>).</li>
|
|
</ul>
|
|
|
|
|
|
<div id="org882b7da" class="figure">
|
|
<p><img src="./figs/coupling_light.png" alt="coupling_light.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 2: </span>Relative Coupling for light mass and high rotation speed</p>
|
|
</div>
|
|
|
|
|
|
<div id="org618a5fd" class="figure">
|
|
<p><img src="figs/coupling_heavy.png" alt="coupling_heavy.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 3: </span>Relative Coupling for heavy mass and low rotation speed</p>
|
|
</div>
|
|
|
|
<div class="important">
|
|
<p>
|
|
Coupling is higher for actuators with small stiffness.
|
|
</p>
|
|
|
|
</div>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org6b54e6c" class="outline-3">
|
|
<h3 id="org6b54e6c"><span class="section-number-3">1.7</span> Limitations due to negative stiffness effect</h3>
|
|
<div class="outline-text-3" id="text-1-7">
|
|
<p>
|
|
If \(\max{\dot{\theta}} \ll \sqrt{\frac{k}{m}}\), then the negative spring effect is negligible and \(k - m\dot{\theta}^2 \approx k\).
|
|
</p>
|
|
|
|
<p>
|
|
Let's estimate what is the maximum rotation speed for which the negative stiffness effect is still negligible (\(\omega_\text{max} = 0.1 \sqrt{\frac{k}{m}}\)). Results are shown table <a href="#orgf000322">3</a>.
|
|
</p>
|
|
<table id="orgf000322" border="2" cellspacing="0" cellpadding="6" rules="groups" frame="hsides">
|
|
<caption class="t-above"><span class="table-number">Table 3:</span> Maximum rotation speed at which negative stiffness is negligible (\(0.1\sqrt{\frac{k}{m}}\))</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">Voice Coil</th>
|
|
<th scope="col" class="org-left">Piezo</th>
|
|
</tr>
|
|
</thead>
|
|
<tbody>
|
|
<tr>
|
|
<td class="org-left">Light</td>
|
|
<td class="org-left">5[rpm]</td>
|
|
<td class="org-left">1614[rpm]</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">Heavy</td>
|
|
<td class="org-left">3[rpm]</td>
|
|
<td class="org-left">1036[rpm]</td>
|
|
</tr>
|
|
</tbody>
|
|
</table>
|
|
|
|
<p>
|
|
The negative spring effect is proportional to the rotational speed \(\omega\).
|
|
The system dynamics will be much more affected when using soft actuator.
|
|
</p>
|
|
|
|
<div class="important">
|
|
<p>
|
|
Negative stiffness effect has very important effect when using soft actuators.
|
|
</p>
|
|
|
|
</div>
|
|
|
|
<p>
|
|
The system can even goes unstable when \(m \omega^2 > k\), that is when the centrifugal forces are higher than the forces due to stiffness.
|
|
</p>
|
|
|
|
<p>
|
|
From this analysis, we can determine the lowest practical stiffness that is possible to use: \(k_\text{min} = 10 m \omega^2\) (table sec:tab:min<sub>k</sub>)
|
|
</p>
|
|
|
|
<table id="org40ac74a" border="2" cellspacing="0" cellpadding="6" rules="groups" frame="hsides">
|
|
<caption class="t-above"><span class="table-number">Table 4:</span> Minimum possible stiffness</caption>
|
|
|
|
<colgroup>
|
|
<col class="org-left" />
|
|
|
|
<col class="org-right" />
|
|
|
|
<col class="org-right" />
|
|
</colgroup>
|
|
<thead>
|
|
<tr>
|
|
<th scope="col" class="org-left"> </th>
|
|
<th scope="col" class="org-right">Light</th>
|
|
<th scope="col" class="org-right">Heavy</th>
|
|
</tr>
|
|
</thead>
|
|
<tbody>
|
|
<tr>
|
|
<td class="org-left">k min [N/m]</td>
|
|
<td class="org-right">2199</td>
|
|
<td class="org-right">89</td>
|
|
</tr>
|
|
</tbody>
|
|
</table>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org826e5cb" class="outline-3">
|
|
<h3 id="org826e5cb"><span class="section-number-3">1.8</span> Effect of rotation speed on the plant</h3>
|
|
<div class="outline-text-3" id="text-1-8">
|
|
<p>
|
|
As shown in equation \eqref{orgb104ecd}, the plant changes with the rotation speed \(\omega_0\).
|
|
</p>
|
|
|
|
<p>
|
|
Then, we compute the bode plot of the direct term and coupling term for multiple rotating speed.
|
|
</p>
|
|
|
|
<p>
|
|
Then we compare the result between voice coil and piezoelectric actuators.
|
|
</p>
|
|
</div>
|
|
|
|
<div id="outline-container-org280b535" class="outline-4">
|
|
<h4 id="org280b535"><span class="section-number-4">1.8.1</span> Voice coil actuator</h4>
|
|
<div class="outline-text-4" id="text-1-8-1">
|
|
|
|
<div id="org467005d" class="figure">
|
|
<p><img src="figs/G_ws_vc.png" alt="G_ws_vc.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 4: </span>Bode plot of the direct transfer function term (from \(F_u\) to \(D_u\)) for multiple rotation speed - Voice coil</p>
|
|
</div>
|
|
|
|
|
|
|
|
<div id="orgf49b6c0" class="figure">
|
|
<p><img src="figs/Gc_ws_vc.png" alt="Gc_ws_vc.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 5: </span>caption</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgba58a6c" class="outline-4">
|
|
<h4 id="orgba58a6c"><span class="section-number-4">1.8.2</span> Piezoelectric actuator</h4>
|
|
<div class="outline-text-4" id="text-1-8-2">
|
|
|
|
<div id="orgc897ced" class="figure">
|
|
<p><img src="figs/G_ws_pz.png" alt="G_ws_pz.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 6: </span>Bode plot of the direct transfer function term (from \(F_u\) to \(D_u\)) for multiple rotation speed - Piezoelectric actuator</p>
|
|
</div>
|
|
|
|
|
|
<div id="orgca0fa14" class="figure">
|
|
<p><img src="figs/Gc_ws_pz.png" alt="Gc_ws_pz.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 7: </span>Bode plot of the coupling transfer function term (from \(F_u\) to \(D_v\)) for multiple rotation speed - Piezoelectric actuator</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orge104640" class="outline-4">
|
|
<h4 id="orge104640"><span class="section-number-4">1.8.3</span> Analysis</h4>
|
|
<div class="outline-text-4" id="text-1-8-3">
|
|
<p>
|
|
When the rotation speed is null, the coupling terms are equal to zero and the diagonal terms corresponds to one degree of freedom mass spring system.
|
|
</p>
|
|
|
|
<p>
|
|
When the rotation speed in not null, the resonance frequency is duplicated into two pairs of complex conjugate poles.
|
|
</p>
|
|
|
|
<p>
|
|
As the rotation speed increases, one of the two resonant frequency goes to lower frequencies as the other one goes to higher frequencies.
|
|
</p>
|
|
|
|
<p>
|
|
The poles of the coupling terms are the same as the poles of the diagonal terms. The magnitude of the coupling terms are increasing with the rotation speed.
|
|
</p>
|
|
|
|
<div class="important">
|
|
<p>
|
|
As shown in the previous figures, the system with voice coil is much more sensitive to rotation speed.
|
|
</p>
|
|
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgf3ec82a" class="outline-4">
|
|
<h4 id="orgf3ec82a"><span class="section-number-4">1.8.4</span> Campbell diagram</h4>
|
|
<div class="outline-text-4" id="text-1-8-4">
|
|
<p>
|
|
The poles of the system are computed for multiple values of the rotation frequency. To simplify the computation of the poles, we add some damping to the system.
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">m = mlight;
|
|
k = kvc;
|
|
c = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">1</span><span class="org-type">*</span>sqrt<span class="org-rainbow-delimiters-depth-1">(</span>k<span class="org-type">*</span>m<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
wsvc = linspace<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-highlight-numbers-number">0</span>, <span class="org-highlight-numbers-number">10</span>, <span class="org-highlight-numbers-number">100</span><span class="org-rainbow-delimiters-depth-1">)</span>; <span class="org-comment">% [rad/s]</span>
|
|
|
|
polesvc = zeros<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-highlight-numbers-number">2</span>, length<span class="org-rainbow-delimiters-depth-2">(</span>wsvc<span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
<span class="org-keyword">for</span> <span class="org-variable-name">i</span> = <span class="org-constant"><span class="org-highlight-numbers-number">1</span></span><span class="org-constant">:length</span><span class="org-constant"><span class="org-rainbow-delimiters-depth-1">(</span></span><span class="org-constant">wsvc</span><span class="org-constant"><span class="org-rainbow-delimiters-depth-1">)</span></span>
|
|
polei = pole<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span>m<span class="org-type">*</span>s<span class="org-type">^</span><span class="org-highlight-numbers-number">2</span> <span class="org-type">+</span> c<span class="org-type">*</span>s <span class="org-type">+</span> <span class="org-rainbow-delimiters-depth-4">(</span>k <span class="org-type">-</span> m<span class="org-type">*</span>wsvc<span class="org-rainbow-delimiters-depth-5">(</span><span class="org-constant">i</span><span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">2</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">2</span> <span class="org-type">+</span> <span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">*</span>m<span class="org-type">*</span>wsvc<span class="org-rainbow-delimiters-depth-4">(</span><span class="org-constant">i</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-type">*</span>s<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">2</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
polesvc<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-type">:</span>, <span class="org-constant">i</span><span class="org-rainbow-delimiters-depth-1">)</span> = sort<span class="org-rainbow-delimiters-depth-1">(</span>polei<span class="org-rainbow-delimiters-depth-2">(</span>imag<span class="org-rainbow-delimiters-depth-3">(</span>polei<span class="org-rainbow-delimiters-depth-3">)</span> <span class="org-type">></span> <span class="org-highlight-numbers-number">0</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
<span class="org-keyword">end</span>
|
|
</pre>
|
|
</div>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">m = mlight;
|
|
k = kpz;
|
|
c = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">1</span><span class="org-type">*</span>sqrt<span class="org-rainbow-delimiters-depth-1">(</span>k<span class="org-type">*</span>m<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
wspz = linspace<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-highlight-numbers-number">0</span>, <span class="org-highlight-numbers-number">1000</span>, <span class="org-highlight-numbers-number">100</span><span class="org-rainbow-delimiters-depth-1">)</span>; <span class="org-comment">% [rad/s]</span>
|
|
|
|
polespz = zeros<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-highlight-numbers-number">2</span>, length<span class="org-rainbow-delimiters-depth-2">(</span>wspz<span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
<span class="org-keyword">for</span> <span class="org-variable-name">i</span> = <span class="org-constant"><span class="org-highlight-numbers-number">1</span></span><span class="org-constant">:length</span><span class="org-constant"><span class="org-rainbow-delimiters-depth-1">(</span></span><span class="org-constant">wspz</span><span class="org-constant"><span class="org-rainbow-delimiters-depth-1">)</span></span>
|
|
polei = pole<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span>m<span class="org-type">*</span>s<span class="org-type">^</span><span class="org-highlight-numbers-number">2</span> <span class="org-type">+</span> c<span class="org-type">*</span>s <span class="org-type">+</span> <span class="org-rainbow-delimiters-depth-4">(</span>k <span class="org-type">-</span> m<span class="org-type">*</span>wspz<span class="org-rainbow-delimiters-depth-5">(</span><span class="org-constant">i</span><span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">2</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">2</span> <span class="org-type">+</span> <span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">*</span>m<span class="org-type">*</span>wspz<span class="org-rainbow-delimiters-depth-4">(</span><span class="org-constant">i</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-type">*</span>s<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">2</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
polespz<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-type">:</span>, <span class="org-constant">i</span><span class="org-rainbow-delimiters-depth-1">)</span> = sort<span class="org-rainbow-delimiters-depth-1">(</span>polei<span class="org-rainbow-delimiters-depth-2">(</span>imag<span class="org-rainbow-delimiters-depth-3">(</span>polei<span class="org-rainbow-delimiters-depth-3">)</span> <span class="org-type">></span> <span class="org-highlight-numbers-number">0</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
<span class="org-keyword">end</span>
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
We then plot the real and imaginary part of the poles as a function of the rotation frequency (figures <a href="#org66ee050">8</a> and <a href="#orgacbac62">9</a>).
|
|
</p>
|
|
|
|
<p>
|
|
When the real part of one pole becomes positive, the system goes unstable.
|
|
</p>
|
|
|
|
<p>
|
|
For the voice coil (figure <a href="#org66ee050">8</a>), the system is unstable when the rotation speed is above 5 rad/s. The real and imaginary part of the poles of the system with piezoelectric actuators are changing much less (figure <a href="#orgacbac62">9</a>).
|
|
</p>
|
|
|
|
|
|
<div id="org66ee050" class="figure">
|
|
<p><img src="figs/poles_w_vc.png" alt="poles_w_vc.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 8: </span>Real and Imaginary part of the poles of the system as a function of the rotation speed - Voice Coil and light sample</p>
|
|
</div>
|
|
|
|
|
|
|
|
<div id="orgacbac62" class="figure">
|
|
<p><img src="figs/poles_w_pz.png" alt="poles_w_pz.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 9: </span>Real and Imaginary part of the poles of the system as a function of the rotation speed - Piezoelectric actuator and light sample</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgd3aebd3" class="outline-2">
|
|
<h2 id="orgd3aebd3"><span class="section-number-2">2</span> Control Strategies</h2>
|
|
<div class="outline-text-2" id="text-2">
|
|
<p>
|
|
<a id="org9763554"></a>
|
|
</p>
|
|
</div>
|
|
<div id="outline-container-org55c90a2" class="outline-3">
|
|
<h3 id="org55c90a2"><span class="section-number-3">2.1</span> Measurement in the fixed reference frame</h3>
|
|
<div class="outline-text-3" id="text-2-1">
|
|
<p>
|
|
First, let's consider a measurement in the fixed referenced frame.
|
|
</p>
|
|
|
|
<p>
|
|
The transfer function from actuator \([F_u, F_v]\) to sensor \([D_x, D_y]\) is then \(G(\theta)\).
|
|
</p>
|
|
|
|
<p>
|
|
Then the measurement is subtracted to the reference signal \([r_x, r_y]\) to obtain the position error in the fixed reference frame \([\epsilon_x, \epsilon_y]\).
|
|
</p>
|
|
|
|
<p>
|
|
The position error \([\epsilon_x, \epsilon_y]\) is then express in the rotating frame corresponding to the actuators \([\epsilon_u, \epsilon_v]\).
|
|
</p>
|
|
|
|
<p>
|
|
Finally, the control low \(K\) links the position errors \([\epsilon_u, \epsilon_v]\) to the actuator forces \([F_u, F_v]\).
|
|
</p>
|
|
|
|
<p>
|
|
The block diagram is shown on figure <a href="#org2ec1e52">10</a>.
|
|
</p>
|
|
|
|
|
|
<div id="org2ec1e52" class="figure">
|
|
<p><img src="./figs/control_measure_fixed_2dof.png" alt="control_measure_fixed_2dof.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 10: </span>Control with a measure from fixed frame</p>
|
|
</div>
|
|
|
|
<p>
|
|
The loop gain is then \(L = G(\theta) K J(\theta)\).
|
|
</p>
|
|
|
|
<p>
|
|
One question we wish to answer is: is \(G(\theta) J(\theta) = G(\theta_0) J(\theta_0)\)?
|
|
</p>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org76e17f2" class="outline-3">
|
|
<h3 id="org76e17f2"><span class="section-number-3">2.2</span> Measurement in the rotating frame</h3>
|
|
<div class="outline-text-3" id="text-2-2">
|
|
<p>
|
|
Let's consider that the measurement is made in the rotating reference frame.
|
|
</p>
|
|
|
|
<p>
|
|
The corresponding block diagram is shown figure <a href="#orge7812cc">11</a>.
|
|
</p>
|
|
|
|
|
|
<div id="orge7812cc" class="figure">
|
|
<p><img src="./figs/control_measure_rotating_2dof.png" alt="control_measure_rotating_2dof.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 11: </span>Control with a measure from rotating frame</p>
|
|
</div>
|
|
|
|
<p>
|
|
The loop gain is \(L = G K\).
|
|
</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org379c58c" class="outline-2">
|
|
<h2 id="org379c58c"><span class="section-number-2">3</span> Multi Body Model - Simscape</h2>
|
|
<div class="outline-text-2" id="text-3">
|
|
<p>
|
|
<a id="org5f1b78c"></a>
|
|
</p>
|
|
</div>
|
|
|
|
<div id="outline-container-orgd629ab2" class="outline-3">
|
|
<h3 id="orgd629ab2"><span class="section-number-3">3.1</span> Initialization</h3>
|
|
<div class="outline-text-3" id="text-3-1">
|
|
<p>
|
|
Let's load the previously defined parameters for the model.
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">bode_opts = bodeoptions;
|
|
bode_opts.FreqUnits = <span class="org-string">'Hz'</span>;
|
|
bode_opts.MagUnits = <span class="org-string">'abs'</span>;
|
|
bode_opts.MagScale = <span class="org-string">'log'</span>;
|
|
bode_opts.Grid = <span class="org-string">'on'</span>;
|
|
bode_opts.PhaseVisible = <span class="org-string">'off'</span>;
|
|
bode_opts.Title.FontSize = <span class="org-highlight-numbers-number">10</span>;
|
|
bode_opts.XLabel.FontSize = <span class="org-highlight-numbers-number">10</span>;
|
|
bode_opts.YLabel.FontSize = <span class="org-highlight-numbers-number">10</span>;
|
|
bode_opts.TickLabel.FontSize = <span class="org-highlight-numbers-number">10</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
First we define the parameters that must be defined in order to run the Simscape simulation.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">w = <span class="org-highlight-numbers-number">2</span><span class="org-type">*</span><span class="org-constant">pi</span>; <span class="org-comment">% Rotation speed [rad/s]</span>
|
|
|
|
theta_e = <span class="org-highlight-numbers-number">0</span>; <span class="org-comment">% Static measurement error on the angle theta [rad]</span>
|
|
|
|
m = <span class="org-highlight-numbers-number">5</span>; <span class="org-comment">% mass of the sample [kg]</span>
|
|
|
|
mTuv = <span class="org-highlight-numbers-number">30</span>;<span class="org-comment">% Mass of the moving part of the Tuv stage [kg]</span>
|
|
kTuv = <span class="org-highlight-numbers-number">1e8</span>; <span class="org-comment">% Stiffness of the Tuv stage [N/m]</span>
|
|
cTuv = <span class="org-highlight-numbers-number">0</span>; <span class="org-comment">% Damping of the Tuv stage [N/(m/s)]</span>
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
Then, we defined parameters that will be used in the following analysis.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">mlight = <span class="org-highlight-numbers-number">5</span>; <span class="org-comment">% Mass for light sample [kg]</span>
|
|
mheavy = <span class="org-highlight-numbers-number">55</span>; <span class="org-comment">% Mass for heavy sample [kg]</span>
|
|
|
|
wlight = <span class="org-highlight-numbers-number">2</span><span class="org-type">*</span><span class="org-constant">pi</span>; <span class="org-comment">% Max rot. speed for light sample [rad/s]</span>
|
|
wheavy = <span class="org-highlight-numbers-number">2</span><span class="org-type">*</span><span class="org-constant">pi</span><span class="org-type">/</span><span class="org-highlight-numbers-number">60</span>; <span class="org-comment">% Max rot. speed for heavy sample [rad/s]</span>
|
|
|
|
kvc = <span class="org-highlight-numbers-number">1e3</span>; <span class="org-comment">% Voice Coil Stiffness [N/m]</span>
|
|
kpz = <span class="org-highlight-numbers-number">1e8</span>; <span class="org-comment">% Piezo Stiffness [N/m]</span>
|
|
|
|
d = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">01</span>; <span class="org-comment">% Maximum excentricity from rotational axis [m]</span>
|
|
|
|
freqs = logspace<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-type">-</span><span class="org-highlight-numbers-number">2</span>, <span class="org-highlight-numbers-number">3</span>, <span class="org-highlight-numbers-number">1000</span><span class="org-rainbow-delimiters-depth-1">)</span>; <span class="org-comment">% Frequency vector for analysis [Hz]</span>
|
|
</pre>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org4495e34" class="outline-3">
|
|
<h3 id="org4495e34"><span class="section-number-3">3.2</span> Identification in the rotating referenced frame</h3>
|
|
<div class="outline-text-3" id="text-3-2">
|
|
<p>
|
|
We initialize the inputs and outputs of the system to identify:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>Inputs: \(f_u\) and \(f_v\)</li>
|
|
<li>Outputs: \(d_u\) and \(d_v\)</li>
|
|
</ul>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab"><span class="org-matlab-cellbreak"><span class="org-comment">%% Options for Linearized</span></span>
|
|
options = linearizeOptions;
|
|
options.SampleTime = <span class="org-highlight-numbers-number">0</span>;
|
|
|
|
<span class="org-matlab-cellbreak"><span class="org-comment">%% Name of the Simulink File</span></span>
|
|
mdl = <span class="org-string">'rotating_frame'</span>;
|
|
|
|
<span class="org-matlab-cellbreak"><span class="org-comment">%% Input/Output definition</span></span>
|
|
io<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span> = linio<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">[</span>mdl, '<span class="org-type">/</span>fu'<span class="org-rainbow-delimiters-depth-2">]</span>, <span class="org-highlight-numbers-number">1</span>, 'input'<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
io<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-highlight-numbers-number">2</span><span class="org-rainbow-delimiters-depth-1">)</span> = linio<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">[</span>mdl, '<span class="org-type">/</span>fv'<span class="org-rainbow-delimiters-depth-2">]</span>, <span class="org-highlight-numbers-number">1</span>, 'input'<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
io<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-highlight-numbers-number">3</span><span class="org-rainbow-delimiters-depth-1">)</span> = linio<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">[</span>mdl, '<span class="org-type">/</span>du'<span class="org-rainbow-delimiters-depth-2">]</span>, <span class="org-highlight-numbers-number">1</span>, 'output'<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
io<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-highlight-numbers-number">4</span><span class="org-rainbow-delimiters-depth-1">)</span> = linio<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">[</span>mdl, '<span class="org-type">/</span>dv'<span class="org-rainbow-delimiters-depth-2">]</span>, <span class="org-highlight-numbers-number">1</span>, 'output'<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
We start we identify the transfer functions at high speed with the light sample.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">w = wlight; <span class="org-comment">% Rotation speed [rad/s]</span>
|
|
m = mlight; <span class="org-comment">% mass of the sample [kg]</span>
|
|
|
|
kTuv = kpz;
|
|
Gpz_light = linearize<span class="org-rainbow-delimiters-depth-1">(</span>mdl, io, <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
Gpz_light.InputName = <span class="org-rainbow-delimiters-depth-1">{</span><span class="org-string">'Fu', 'Fv'</span><span class="org-rainbow-delimiters-depth-1">}</span>;
|
|
Gpz_light.OutputName = <span class="org-rainbow-delimiters-depth-1">{</span><span class="org-string">'Du', 'Dv'</span><span class="org-rainbow-delimiters-depth-1">}</span>;
|
|
|
|
kTuv = kvc;
|
|
Gvc_light = linearize<span class="org-rainbow-delimiters-depth-1">(</span>mdl, io, <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
Gvc_light.InputName = <span class="org-rainbow-delimiters-depth-1">{</span><span class="org-string">'Fu', 'Fv'</span><span class="org-rainbow-delimiters-depth-1">}</span>;
|
|
Gvc_light.OutputName = <span class="org-rainbow-delimiters-depth-1">{</span><span class="org-string">'Du', 'Dv'</span><span class="org-rainbow-delimiters-depth-1">}</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
Then we identify the system with an heavy mass and low speed.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">w = wheavy; <span class="org-comment">% Rotation speed [rad/s]</span>
|
|
m = mheavy; <span class="org-comment">% mass of the sample [kg]</span>
|
|
|
|
kTuv = kpz;
|
|
Gpz_heavy = linearize<span class="org-rainbow-delimiters-depth-1">(</span>mdl, io, <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
Gpz_heavy.InputName = <span class="org-rainbow-delimiters-depth-1">{</span><span class="org-string">'Fu', 'Fv'</span><span class="org-rainbow-delimiters-depth-1">}</span>;
|
|
Gpz_heavy.OutputName = <span class="org-rainbow-delimiters-depth-1">{</span><span class="org-string">'Du', 'Dv'</span><span class="org-rainbow-delimiters-depth-1">}</span>;
|
|
|
|
kTuv = kvc;
|
|
Gvc_heavy = linearize<span class="org-rainbow-delimiters-depth-1">(</span>mdl, io, <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
Gvc_heavy.InputName = <span class="org-rainbow-delimiters-depth-1">{</span><span class="org-string">'Fu', 'Fv'</span><span class="org-rainbow-delimiters-depth-1">}</span>;
|
|
Gvc_heavy.OutputName = <span class="org-rainbow-delimiters-depth-1">{</span><span class="org-string">'Du', 'Dv'</span><span class="org-rainbow-delimiters-depth-1">}</span>;
|
|
</pre>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org1fb0c24" class="outline-3">
|
|
<h3 id="org1fb0c24"><span class="section-number-3">3.3</span> Coupling ratio between \(f_{uv}\) and \(d_{uv}\)</h3>
|
|
<div class="outline-text-3" id="text-3-3">
|
|
<p>
|
|
In order to validate the equations written, we can compute the coupling ratio using the simscape model and compare with the equations.
|
|
</p>
|
|
|
|
<p>
|
|
From the previous identification, we plot the coupling ratio in both case (figure <a href="#org49bb83e">12</a>).
|
|
</p>
|
|
|
|
<p>
|
|
We obtain the same result than the analytical case (figures <a href="#org882b7da">2</a> and <a href="#org618a5fd">3</a>).
|
|
</p>
|
|
|
|
<div id="org49bb83e" class="figure">
|
|
<p><img src="figs/coupling_ratio_light_heavy.png" alt="coupling_ratio_light_heavy.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 12: </span>Coupling ratio obtained with the Simscape model</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org0344c6e" class="outline-3">
|
|
<h3 id="org0344c6e"><span class="section-number-3">3.4</span> Plant Control - SISO approach</h3>
|
|
<div class="outline-text-3" id="text-3-4">
|
|
</div>
|
|
<div id="outline-container-orgbd17c9a" class="outline-4">
|
|
<h4 id="orgbd17c9a"><span class="section-number-4">3.4.1</span> Plant identification</h4>
|
|
<div class="outline-text-4" id="text-3-4-1">
|
|
<p>
|
|
The goal is to study the control problems due to the coupling that appears because of the rotation.
|
|
</p>
|
|
|
|
<p>
|
|
First, we identify the system when the rotation speed is null and then when the rotation speed is equal to 60rpm.
|
|
</p>
|
|
|
|
<p>
|
|
The actuators are voice coil with some damping added.
|
|
</p>
|
|
|
|
<p>
|
|
The bode plot of the system not rotating and rotating at 60rpm is shown figure <a href="#org0d455e7">13</a>.
|
|
</p>
|
|
|
|
|
|
<div id="org0d455e7" class="figure">
|
|
<p><img src="figs/Gvc_speed.png" alt="Gvc_speed.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 13: </span>Change of transfer functions due to rotating speed</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org34f917c" class="outline-4">
|
|
<h4 id="org34f917c"><span class="section-number-4">3.4.2</span> Effect of rotation speed</h4>
|
|
<div class="outline-text-4" id="text-3-4-2">
|
|
<p>
|
|
We first identify the system (voice coil and light mass) for multiple rotation speed.
|
|
Then we compute the bode plot of the system (figure <a href="#org3bb39fd">14</a>).
|
|
</p>
|
|
|
|
<p>
|
|
As the rotation frequency increases:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>one pole goes to lower frequencies while the other goes to higher frequencies</li>
|
|
<li>one zero appears between the two poles</li>
|
|
<li>the zero disappears when \(\omega > \sqrt{\frac{k}{m}}\) and the low frequency pole becomes unstable (positive real part)</li>
|
|
</ul>
|
|
|
|
<p>
|
|
To stabilize the unstable pole, we need a control bandwidth of at least twice of frequency of the unstable pole.
|
|
</p>
|
|
|
|
|
|
<div id="org3bb39fd" class="figure">
|
|
<p><img src="figs/Guu_uv_ws.png" alt="Guu_uv_ws.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 14: </span>Diagonal term as a function of the rotation frequency</p>
|
|
</div>
|
|
|
|
<p>
|
|
Then, we can look at the same plots for the piezoelectric actuator (figure <a href="#org8a8233f">15</a>). The effect of the rotation frequency has very little effect on the dynamics of the system to control.
|
|
</p>
|
|
|
|
|
|
<div id="org8a8233f" class="figure">
|
|
<p><img src="figs/Guu_ws_pz.png" alt="Guu_ws_pz.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 15: </span>Diagonal term as a function of the rotation frequency</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org4142099" class="outline-4">
|
|
<h4 id="org4142099"><span class="section-number-4">3.4.3</span> Controller design</h4>
|
|
<div class="outline-text-4" id="text-3-4-3">
|
|
<p>
|
|
We design a controller based on the identification when the system is not rotating.
|
|
</p>
|
|
|
|
<p>
|
|
The obtained controller is a lead-lag controller with the following transfer function.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">Kll = <span class="org-highlight-numbers-number">2</span>.<span class="org-highlight-numbers-number">0698e09</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-1">(</span>s<span class="org-type">+</span><span class="org-highlight-numbers-number">40</span>.<span class="org-highlight-numbers-number">45</span><span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-1">(</span>s<span class="org-type">+</span><span class="org-highlight-numbers-number">1</span>.<span class="org-highlight-numbers-number">181</span><span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">(</span>s<span class="org-type">+</span><span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">01</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-2">(</span>s<span class="org-type">+</span><span class="org-highlight-numbers-number">198</span>.<span class="org-highlight-numbers-number">4</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-2">(</span>s<span class="org-type">+</span><span class="org-highlight-numbers-number">2790</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
K = <span class="org-rainbow-delimiters-depth-1">[</span>Kll <span class="org-highlight-numbers-number">0</span>;
|
|
<span class="org-highlight-numbers-number">0</span> Kll<span class="org-rainbow-delimiters-depth-1">]</span>;
|
|
|
|
K.InputName = <span class="org-rainbow-delimiters-depth-1">{</span><span class="org-string">'Du', 'Dv'</span><span class="org-rainbow-delimiters-depth-1">}</span>;
|
|
K.OutputName = <span class="org-rainbow-delimiters-depth-1">{</span><span class="org-string">'Fu', 'Fv'</span><span class="org-rainbow-delimiters-depth-1">}</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
The loop gain is displayed figure <a href="#org2fb3944">16</a>.
|
|
</p>
|
|
|
|
|
|
<div id="org2fb3944" class="figure">
|
|
<p><img src="figs/Gvc_loop_gain.png" alt="Gvc_loop_gain.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 16: </span>Loop gain obtained for a lead-lag controller on the system with a voice coil</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org64519ad" class="outline-4">
|
|
<h4 id="org64519ad"><span class="section-number-4">3.4.4</span> Controlling the rotating system</h4>
|
|
<div class="outline-text-4" id="text-3-4-4">
|
|
<p>
|
|
We here want to see if the system is robust with respect to the rotation speed.
|
|
We use the controller that was designed based on the dynamics of the non-rotating system.
|
|
</p>
|
|
|
|
<p>
|
|
Let's first plot the SISO loop gain.
|
|
</p>
|
|
|
|
|
|
<div id="org35db4df" class="figure">
|
|
<p><img src="figs/loop_gain_turning.png" alt="loop_gain_turning.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 17: </span>Loop Gain \(G_u * K\)</p>
|
|
</div>
|
|
|
|
<p>
|
|
We can now compute the close-loop systems.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">Gvc_cl = <span class="org-rainbow-delimiters-depth-1">{</span>zeros<span class="org-rainbow-delimiters-depth-2">(</span><span class="org-highlight-numbers-number">1</span>, length<span class="org-rainbow-delimiters-depth-3">(</span>ws<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">}</span>;
|
|
<span class="org-keyword">for</span> <span class="org-variable-name">i</span> = <span class="org-constant"><span class="org-highlight-numbers-number">1</span></span><span class="org-constant">:length</span><span class="org-constant"><span class="org-rainbow-delimiters-depth-1">(</span></span><span class="org-constant">ws</span><span class="org-constant"><span class="org-rainbow-delimiters-depth-1">)</span></span>
|
|
Gvc_cl<span class="org-rainbow-delimiters-depth-1">{</span><span class="org-constant">i</span><span class="org-rainbow-delimiters-depth-1">}</span> = feedback<span class="org-rainbow-delimiters-depth-1">(</span>Gs_vc<span class="org-rainbow-delimiters-depth-2">{</span><span class="org-constant">i</span><span class="org-rainbow-delimiters-depth-2">}</span>, K, <span class="org-string">'name'</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
<span class="org-keyword">end</span>
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
Let's now look on figure <a href="#orgb02f4ce">18</a> at the evolution of the poles of the system when closing only one loop (controlling only one direction). We see that two complex conjugate poles are approaching the real axis and then they separate: one goes to positive real part and the other goes to negative real part.
|
|
The system then goes unstable at some point (here for \(\omega=60rpm\)).
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab"><span class="org-type">figure</span>;
|
|
hold on;
|
|
<span class="org-keyword">for</span> <span class="org-variable-name">i</span> = <span class="org-constant"><span class="org-highlight-numbers-number">1</span></span><span class="org-constant">:length</span><span class="org-constant"><span class="org-rainbow-delimiters-depth-1">(</span></span><span class="org-constant">ws</span><span class="org-constant"><span class="org-rainbow-delimiters-depth-1">)</span></span>
|
|
sys = feedback<span class="org-rainbow-delimiters-depth-1">(</span>Gs_vc<span class="org-rainbow-delimiters-depth-2">{</span><span class="org-constant">i</span><span class="org-rainbow-delimiters-depth-2">}(</span><span class="org-highlight-numbers-number">1</span>, <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-2">)</span>, K<span class="org-rainbow-delimiters-depth-2">(</span><span class="org-highlight-numbers-number">1</span>, <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-2">)</span>, <span class="org-string">'name'</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
plot<span class="org-rainbow-delimiters-depth-1">(</span>real<span class="org-rainbow-delimiters-depth-2">(</span>pole<span class="org-rainbow-delimiters-depth-3">(</span>sys<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-rainbow-delimiters-depth-2">)</span>, imag<span class="org-rainbow-delimiters-depth-2">(</span>pole<span class="org-rainbow-delimiters-depth-3">(</span>sys<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-rainbow-delimiters-depth-2">)</span>, <span class="org-string">'o', 'DisplayName', sprintf</span><span class="org-string"><span class="org-rainbow-delimiters-depth-2">(</span></span><span class="org-string">'</span>$<span class="org-type">\\</span>omega = %.<span class="org-highlight-numbers-number">0f</span> rpm$', ws(<span class="org-constant">i</span>)<span class="org-type">/</span>(<span class="org-highlight-numbers-number">2</span><span class="org-type">*</span><span class="org-constant">pi</span>)<span class="org-type">*</span><span class="org-highlight-numbers-number">60</span>));
|
|
<span class="org-keyword">end</span>
|
|
hold off;
|
|
xlim<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-rainbow-delimiters-depth-4">[</span><span class="org-type">-</span><span class="org-highlight-numbers-number">80</span>, <span class="org-highlight-numbers-number">10</span><span class="org-rainbow-delimiters-depth-4">]</span><span class="org-rainbow-delimiters-depth-3">)</span>;
|
|
xlabel<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-string">'Real Axis'</span><span class="org-string"><span class="org-rainbow-delimiters-depth-3">)</span></span><span class="org-string">; ylabel</span><span class="org-string"><span class="org-rainbow-delimiters-depth-3">(</span></span><span class="org-string">'Imaginary Axis'</span><span class="org-rainbow-delimiters-depth-3">)</span>;
|
|
legend<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-string">'Location', 'northeast'</span><span class="org-rainbow-delimiters-depth-3">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="orgb02f4ce" class="figure">
|
|
<p><img src="figs/evolution_poles_u.png" alt="evolution_poles_u.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 18: </span>Evolution of the poles of the closed-loop system when closing just one loop</p>
|
|
</div>
|
|
|
|
<p>
|
|
If we look at the poles of the closed loop-system for multiple rotating speed (figure <a href="#org78bc6a6">19</a>) when closing the two loops (MIMO system), we see that they all have a negative real part (stable system), and their evolution on the complex plane is rather small compare to the open loop evolution.
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab"><span class="org-type">figure</span>;
|
|
hold on;
|
|
<span class="org-keyword">for</span> <span class="org-variable-name">i</span> = <span class="org-constant"><span class="org-highlight-numbers-number">1</span></span><span class="org-constant">:length</span><span class="org-constant"><span class="org-rainbow-delimiters-depth-1">(</span></span><span class="org-constant">ws</span><span class="org-constant"><span class="org-rainbow-delimiters-depth-1">)</span></span>
|
|
plot<span class="org-rainbow-delimiters-depth-1">(</span>real<span class="org-rainbow-delimiters-depth-2">(</span>pole<span class="org-rainbow-delimiters-depth-3">(</span>Gvc_cl<span class="org-rainbow-delimiters-depth-4">{</span><span class="org-constant">i</span><span class="org-rainbow-delimiters-depth-4">}</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-rainbow-delimiters-depth-2">)</span>, imag<span class="org-rainbow-delimiters-depth-2">(</span>pole<span class="org-rainbow-delimiters-depth-3">(</span>Gvc_cl<span class="org-rainbow-delimiters-depth-4">{</span><span class="org-constant">i</span><span class="org-rainbow-delimiters-depth-4">}</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-rainbow-delimiters-depth-2">)</span>, <span class="org-string">'o', 'DisplayName', sprintf</span><span class="org-string"><span class="org-rainbow-delimiters-depth-2">(</span></span><span class="org-string">'</span>$<span class="org-type">\\</span>omega = %.<span class="org-highlight-numbers-number">0f</span> rpm$', ws(<span class="org-constant">i</span>)<span class="org-type">/</span>(<span class="org-highlight-numbers-number">2</span><span class="org-type">*</span><span class="org-constant">pi</span>)<span class="org-type">*</span><span class="org-highlight-numbers-number">60</span>));
|
|
<span class="org-keyword">end</span>
|
|
hold off;
|
|
xlim<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-rainbow-delimiters-depth-4">[</span><span class="org-type">-</span><span class="org-highlight-numbers-number">80</span>, <span class="org-highlight-numbers-number">0</span><span class="org-rainbow-delimiters-depth-4">]</span><span class="org-rainbow-delimiters-depth-3">)</span>;
|
|
xlabel<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-string">'Real Axis'</span><span class="org-string"><span class="org-rainbow-delimiters-depth-3">)</span></span><span class="org-string">; ylabel</span><span class="org-string"><span class="org-rainbow-delimiters-depth-3">(</span></span><span class="org-string">'Imaginary Axis'</span><span class="org-rainbow-delimiters-depth-3">)</span>;
|
|
legend<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-string">'Location', 'northeast'</span><span class="org-rainbow-delimiters-depth-3">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="org78bc6a6" class="figure">
|
|
<p><img src="figs/poles_cl_system.png" alt="poles_cl_system.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 19: </span>Evolution of the poles of the closed-loop system</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org6d2873c" class="outline-4">
|
|
<h4 id="org6d2873c"><span class="section-number-4">3.4.5</span> Close loop performance</h4>
|
|
<div class="outline-text-4" id="text-3-4-5">
|
|
<p>
|
|
First, we create the closed loop systems. Then, we plot the transfer function from the reference signals \([r_u, r_v]\) to the output \([d_u, d_v]\) (figure <a href="#org99c9d71">20</a>).
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">freqs = logspace<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-type">-</span><span class="org-highlight-numbers-number">2</span>, <span class="org-highlight-numbers-number">3</span>, <span class="org-highlight-numbers-number">1000</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
<span class="org-type">figure</span>;
|
|
ax1 = subplot<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-highlight-numbers-number">1</span>,<span class="org-highlight-numbers-number">2</span>,<span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
title<span class="org-rainbow-delimiters-depth-1">(</span>'$G_<span class="org-rainbow-delimiters-depth-2">{</span>r_u <span class="org-type">\</span>to d_u<span class="org-rainbow-delimiters-depth-2">}</span>$'<span class="org-rainbow-delimiters-depth-1">)</span>
|
|
hold on;
|
|
<span class="org-keyword">for</span> <span class="org-variable-name">i</span> = <span class="org-constant"><span class="org-highlight-numbers-number">1</span></span><span class="org-constant">:length</span><span class="org-constant"><span class="org-rainbow-delimiters-depth-1">(</span></span><span class="org-constant">ws</span><span class="org-constant"><span class="org-rainbow-delimiters-depth-1">)</span></span>
|
|
sys = Gvc_cl<span class="org-rainbow-delimiters-depth-1">{</span><span class="org-constant">i</span><span class="org-rainbow-delimiters-depth-1">}</span><span class="org-type">*</span>K;
|
|
plot<span class="org-rainbow-delimiters-depth-1">(</span>freqs, abs<span class="org-rainbow-delimiters-depth-2">(</span>squeeze<span class="org-rainbow-delimiters-depth-3">(</span>freqresp<span class="org-rainbow-delimiters-depth-4">(</span>sys<span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">1</span>, <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-5">)</span>, freqs, <span class="org-string">'Hz'</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
<span class="org-keyword">end</span>
|
|
hold off;
|
|
xlim<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">[</span>freqs<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-3">)</span>, freqs<span class="org-rainbow-delimiters-depth-3">(</span>end<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-rainbow-delimiters-depth-2">]</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
ylim<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">[</span><span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">4</span>, <span class="org-highlight-numbers-number">10</span><span class="org-rainbow-delimiters-depth-2">]</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
<span class="org-type">set</span><span class="org-rainbow-delimiters-depth-1">(</span><span class="org-variable-name">gca</span>, <span class="org-string">'XScale', 'log'</span><span class="org-string"><span class="org-rainbow-delimiters-depth-1">)</span></span><span class="org-string">; set</span><span class="org-string"><span class="org-rainbow-delimiters-depth-1">(</span></span><span class="org-string">gca, 'YScale', 'log'</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
xlabel<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-string">'Frequency </span><span class="org-string"><span class="org-rainbow-delimiters-depth-2">[</span></span><span class="org-string">Hz</span><span class="org-string"><span class="org-rainbow-delimiters-depth-2">]</span></span><span class="org-string">'</span><span class="org-string"><span class="org-rainbow-delimiters-depth-1">)</span></span><span class="org-string">; ylabel</span><span class="org-string"><span class="org-rainbow-delimiters-depth-1">(</span></span><span class="org-string">'Magnitude </span><span class="org-string"><span class="org-rainbow-delimiters-depth-2">[</span></span><span class="org-string">m/N</span><span class="org-string"><span class="org-rainbow-delimiters-depth-2">]</span></span><span class="org-string">'</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
ax2 = subplot<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-highlight-numbers-number">1</span>,<span class="org-highlight-numbers-number">2</span>,<span class="org-highlight-numbers-number">2</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
title<span class="org-rainbow-delimiters-depth-1">(</span>'$G_<span class="org-rainbow-delimiters-depth-2">{</span>r_u <span class="org-type">\</span>to d_v<span class="org-rainbow-delimiters-depth-2">}</span>$'<span class="org-rainbow-delimiters-depth-1">)</span>
|
|
hold on;
|
|
<span class="org-keyword">for</span> <span class="org-variable-name">i</span> = <span class="org-constant"><span class="org-highlight-numbers-number">1</span></span><span class="org-constant">:length</span><span class="org-constant"><span class="org-rainbow-delimiters-depth-1">(</span></span><span class="org-constant">ws</span><span class="org-constant"><span class="org-rainbow-delimiters-depth-1">)</span></span>
|
|
sys = Gvc_cl<span class="org-rainbow-delimiters-depth-1">{</span><span class="org-constant">i</span><span class="org-rainbow-delimiters-depth-1">}</span><span class="org-type">*</span>K;
|
|
plot<span class="org-rainbow-delimiters-depth-1">(</span>freqs, abs<span class="org-rainbow-delimiters-depth-2">(</span>squeeze<span class="org-rainbow-delimiters-depth-3">(</span>freqresp<span class="org-rainbow-delimiters-depth-4">(</span>sys<span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">1</span>, <span class="org-highlight-numbers-number">2</span><span class="org-rainbow-delimiters-depth-5">)</span>, freqs, <span class="org-string">'Hz'</span><span class="org-string"><span class="org-rainbow-delimiters-depth-4">)</span></span><span class="org-string"><span class="org-rainbow-delimiters-depth-3">)</span></span><span class="org-string"><span class="org-rainbow-delimiters-depth-2">)</span></span><span class="org-string">, 'DisplayName', sprintf</span><span class="org-string"><span class="org-rainbow-delimiters-depth-2">(</span></span><span class="org-string">'</span>$<span class="org-type">\\</span>omega = %.<span class="org-highlight-numbers-number">0f</span> rpm$', ws(<span class="org-constant">i</span>)<span class="org-type">/</span>(<span class="org-highlight-numbers-number">2</span><span class="org-type">*</span><span class="org-constant">pi</span>)<span class="org-type">*</span><span class="org-highlight-numbers-number">60</span>));
|
|
<span class="org-keyword">end</span>
|
|
hold off;
|
|
xlim<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-rainbow-delimiters-depth-4">[</span>freqs<span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-5">)</span>, freqs<span class="org-rainbow-delimiters-depth-5">(</span>end<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">]</span><span class="org-rainbow-delimiters-depth-3">)</span>;
|
|
ylim<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-rainbow-delimiters-depth-4">[</span><span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">4</span>, <span class="org-highlight-numbers-number">10</span><span class="org-rainbow-delimiters-depth-4">]</span><span class="org-rainbow-delimiters-depth-3">)</span>;
|
|
<span class="org-type">set</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-variable-name">gca</span>, <span class="org-string">'XScale', 'log'</span><span class="org-string"><span class="org-rainbow-delimiters-depth-3">)</span></span><span class="org-string">; set</span><span class="org-string"><span class="org-rainbow-delimiters-depth-3">(</span></span><span class="org-string">gca, 'YScale', 'log'</span><span class="org-rainbow-delimiters-depth-3">)</span>;
|
|
xlabel<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-string">'Frequency </span><span class="org-string"><span class="org-rainbow-delimiters-depth-4">[</span></span><span class="org-string">Hz</span><span class="org-string"><span class="org-rainbow-delimiters-depth-4">]</span></span><span class="org-string">'</span><span class="org-rainbow-delimiters-depth-3">)</span>;
|
|
legend<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-string">'Location', 'northeast'</span><span class="org-rainbow-delimiters-depth-3">)</span>
|
|
|
|
linkaxes<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-rainbow-delimiters-depth-4">[</span>ax1,ax2<span class="org-rainbow-delimiters-depth-4">]</span>,<span class="org-string">'x'</span><span class="org-rainbow-delimiters-depth-3">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="org99c9d71" class="figure">
|
|
<p><img src="figs/perfcomp.png" alt="perfcomp.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 20: </span>Close loop performance for \(\omega = 0\) and \(\omega = 60 rpm\)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org88a2f7e" class="outline-4">
|
|
<h4 id="org88a2f7e"><span class="section-number-4">3.4.6</span> Conclusion</h4>
|
|
<div class="outline-text-4" id="text-3-4-6">
|
|
<div class="important">
|
|
<p>
|
|
Even though considering one input and output at a time would results in an unstable system (figure <a href="#orgb02f4ce">18</a>), when using the diagonal MIMO controller, the system stays stable (figure <a href="#org78bc6a6">19</a>). This could be understood by saying that when controlling both directions at the same time, the coupling effect should be much lower than when controlling only one direction.
|
|
</p>
|
|
|
|
<p>
|
|
The close-loop performance does not vary a lot with the rotating speed (figure <a href="#org99c9d71">20</a>) even tough the open loop system is varying quite a lot (figure <a href="#org3bb39fd">14</a>).
|
|
</p>
|
|
|
|
</div>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgb513744" class="outline-3">
|
|
<h3 id="orgb513744"><span class="section-number-3">3.5</span> <span class="todo BKMK">BKMK</span> Plant Control - MIMO approach</h3>
|
|
<div class="outline-text-3" id="text-3-5">
|
|
</div>
|
|
<div id="outline-container-org0527579" class="outline-4">
|
|
<h4 id="org0527579"><span class="section-number-4">3.5.1</span> Analysis - SVD</h4>
|
|
<div class="outline-text-4" id="text-3-5-1">
|
|
<p>
|
|
The singular value decomposition of a MIMO system \(G\) is defined as follow:
|
|
\[ G = U \Sigma V^H \]
|
|
</p>
|
|
|
|
<p>
|
|
With:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>\(\Sigma\) is an \(2 \times 2\) matrix with 2 non-negative <b>singular values</b> \(\sigma_i\), arranged in descending order along its main diagonal</li>
|
|
<li>\(U\) is an \(2 \times 2\) unitary matrix. The columns vectors of \(U\), denoted \(u_i\), represent the <b>output directions</b> of the plant. They are orthonomal</li>
|
|
<li>\(V\) is an \(2 \times 2\) unitary matrix. The columns vectors of \(V\), denoted \(v_i\), represent the <b>input directions</b> of the plant. They are orthonomal</li>
|
|
</ul>
|
|
|
|
<p>
|
|
We first look at the evolution of the singular values as a function of frequency (figure <a href="#org2852d52">21</a>).
|
|
</p>
|
|
|
|
|
|
<div id="org2852d52" class="figure">
|
|
<p><img src="figs/G_sigma.png" alt="G_sigma.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 21: </span>Evolution of the singular values with frequency</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org46ce269" class="outline-2">
|
|
<h2 id="org46ce269"><span class="section-number-2">4</span> Control Implementation</h2>
|
|
<div class="outline-text-2" id="text-4">
|
|
<p>
|
|
<a id="orgd39f226"></a>
|
|
</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
<div id="postamble" class="status">
|
|
<p class="author">Author: Dehaeze Thomas</p>
|
|
<p class="date">Created: 2019-06-04 mar. 10:16</p>
|
|
<p class="validation"><a href="http://validator.w3.org/check?uri=referer">Validate</a></p>
|
|
</div>
|
|
</body>
|
|
</html>
|