tdehaeze/nass-simscape
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Correct stupid error

Browse Source
This commit is contained in:
Thomas Dehaeze
2020-04-17 14:32:08 +02:00
parent 6522211e01
commit 00452e0a49
19 changed files with 1835 additions and 2096 deletions
Download Patch File Download Diff File Expand all files Collapse all files

78
docs/control_virtual_mass.html
View File

@@ -1,11 +1,10 @@
<?xml version="1.0" encoding="utf-8"?>
<?xml version="1.0" encoding="utf-8"?>
<?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>
<!-- 2020-04-17 ven. 14:10 -->
<!-- 2020-04-17 ven. 14:32 -->
<meta http-equiv="Content-Type" content="text/html;charset=utf-8" />
<title>Decentralize control to add virtual mass</title>
<meta name="generator" content="Org mode" />
@@ -37,24 +36,19 @@
<div id="text-table-of-contents">
<ul>
<li><a href="#org982b263">1. Initialization</a></li>
<li><a href="#org35a3822">2. Identification</a>
<ul>
<li><a href="#org33f35d2">2.1. Identification of the transfer function from \(\tau\) to \(d\mathcal{L}\)</a></li>
<li><a href="#org6663ed2">2.2. Identification of the Primary plant without virtual add of mass</a></li>
</ul>
</li>
<li><a href="#org35a3822">2. Identification</a></li>
<li><a href="#orgd6fc719">3. Adding Virtual Mass in the Leg&rsquo;s Space</a>
<ul>
<li><a href="#orgc37faa7">3.1. Plant</a></li>
<li><a href="#org4ae3263">3.2. Controller Design</a></li>
<li><a href="#orgb270293">3.3. Identification of the Primary Plant</a></li>
<li><a href="#org9ed2d4c">3.1. Plant</a></li>
<li><a href="#org4f03a34">3.2. Controller Design</a></li>
<li><a href="#org2fe0ce0">3.3. Identification of the Primary Plant</a></li>
</ul>
</li>
<li><a href="#orgc9131d0">4. Adding Virtual Mass in the Task Space</a>
<ul>
<li><a href="#org9ed2d4c">4.1. Plant</a></li>
<li><a href="#org4f03a34">4.2. Controller Design</a></li>
<li><a href="#org2fe0ce0">4.3. Identification of the Primary Plant</a></li>
<li><a href="#orga27c9a0">4.1. Plant</a></li>
<li><a href="#orgcbce41a">4.2. Controller Design</a></li>
<li><a href="#orgca1f525">4.3. Identification of the Primary Plant</a></li>
</ul>
</li>
</ul>
@@ -82,6 +76,14 @@ initializeController(<span class="org-string">'type'</span>, <span class="org-st
</pre>
</div>
<p>
The nano-hexapod has the following leg&rsquo;s stiffness and damping.
</p>
<div class="org-src-container">
<pre class="src src-matlab">initializeNanoHexapod(<span class="org-string">'k'</span>, 1e5, <span class="org-string">'c'</span>, 2e2);
</pre>
</div>
<p>
We set the stiffness of the payload fixation:
</p>
@@ -95,16 +97,6 @@ We set the stiffness of the payload fixation:
<div id="outline-container-org35a3822" class="outline-2">
<h2 id="org35a3822"><span class="section-number-2">2</span> Identification</h2>
<div class="outline-text-2" id="text-2">
</div>
<div id="outline-container-org33f35d2" class="outline-3">
<h3 id="org33f35d2"><span class="section-number-3">2.1</span> Identification of the transfer function from \(\tau\) to \(d\mathcal{L}\)</h3>
<div class="outline-text-3" id="text-2-1">
<div class="org-src-container">
<pre class="src src-matlab">K = tf(zeros(6));
Kdvf = tf(zeros(6));
</pre>
</div>
<p>
We identify the system for the following payload masses:
</p>
@@ -114,25 +106,17 @@ We identify the system for the following payload masses:
</div>
<p>
The nano-hexapod has the following leg&rsquo;s stiffness and damping.
Identification of the transfer function from \(\tau\) to \(d\mathcal{L}\).
Identification of the Primary plant without virtual add of mass
</p>
<div class="org-src-container">
<pre class="src src-matlab">initializeNanoHexapod(<span class="org-string">'k'</span>, 1e5, <span class="org-string">'c'</span>, 2e2);
</pre>
</div>
</div>
</div>
<div id="outline-container-org6663ed2" class="outline-3">
<h3 id="org6663ed2"><span class="section-number-3">2.2</span> Identification of the Primary plant without virtual add of mass</h3>
</div>
</div>
<div id="outline-container-orgd6fc719" class="outline-2">
<h2 id="orgd6fc719"><span class="section-number-2">3</span> Adding Virtual Mass in the Leg&rsquo;s Space</h2>
<div class="outline-text-2" id="text-3">
</div>
<div id="outline-container-orgc37faa7" class="outline-3">
<h3 id="orgc37faa7"><span class="section-number-3">3.1</span> Plant</h3>
<div id="outline-container-org9ed2d4c" class="outline-3">
<h3 id="org9ed2d4c"><span class="section-number-3">3.1</span> Plant</h3>
<div class="outline-text-3" id="text-3-1">
<div id="org98e7ba8" class="figure">
@@ -143,8 +127,8 @@ The nano-hexapod has the following leg&rsquo;s stiffness and damping.
</div>
</div>
<div id="outline-container-org4ae3263" class="outline-3">
<h3 id="org4ae3263"><span class="section-number-3">3.2</span> Controller Design</h3>
<div id="outline-container-org4f03a34" class="outline-3">
<h3 id="org4f03a34"><span class="section-number-3">3.2</span> Controller Design</h3>
<div class="outline-text-3" id="text-3-2">
<div class="org-src-container">
<pre class="src src-matlab">Kdvf = 10<span class="org-type">*</span>s<span class="org-type">^</span>2<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>500)<span class="org-type">^</span>2<span class="org-type">*</span>eye(6);
@@ -160,8 +144,8 @@ The nano-hexapod has the following leg&rsquo;s stiffness and damping.
</div>
</div>
<div id="outline-container-orgb270293" class="outline-3">
<h3 id="orgb270293"><span class="section-number-3">3.3</span> Identification of the Primary Plant</h3>
<div id="outline-container-org2fe0ce0" class="outline-3">
<h3 id="org2fe0ce0"><span class="section-number-3">3.3</span> Identification of the Primary Plant</h3>
<div class="outline-text-3" id="text-3-3">
<div id="orgd49505e" class="figure">
@@ -184,8 +168,8 @@ The nano-hexapod has the following leg&rsquo;s stiffness and damping.
<h2 id="orgc9131d0"><span class="section-number-2">4</span> Adding Virtual Mass in the Task Space</h2>
<div class="outline-text-2" id="text-4">
</div>
<div id="outline-container-org9ed2d4c" class="outline-3">
<h3 id="org9ed2d4c"><span class="section-number-3">4.1</span> Plant</h3>
<div id="outline-container-orga27c9a0" class="outline-3">
<h3 id="orga27c9a0"><span class="section-number-3">4.1</span> Plant</h3>
<div class="outline-text-3" id="text-4-1">
<p>
Let&rsquo;s look at the transfer function from \(\bm{\mathcal{F}}\) to \(d\bm{\mathcal{X}}\):
@@ -201,8 +185,8 @@ Let&rsquo;s look at the transfer function from \(\bm{\mathcal{F}}\) to \(d\bm{\m
</div>
</div>
<div id="outline-container-org4f03a34" class="outline-3">
<h3 id="org4f03a34"><span class="section-number-3">4.2</span> Controller Design</h3>
<div id="outline-container-orgcbce41a" class="outline-3">
<h3 id="orgcbce41a"><span class="section-number-3">4.2</span> Controller Design</h3>
<div class="outline-text-3" id="text-4-2">
<div class="org-src-container">
<pre class="src src-matlab">KmX = (s<span class="org-type">^</span>2<span class="org-type">*</span>1<span class="org-type">/</span>(1<span class="org-type">+</span>s<span class="org-type">/</span>2<span class="org-type">/</span><span class="org-constant">pi</span><span class="org-type">/</span>500)<span class="org-type">^</span>2<span class="org-type">*</span>diag([1 1 50 0 0 0]));
@@ -223,8 +207,8 @@ Let&rsquo;s look at the transfer function from \(\bm{\mathcal{F}}\) to \(d\bm{\m
</div>
</div>
<div id="outline-container-org2fe0ce0" class="outline-3">
<h3 id="org2fe0ce0"><span class="section-number-3">4.3</span> Identification of the Primary Plant</h3>
<div id="outline-container-orgca1f525" class="outline-3">
<h3 id="orgca1f525"><span class="section-number-3">4.3</span> Identification of the Primary Plant</h3>
<div class="outline-text-3" id="text-4-3">
<div id="orge1df87b" class="figure">
@@ -245,7 +229,7 @@ Let&rsquo;s look at the transfer function from \(\bm{\mathcal{F}}\) to \(d\bm{\m
</div>
<div id="postamble" class="status">
<p class="author">Author: Dehaeze Thomas</p>
<p class="date">Created: 2020-04-17 ven. 14:10</p>
<p class="date">Created: 2020-04-17 ven. 14:32</p>
</div>
</body>
</html>