2980 lines
204 KiB
HTML
2980 lines
204 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-09-03 mar. 09:02 -->
|
|
<meta http-equiv="Content-Type" content="text/html;charset=utf-8" />
|
|
<meta name="viewport" content="width=device-width, initial-scale=1" />
|
|
<title>Robust and Optimal Sensor Fusion - Matlab Computation</title>
|
|
<meta name="generator" content="Org mode" />
|
|
<meta name="author" content="Thomas Dehaeze" />
|
|
<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 src="../js/jquery.min.js"></script>
|
|
<script src="../js/bootstrap.min.js"></script>
|
|
<script src="../js/jquery.stickytableheaders.min.js"></script>
|
|
<script 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="org-div-home-and-up">
|
|
<a accesskey="h" href="../index.html"> UP </a>
|
|
|
|
|
<a accesskey="H" href="../index.html"> HOME </a>
|
|
</div><div id="content">
|
|
<h1 class="title">Robust and Optimal Sensor Fusion - Matlab Computation</h1>
|
|
<div id="table-of-contents">
|
|
<h2>Table of Contents</h2>
|
|
<div id="text-table-of-contents">
|
|
<ul>
|
|
<li><a href="#org6a5ea1e">1. Optimal Sensor Fusion - Minimize the Super Sensor Noise</a>
|
|
<ul>
|
|
<li><a href="#orgfc35b50">1.1. Architecture</a></li>
|
|
<li><a href="#org791316d">1.2. Noise of the sensors</a></li>
|
|
<li><a href="#orgef7f268">1.3. H-Two Synthesis</a></li>
|
|
<li><a href="#org50fb2c6">1.4. Alternative H-Two Synthesis</a></li>
|
|
<li><a href="#org1d306e7">1.5. H-Infinity Synthesis - method A</a></li>
|
|
<li><a href="#org12cdd85">1.6. H-Infinity Synthesis - method B</a></li>
|
|
<li><a href="#org36e53f2">1.7. H-Infinity Synthesis - method C</a></li>
|
|
<li><a href="#orgd63da98">1.8. Comparison of the methods</a></li>
|
|
<li><a href="#orge74ac09">1.9. Obtained Super Sensor's noise uncertainty</a></li>
|
|
<li><a href="#orga246751">1.10. Conclusion</a></li>
|
|
</ul>
|
|
</li>
|
|
<li><a href="#orgb4f295b">2. Optimal Sensor Fusion - Minimize the Super Sensor Dynamical Uncertainty</a>
|
|
<ul>
|
|
<li><a href="#orgdd8809b">2.1. Super Sensor Dynamical Uncertainty</a></li>
|
|
<li><a href="#org3597260">2.2. Dynamical uncertainty of the individual sensors</a></li>
|
|
<li><a href="#orga6f0baf">2.3. Synthesis objective</a></li>
|
|
<li><a href="#org071d7dd">2.4. Requirements as an \(\mathcal{H}_\infty\) norm</a></li>
|
|
<li><a href="#orgf966f50">2.5. Weighting Function used to bound the super sensor uncertainty</a></li>
|
|
<li><a href="#org027208c">2.6. \(\mathcal{H}_\infty\) Synthesis</a></li>
|
|
<li><a href="#orgc2223cb">2.7. Super sensor uncertainty</a></li>
|
|
<li><a href="#orgb6b7895">2.8. Super sensor noise</a></li>
|
|
<li><a href="#org30df8bd">2.9. Conclusion</a></li>
|
|
</ul>
|
|
</li>
|
|
<li><a href="#org5297284">3. Optimal Sensor Fusion - Mixed Synthesis</a>
|
|
<ul>
|
|
<li><a href="#orgf4ba947">3.1. Mixed \(\mathcal{H}_2\) / \(\mathcal{H}_\infty\) Synthesis - Introduction</a></li>
|
|
<li><a href="#org6def3bd">3.2. Noise characteristics and Uncertainty of the individual sensors</a></li>
|
|
<li><a href="#org69f8283">3.3. Weighting Functions on the uncertainty of the super sensor</a></li>
|
|
<li><a href="#orgc087ca6">3.4. Mixed Synthesis Architecture</a></li>
|
|
<li><a href="#orga44c183">3.5. Mixed \(\mathcal{H}_2\) / \(\mathcal{H}_\infty\) Synthesis</a></li>
|
|
<li><a href="#orgcc3cb0c">3.6. Obtained Super Sensor's noise</a></li>
|
|
<li><a href="#org4be95ec">3.7. Obtained Super Sensor's Uncertainty</a></li>
|
|
<li><a href="#org578a3af">3.8. Conclusion</a></li>
|
|
</ul>
|
|
</li>
|
|
<li><a href="#orge21a905">4. H-Infinity synthesis to ensure both performance and robustness</a>
|
|
<ul>
|
|
<li><a href="#orgc9411c5">4.1. Introduction</a></li>
|
|
<li><a href="#orgd416fee">4.2. Dynamical uncertainty and Noise level of the individual sensors</a></li>
|
|
<li><a href="#org2be762e">4.3. Weights for uncertainty and performance</a></li>
|
|
<li><a href="#org67abdbf">4.4. H-infinity synthesis with 4 outputs corresponding to the 4 weights</a></li>
|
|
<li><a href="#orgeddf530">4.5. Conclusion</a></li>
|
|
</ul>
|
|
</li>
|
|
<li><a href="#orge0c4fba">5. Equivalent Super Sensor</a>
|
|
<ul>
|
|
<li><a href="#orgb9f88a6">5.1. Sensor Fusion Architecture</a></li>
|
|
<li><a href="#org3ce82ca">5.2. Equivalent Configuration</a></li>
|
|
<li><a href="#orgaef042e">5.3. Model the uncertainty of the super sensor</a></li>
|
|
<li><a href="#org11399c1">5.4. Model the noise of the super sensor</a></li>
|
|
<li><a href="#org57d7962">5.5. First guess</a></li>
|
|
</ul>
|
|
</li>
|
|
<li><a href="#org9ccbf4c">6. Optimal And Robust Sensor Fusion in Practice</a>
|
|
<ul>
|
|
<li><a href="#orgb47b99b">6.1. Measurement of the noise characteristics of the sensors</a>
|
|
<ul>
|
|
<li><a href="#org5bec3bd">6.1.1. Huddle Test</a></li>
|
|
<li><a href="#org9b36860">6.1.2. Weights that represents the noises' PSD</a></li>
|
|
<li><a href="#orgcaad5c7">6.1.3. Comparison of the noises' PSD</a></li>
|
|
<li><a href="#org516acb4">6.1.4. Computation of the coherence, power spectral density and cross spectral density of signals</a></li>
|
|
</ul>
|
|
</li>
|
|
<li><a href="#org3b36d5b">6.2. Estimate the dynamic uncertainty of the sensors</a></li>
|
|
<li><a href="#org78e12d1">6.3. Optimal and Robust synthesis of the complementary filters</a></li>
|
|
</ul>
|
|
</li>
|
|
<li><a href="#org5241fc0">7. Methods of complementary filter synthesis</a>
|
|
<ul>
|
|
<li><a href="#org6450493">7.1. Complementary filters using analytical formula</a>
|
|
<ul>
|
|
<li><a href="#org3e91cf8">7.1.1. Analytical 1st order complementary filters</a></li>
|
|
<li><a href="#org6e195db">7.1.2. Second Order Complementary Filters</a></li>
|
|
<li><a href="#org038e979">7.1.3. Third Order Complementary Filters</a></li>
|
|
</ul>
|
|
</li>
|
|
<li><a href="#org3e0bda3">7.2. H-Infinity synthesis of complementary filters</a>
|
|
<ul>
|
|
<li><a href="#orgd3f44dd">7.2.1. Synthesis Architecture</a></li>
|
|
<li><a href="#org3d3c117">7.2.2. Weights</a></li>
|
|
<li><a href="#orgbc7f25c">7.2.3. H-Infinity Synthesis</a></li>
|
|
<li><a href="#org6ceb811">7.2.4. Obtained Complementary Filters</a></li>
|
|
</ul>
|
|
</li>
|
|
<li><a href="#org3592282">7.3. Feedback Control Architecture to generate Complementary Filters</a>
|
|
<ul>
|
|
<li><a href="#orga8706fd">7.3.1. Architecture</a></li>
|
|
<li><a href="#org733ed6c">7.3.2. Loop Gain Design</a></li>
|
|
<li><a href="#orga0835dc">7.3.3. Complementary Filters Obtained</a></li>
|
|
</ul>
|
|
</li>
|
|
<li><a href="#orgcec1071">7.4. Analytical Formula found in the literature</a>
|
|
<ul>
|
|
<li><a href="#orgc8af80a">7.4.1. Analytical Formula</a></li>
|
|
<li><a href="#org0e2cc35">7.4.2. Matlab</a></li>
|
|
<li><a href="#orga267e9d">7.4.3. Discussion</a></li>
|
|
</ul>
|
|
</li>
|
|
<li><a href="#orgfc3780b">7.5. Comparison of the different methods of synthesis</a></li>
|
|
</ul>
|
|
</li>
|
|
</ul>
|
|
</div>
|
|
</div>
|
|
|
|
<p>
|
|
In this document, the optimal and robust design of complementary filters is studied.
|
|
</p>
|
|
|
|
<p>
|
|
Two sensors are considered with both different noise characteristics and dynamical uncertainties represented by multiplicative input uncertainty.
|
|
</p>
|
|
|
|
<ul class="org-ul">
|
|
<li>in section <a href="#org02dee07">1</a>: the \(\mathcal{H}_2\) synthesis is used to design complementary filters such that the RMS value of the super sensor's noise is minimized</li>
|
|
<li>in section <a href="#org707f0a1">2</a>: the \(\mathcal{H}_\infty\) synthesis is used to design complementary filters such that the super sensor's uncertainty is bonded to acceptable values</li>
|
|
<li>in section <a href="#org51e3caa">3</a>: the mixed \(\mathcal{H}_2/\mathcal{H}_\infty\) synthesis is used to both limit the super sensor's uncertainty and to lower the RMS value of the super sensor's noise</li>
|
|
<li>in section <a href="#org474865c">4</a>: the \(\mathcal{H}_\infty\) synthesis is used for both limiting the noise and uncertainty of the super sensor</li>
|
|
<li>in section <a href="#orge2278c6">5</a>: we try to find the characteristics of the super sensor from the characteristics of the individual sensors and of the complementary filters</li>
|
|
<li>in section <a href="#org51d0428">6</a>: a methodology is proposed to apply optimal and robust sensor fusion in practice</li>
|
|
<li>in section <a href="#orgc984e6e">7</a>: methods of complementary filter synthesis are proposed</li>
|
|
</ul>
|
|
|
|
<div id="outline-container-org6a5ea1e" class="outline-2">
|
|
<h2 id="org6a5ea1e"><span class="section-number-2">1</span> Optimal Sensor Fusion - Minimize the Super Sensor Noise</h2>
|
|
<div class="outline-text-2" id="text-1">
|
|
<p>
|
|
<a id="org02dee07"></a>
|
|
</p>
|
|
<p>
|
|
The idea is to combine sensors that works in different frequency range using complementary filters.
|
|
</p>
|
|
|
|
<p>
|
|
Doing so, one "super sensor" is obtained that can have better noise characteristics than the individual sensors over a large frequency range.
|
|
</p>
|
|
|
|
<p>
|
|
The complementary filters have to be designed in order to minimize the effect noise of each sensor on the super sensor noise.
|
|
</p>
|
|
<div class="note">
|
|
<p>
|
|
The Matlab scripts is accessible <a href="matlab/optimal_comp_filters.m">here</a>.
|
|
</p>
|
|
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgfc35b50" class="outline-3">
|
|
<h3 id="orgfc35b50"><span class="section-number-3">1.1</span> Architecture</h3>
|
|
<div class="outline-text-3" id="text-1-1">
|
|
<p>
|
|
Let's consider the sensor fusion architecture shown on figure <a href="#orgd2264d9">1</a> where two sensors (sensor 1 and sensor 2) are measuring the same quantity \(x\) with different noise characteristics determined by \(N_1(s)\) and \(N_2(s)\).
|
|
</p>
|
|
|
|
<p>
|
|
\(\tilde{n}_1\) and \(\tilde{n}_2\) are normalized white noise:
|
|
</p>
|
|
\begin{equation}
|
|
\label{org426d18d}
|
|
\Phi_{\tilde{n}_1}(\omega) = \Phi_{\tilde{n}_1}(\omega) = 1
|
|
\end{equation}
|
|
|
|
|
|
<div id="orgd2264d9" class="figure">
|
|
<p><img src="figs-tikz/fusion_two_noisy_sensors_weights.png" alt="fusion_two_noisy_sensors_weights.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 1: </span>Fusion of two sensors</p>
|
|
</div>
|
|
|
|
<p>
|
|
We consider that the two sensor dynamics \(G_1(s)\) and \(G_2(s)\) are ideal:
|
|
</p>
|
|
\begin{equation}
|
|
\label{org87788f0}
|
|
G_1(s) = G_2(s) = 1
|
|
\end{equation}
|
|
|
|
<p>
|
|
We obtain the architecture of figure <a href="#org840ea03">2</a>.
|
|
</p>
|
|
|
|
|
|
<div id="org840ea03" class="figure">
|
|
<p><img src="figs-tikz/sensor_fusion_noisy_perfect_dyn.png" alt="sensor_fusion_noisy_perfect_dyn.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 2: </span>Fusion of two sensors with ideal dynamics</p>
|
|
</div>
|
|
|
|
<p>
|
|
\(H_1(s)\) and \(H_2(s)\) are complementary filters:
|
|
</p>
|
|
\begin{equation}
|
|
\label{orga37fb32}
|
|
H_1(s) + H_2(s) = 1
|
|
\end{equation}
|
|
|
|
<p>
|
|
The goal is to design \(H_1(s)\) and \(H_2(s)\) such that the effect of the noise sources \(\tilde{n}_1\) and \(\tilde{n}_2\) has the smallest possible effect on the estimation \(\hat{x}\).
|
|
</p>
|
|
|
|
<p>
|
|
We have that the Power Spectral Density (PSD) of \(\hat{x}\) is:
|
|
\[ \Phi_{\hat{x}}(\omega) = |H_1(j\omega) N_1(j\omega)|^2 \Phi_{\tilde{n}_1}(\omega) + |H_2(j\omega) N_2(j\omega)|^2 \Phi_{\tilde{n}_2}(\omega), \quad \forall \omega \]
|
|
</p>
|
|
|
|
<p>
|
|
And the goal is the minimize the Root Mean Square (RMS) value of \(\hat{x}\):
|
|
</p>
|
|
\begin{equation}
|
|
\label{orga3c4135}
|
|
\sigma_{\hat{x}} = \sqrt{\int_0^\infty \Phi_{\hat{x}}(\omega) d\omega}
|
|
\end{equation}
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org791316d" class="outline-3">
|
|
<h3 id="org791316d"><span class="section-number-3">1.2</span> Noise of the sensors</h3>
|
|
<div class="outline-text-3" id="text-1-2">
|
|
<p>
|
|
Let's define the noise characteristics of the two sensors by choosing \(N_1\) and \(N_2\):
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>Sensor 1 characterized by \(N_1(s)\) has low noise at low frequency (for instance a geophone)</li>
|
|
<li>Sensor 2 characterized by \(N_2(s)\) has low noise at high frequency (for instance an accelerometer)</li>
|
|
</ul>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">omegac = <span class="org-highlight-numbers-number">100</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>; G0 = <span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">5</span>; Ginf = <span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">4</span>;
|
|
N1 = <span class="org-rainbow-delimiters-depth-1">(</span>Ginf<span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> G0<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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</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-highlight-numbers-number">1</span> <span class="org-type">+</span> s<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">100</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
omegac = <span class="org-highlight-numbers-number">1</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>; G0 = <span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">3</span>; Ginf = <span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">8</span>;
|
|
N2 = <span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">(</span>sqrt<span class="org-rainbow-delimiters-depth-3">(</span>Ginf<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> sqrt<span class="org-rainbow-delimiters-depth-3">(</span>G0<span class="org-rainbow-delimiters-depth-3">)</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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">)</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-1">(</span><span class="org-highlight-numbers-number">1</span> <span class="org-type">+</span> s<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">4000</span><span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">2</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="orgb9aa49d" class="figure">
|
|
<p><img src="figs/noise_characteristics_sensors.png" alt="noise_characteristics_sensors.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 3: </span>Noise Characteristics of the two sensors (<a href="./figs/noise_characteristics_sensors.png">png</a>, <a href="./figs/noise_characteristics_sensors.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgef7f268" class="outline-3">
|
|
<h3 id="orgef7f268"><span class="section-number-3">1.3</span> H-Two Synthesis</h3>
|
|
<div class="outline-text-3" id="text-1-3">
|
|
<p>
|
|
As \(\tilde{n}_1\) and \(\tilde{n}_2\) are normalized white noise: \(\Phi_{\tilde{n}_1}(\omega) = \Phi_{\tilde{n}_2}(\omega) = 1\) and we have:
|
|
\[ \sigma_{\hat{x}} = \sqrt{\int_0^\infty |H_1 N_1|^2(\omega) + |H_2 N_2|^2(\omega) d\omega} = \left\| \begin{matrix} H_1 N_1 \\ H_2 N_2 \end{matrix} \right\|_2 \]
|
|
Thus, the goal is to design \(H_1(s)\) and \(H_2(s)\) such that \(H_1(s) + H_2(s) = 1\) and such that \(\left\| \begin{matrix} H_1 N_1 \\ H_2 N_2 \end{matrix} \right\|_2\) is minimized.
|
|
</p>
|
|
|
|
<p>
|
|
For that, we use the \(\mathcal{H}_2\) Synthesis.
|
|
</p>
|
|
|
|
<p>
|
|
We use the generalized plant architecture shown on figure <a href="#org4d47519">4</a>.
|
|
</p>
|
|
|
|
|
|
<div id="org4d47519" class="figure">
|
|
<p><img src="figs-tikz/h_infinity_optimal_comp_filters.png" alt="h_infinity_optimal_comp_filters.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 4: </span>\(\mathcal{H}_2\) Synthesis - Generalized plant used for the optimal generation of complementary filters</p>
|
|
</div>
|
|
|
|
\begin{equation*}
|
|
\begin{pmatrix}
|
|
z \\ v
|
|
\end{pmatrix} = \begin{pmatrix}
|
|
0 & N_2 & 1 \\
|
|
N_1 & -N_2 & 0
|
|
\end{pmatrix} \begin{pmatrix}
|
|
w_1 \\ w_2 \\ u
|
|
\end{pmatrix}
|
|
\end{equation*}
|
|
|
|
<p>
|
|
The transfer function from \([n_1, n_2]\) to \(\hat{x}\) is:
|
|
\[ \begin{bmatrix} N_1 H_1 \\ N_2 (1 - H_1) \end{bmatrix} \]
|
|
If we define \(H_2 = 1 - H_1\), we obtain:
|
|
\[ \begin{bmatrix} N_1 H_1 \\ N_2 H_2 \end{bmatrix} \]
|
|
</p>
|
|
|
|
<p>
|
|
Thus, if we minimize the \(\mathcal{H}_2\) norm of this transfer function, we minimize the RMS value of \(\hat{x}\).
|
|
</p>
|
|
|
|
<p>
|
|
We define the generalized plant \(P\) on matlab as shown on figure <a href="#org4d47519">4</a>.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">P = <span class="org-rainbow-delimiters-depth-1">[</span><span class="org-highlight-numbers-number">0</span> N2 <span class="org-highlight-numbers-number">1</span>;
|
|
N1 <span class="org-type">-</span>N2 <span class="org-highlight-numbers-number">0</span><span class="org-rainbow-delimiters-depth-1">]</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
And we do the \(\mathcal{H}_2\) synthesis using the <code>h2syn</code> command.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab"><span class="org-rainbow-delimiters-depth-1">[</span>H1, <span class="org-type">~</span>, gamma<span class="org-rainbow-delimiters-depth-1">]</span> = h2syn<span class="org-rainbow-delimiters-depth-1">(</span>P, <span class="org-highlight-numbers-number">1</span>, <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
Finally, we define \(H_2(s) = 1 - H_1(s)\).
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">H2 = <span class="org-highlight-numbers-number">1</span> <span class="org-type">-</span> H1;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
The complementary filters obtained are shown on figure <a href="#org09891eb">5</a>.
|
|
</p>
|
|
|
|
<p>
|
|
The PSD of the noise of the individual sensor and of the super sensor are shown in Fig. <a href="#orgafaa1c1">6</a>.
|
|
</p>
|
|
|
|
<p>
|
|
The Cumulative Power Spectrum (CPS) is shown on Fig. <a href="#org6e37b90">7</a>.
|
|
</p>
|
|
|
|
<p>
|
|
The obtained RMS value of the super sensor is lower than the RMS value of the individual sensors.
|
|
</p>
|
|
|
|
|
|
<div id="org09891eb" class="figure">
|
|
<p><img src="figs/htwo_comp_filters.png" alt="htwo_comp_filters.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 5: </span>Obtained complementary filters using the \(\mathcal{H}_2\) Synthesis (<a href="./figs/htwo_comp_filters.png">png</a>, <a href="./figs/htwo_comp_filters.pdf">pdf</a>)</p>
|
|
</div>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">PSD_S1 = abs<span class="org-rainbow-delimiters-depth-1">(</span>squeeze<span class="org-rainbow-delimiters-depth-2">(</span>freqresp<span class="org-rainbow-delimiters-depth-3">(</span>N1, freqs, <span class="org-string">'Hz'</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-type">.^</span><span class="org-highlight-numbers-number">2</span>;
|
|
PSD_S2 = abs<span class="org-rainbow-delimiters-depth-1">(</span>squeeze<span class="org-rainbow-delimiters-depth-2">(</span>freqresp<span class="org-rainbow-delimiters-depth-3">(</span>N2, freqs, <span class="org-string">'Hz'</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-type">.^</span><span class="org-highlight-numbers-number">2</span>;
|
|
PSD_H2 = abs<span class="org-rainbow-delimiters-depth-1">(</span>squeeze<span class="org-rainbow-delimiters-depth-2">(</span>freqresp<span class="org-rainbow-delimiters-depth-3">(</span>N1<span class="org-type">*</span>H1, freqs, 'Hz'<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-type">.^</span><span class="org-highlight-numbers-number">2</span><span class="org-type">+</span>abs<span class="org-rainbow-delimiters-depth-1">(</span>squeeze<span class="org-rainbow-delimiters-depth-2">(</span>freqresp<span class="org-rainbow-delimiters-depth-3">(</span>N2<span class="org-type">*</span>H2, freqs, 'Hz'<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-type">.^</span><span class="org-highlight-numbers-number">2</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="orgafaa1c1" class="figure">
|
|
<p><img src="figs/psd_sensors_htwo_synthesis.png" alt="psd_sensors_htwo_synthesis.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 6: </span>Power Spectral Density of the estimated \(\hat{x}\) using the two sensors alone and using the optimally fused signal (<a href="./figs/psd_sensors_htwo_synthesis.png">png</a>, <a href="./figs/psd_sensors_htwo_synthesis.pdf">pdf</a>)</p>
|
|
</div>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">CPS_S1 = <span class="org-highlight-numbers-number">1</span><span class="org-type">/</span><span class="org-constant">pi</span><span class="org-type">*</span>cumtrapz<span class="org-rainbow-delimiters-depth-1">(</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>freqs, PSD_S1<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
CPS_S2 = <span class="org-highlight-numbers-number">1</span><span class="org-type">/</span><span class="org-constant">pi</span><span class="org-type">*</span>cumtrapz<span class="org-rainbow-delimiters-depth-1">(</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>freqs, PSD_S2<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
CPS_H2 = <span class="org-highlight-numbers-number">1</span><span class="org-type">/</span><span class="org-constant">pi</span><span class="org-type">*</span>cumtrapz<span class="org-rainbow-delimiters-depth-1">(</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>freqs, PSD_H2<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="org6e37b90" class="figure">
|
|
<p><img src="figs/cps_h2_synthesis.png" alt="cps_h2_synthesis.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 7: </span>Cumulative Power Spectrum of individual sensors and super sensor using the \(\mathcal{H}_2\) synthesis (<a href="./figs/cps_h2_synthesis.png">png</a>, <a href="./figs/cps_h2_synthesis.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org50fb2c6" class="outline-3">
|
|
<h3 id="org50fb2c6"><span class="section-number-3">1.4</span> Alternative H-Two Synthesis</h3>
|
|
<div class="outline-text-3" id="text-1-4">
|
|
<p>
|
|
An alternative Alternative formulation of the \(\mathcal{H}_2\) synthesis is shown in Fig. <a href="#orgef95590">8</a>.
|
|
</p>
|
|
|
|
|
|
<div id="orgef95590" class="figure">
|
|
<p><img src="figs-tikz/h_infinity_optimal_comp_filters_bis.png" alt="h_infinity_optimal_comp_filters_bis.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 8: </span>Alternative formulation of the \(\mathcal{H}_2\) synthesis</p>
|
|
</div>
|
|
|
|
\begin{equation*}
|
|
\begin{pmatrix}
|
|
z_1 \\ z_2 \\ v
|
|
\end{pmatrix} = \begin{pmatrix}
|
|
N_1 & -N_1 \\
|
|
0 & N_2 \\
|
|
1 & 0
|
|
\end{pmatrix} \begin{pmatrix}
|
|
w \\ u
|
|
\end{pmatrix}
|
|
\end{equation*}
|
|
</div>
|
|
</div>
|
|
|
|
|
|
<div id="outline-container-org1d306e7" class="outline-3">
|
|
<h3 id="org1d306e7"><span class="section-number-3">1.5</span> H-Infinity Synthesis - method A</h3>
|
|
<div class="outline-text-3" id="text-1-5">
|
|
<p>
|
|
Another objective that we may have is that the noise of the super sensor \(n_{SS}\) is following the minimum of the noise of the two sensors \(n_1\) and \(n_2\):
|
|
\[ \Gamma_{n_{ss}}(\omega) = \min(\Gamma_{n_1}(\omega),\ \Gamma_{n_2}(\omega)) \]
|
|
</p>
|
|
|
|
<p>
|
|
In order to obtain that ideal case, we need that the complementary filters be designed such that:
|
|
</p>
|
|
\begin{align*}
|
|
& |H_1(j\omega)| = 1 \text{ and } |H_2(j\omega)| = 0 \text{ at frequencies where } \Gamma_{n_1}(\omega) < \Gamma_{n_2}(\omega) \\
|
|
& |H_1(j\omega)| = 0 \text{ and } |H_2(j\omega)| = 1 \text{ at frequencies where } \Gamma_{n_1}(\omega) > \Gamma_{n_2}(\omega)
|
|
\end{align*}
|
|
|
|
<p>
|
|
Which is indeed impossible in practice.
|
|
</p>
|
|
|
|
<p>
|
|
We could try to approach that with the \(\mathcal{H}_\infty\) synthesis by using high order filters.
|
|
</p>
|
|
|
|
<p>
|
|
As shown on Fig. <a href="#orgb9aa49d">3</a>, the frequency where the two sensors have the same noise level is around 9Hz.
|
|
We will thus choose weighting functions such that the merging frequency is around 9Hz.
|
|
</p>
|
|
|
|
<p>
|
|
The weighting functions used as well as the obtained complementary filters are shown in Fig. <a href="#org10af2cc">9</a>.
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">n = <span class="org-highlight-numbers-number">5</span>; w0 = <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">10</span>; G0 = <span class="org-highlight-numbers-number">1</span><span class="org-type">/</span><span class="org-highlight-numbers-number">10</span>; G1 = <span class="org-highlight-numbers-number">10000</span>; Gc = <span class="org-highlight-numbers-number">1</span><span class="org-type">/</span><span class="org-highlight-numbers-number">2</span>;
|
|
W1a = <span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>sqrt<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>Gc<span class="org-type">/</span>G1<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>s <span class="org-type">+</span> <span class="org-rainbow-delimiters-depth-3">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>G1<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>sqrt<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>Gc<span class="org-type">/</span>G1<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>s <span class="org-type">+</span> <span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<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-type">^</span>n;
|
|
|
|
n = <span class="org-highlight-numbers-number">5</span>; w0 = <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">8</span>; G0 = <span class="org-highlight-numbers-number">1000</span>; G1 = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">1</span>; Gc = <span class="org-highlight-numbers-number">1</span><span class="org-type">/</span><span class="org-highlight-numbers-number">2</span>;
|
|
W2a = <span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>sqrt<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>Gc<span class="org-type">/</span>G1<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>s <span class="org-type">+</span> <span class="org-rainbow-delimiters-depth-3">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>G1<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>sqrt<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>Gc<span class="org-type">/</span>G1<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>s <span class="org-type">+</span> <span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<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-type">^</span>n;
|
|
</pre>
|
|
</div>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">P = <span class="org-rainbow-delimiters-depth-1">[</span>W1a <span class="org-type">-</span>W1a;
|
|
<span class="org-highlight-numbers-number">0</span> W2a;
|
|
<span class="org-highlight-numbers-number">1</span> <span class="org-highlight-numbers-number">0</span><span class="org-rainbow-delimiters-depth-1">]</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
And we do the \(\mathcal{H}_\infty\) synthesis using the <code>hinfsyn</code> command.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab"><span class="org-rainbow-delimiters-depth-1">[</span>H2a, <span class="org-type">~</span>, gamma, <span class="org-type">~</span><span class="org-rainbow-delimiters-depth-1">]</span> = hinfsyn<span class="org-rainbow-delimiters-depth-1">(</span>P, <span class="org-highlight-numbers-number">1</span>, <span class="org-highlight-numbers-number">1</span>,'TOLGAM', <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">001</span>, 'METHOD', 'ric', 'DISPLAY', 'on'<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<pre class="example">
|
|
[H2a, ~, gamma, ~] = hinfsyn(P, 1, 1,'TOLGAM', 0.001, 'METHOD', 'ric', 'DISPLAY', 'on');
|
|
Resetting value of Gamma min based on D_11, D_12, D_21 terms
|
|
|
|
Test bounds: 0.1000 < gamma <= 10500.0000
|
|
|
|
gamma hamx_eig xinf_eig hamy_eig yinf_eig nrho_xy p/f
|
|
1.050e+04 2.1e+01 -3.0e-07 7.8e+00 -1.3e-15 0.0000 p
|
|
5.250e+03 2.1e+01 -1.5e-08 7.8e+00 -5.8e-14 0.0000 p
|
|
2.625e+03 2.1e+01 2.5e-10 7.8e+00 -3.7e-12 0.0000 p
|
|
1.313e+03 2.1e+01 -3.2e-11 7.8e+00 -7.3e-14 0.0000 p
|
|
656.344 2.1e+01 -2.2e-10 7.8e+00 -1.1e-15 0.0000 p
|
|
328.222 2.1e+01 -1.1e-10 7.8e+00 -1.2e-15 0.0000 p
|
|
164.161 2.1e+01 -2.4e-08 7.8e+00 -8.9e-16 0.0000 p
|
|
82.130 2.1e+01 2.0e-10 7.8e+00 -9.1e-31 0.0000 p
|
|
41.115 2.1e+01 -6.8e-09 7.8e+00 -4.1e-13 0.0000 p
|
|
20.608 2.1e+01 3.3e-10 7.8e+00 -1.4e-12 0.0000 p
|
|
10.354 2.1e+01 -9.8e-09 7.8e+00 -1.8e-15 0.0000 p
|
|
5.227 2.1e+01 -4.1e-09 7.8e+00 -2.5e-12 0.0000 p
|
|
2.663 2.1e+01 2.7e-10 7.8e+00 -4.0e-14 0.0000 p
|
|
1.382 2.1e+01 -3.2e+05# 7.8e+00 -3.5e-14 0.0000 f
|
|
2.023 2.1e+01 -5.0e-10 7.8e+00 0.0e+00 0.0000 p
|
|
1.702 2.1e+01 -2.4e+07# 7.8e+00 -1.6e-13 0.0000 f
|
|
1.862 2.1e+01 -6.0e+08# 7.8e+00 -1.0e-12 0.0000 f
|
|
1.942 2.1e+01 -2.8e-09 7.8e+00 -8.1e-14 0.0000 p
|
|
1.902 2.1e+01 -2.5e-09 7.8e+00 -1.1e-13 0.0000 p
|
|
1.882 2.1e+01 -9.3e-09 7.8e+00 -2.0e-15 0.0001 p
|
|
1.872 2.1e+01 -1.3e+09# 7.8e+00 -3.6e-22 0.0000 f
|
|
1.877 2.1e+01 -2.6e+09# 7.8e+00 -1.2e-13 0.0000 f
|
|
1.880 2.1e+01 -5.6e+09# 7.8e+00 -1.4e-13 0.0000 f
|
|
1.881 2.1e+01 -1.2e+10# 7.8e+00 -3.3e-12 0.0000 f
|
|
1.882 2.1e+01 -3.2e+10# 7.8e+00 -8.5e-14 0.0001 f
|
|
|
|
Gamma value achieved: 1.8824
|
|
</pre>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">H1a = <span class="org-highlight-numbers-number">1</span> <span class="org-type">-</span> H2a;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="org10af2cc" class="figure">
|
|
<p><img src="figs/weights_comp_filters_Hinfa.png" alt="weights_comp_filters_Hinfa.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 9: </span>Weights and Complementary Fitlers obtained (<a href="./figs/weights_comp_filters_Hinfa.png">png</a>, <a href="./figs/weights_comp_filters_Hinfa.pdf">pdf</a>)</p>
|
|
</div>
|
|
|
|
<p>
|
|
We then compute the Power Spectral Density as well as the Cumulative Power Spectrum.
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">PSD_Ha = abs<span class="org-rainbow-delimiters-depth-1">(</span>squeeze<span class="org-rainbow-delimiters-depth-2">(</span>freqresp<span class="org-rainbow-delimiters-depth-3">(</span>N1<span class="org-type">*</span>H1a, freqs, 'Hz'<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-type">.^</span><span class="org-highlight-numbers-number">2</span><span class="org-type">+</span>abs<span class="org-rainbow-delimiters-depth-1">(</span>squeeze<span class="org-rainbow-delimiters-depth-2">(</span>freqresp<span class="org-rainbow-delimiters-depth-3">(</span>N2<span class="org-type">*</span>H2a, freqs, 'Hz'<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-type">.^</span><span class="org-highlight-numbers-number">2</span>;
|
|
CPS_Ha = <span class="org-highlight-numbers-number">1</span><span class="org-type">/</span><span class="org-constant">pi</span><span class="org-type">*</span>cumtrapz<span class="org-rainbow-delimiters-depth-1">(</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>freqs, PSD_Ha<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org12cdd85" class="outline-3">
|
|
<h3 id="org12cdd85"><span class="section-number-3">1.6</span> H-Infinity Synthesis - method B</h3>
|
|
<div class="outline-text-3" id="text-1-6">
|
|
<p>
|
|
We have that:
|
|
\[ \Phi_{\hat{x}}(\omega) = \left|H_1(j\omega) N_1(j\omega)\right|^2 + \left|H_2(j\omega) N_2(j\omega)\right|^2 \]
|
|
</p>
|
|
|
|
<p>
|
|
Then, at frequencies where \(|H_1(j\omega)| < |H_2(j\omega)|\) we would like that \(|N_1(j\omega)| = 1\) and \(|N_2(j\omega)| = 0\) as we discussed before.
|
|
Then \(|H_1 N_1|^2 + |H_2 N_2|^2 = |N_1|^2\).
|
|
</p>
|
|
|
|
<p>
|
|
We know that this is impossible in practice. A more realistic choice is to design \(H_2(s)\) such that when \(|N_2(j\omega)| > |N_1(j\omega)|\), we have that:
|
|
\[ |H_2 N_2|^2 = \epsilon |H_1 N_1|^2 \]
|
|
</p>
|
|
|
|
<p>
|
|
Which is equivalent to have (by supposing \(|H_1| \approx 1\)):
|
|
\[ |H_2| = \sqrt{\epsilon} \frac{|N_1|}{|N_2|} \]
|
|
</p>
|
|
|
|
<p>
|
|
And we have:
|
|
</p>
|
|
\begin{align*}
|
|
\Phi_{\hat{x}} &= \left|H_1 N_1\right|^2 + |H_2 N_2|^2 \\
|
|
&= (1 + \epsilon) \left| H_1 N_1 \right|^2 \\
|
|
&\approx \left|N_1\right|^2
|
|
\end{align*}
|
|
|
|
<p>
|
|
Similarly, we design \(H_1(s)\) such that at frequencies where \(|N_1| > |N_2|\):
|
|
\[ |H_1| = \sqrt{\epsilon} \frac{|N_2|}{|N_1|} \]
|
|
</p>
|
|
|
|
<p>
|
|
For instance, is we take \(\epsilon = 1\), then the PSD of \(\hat{x}\) is increased by just by a factor \(\sqrt{2}\) over the all frequencies from the idea case.
|
|
</p>
|
|
|
|
<p>
|
|
We use this as the weighting functions for the \(\mathcal{H}_\infty\) synthesis of the complementary filters.
|
|
</p>
|
|
|
|
<p>
|
|
The weighting function and the obtained complementary filters are shown in Fig. <a href="#org21b99ba">10</a>.
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">epsilon = <span class="org-highlight-numbers-number">2</span>;
|
|
|
|
W1b = <span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>epsilon<span class="org-type">*</span>N1<span class="org-type">/</span>N2;
|
|
W2b = <span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>epsilon<span class="org-type">*</span>N2<span class="org-type">/</span>N1;
|
|
|
|
W1b = W1b<span class="org-type">/</span><span class="org-rainbow-delimiters-depth-1">(</span><span class="org-highlight-numbers-number">1</span> <span class="org-type">+</span> s<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">1000</span><span class="org-rainbow-delimiters-depth-1">)</span>; <span class="org-comment">% this is added so that it is proper</span>
|
|
</pre>
|
|
</div>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">P = <span class="org-rainbow-delimiters-depth-1">[</span>W1b <span class="org-type">-</span>W1b;
|
|
<span class="org-highlight-numbers-number">0</span> W2b;
|
|
<span class="org-highlight-numbers-number">1</span> <span class="org-highlight-numbers-number">0</span><span class="org-rainbow-delimiters-depth-1">]</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
And we do the \(\mathcal{H}_\infty\) synthesis using the <code>hinfsyn</code> command.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab"><span class="org-rainbow-delimiters-depth-1">[</span>H2b, <span class="org-type">~</span>, gamma, <span class="org-type">~</span><span class="org-rainbow-delimiters-depth-1">]</span> = hinfsyn<span class="org-rainbow-delimiters-depth-1">(</span>P, <span class="org-highlight-numbers-number">1</span>, <span class="org-highlight-numbers-number">1</span>,'TOLGAM', <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">001</span>, 'METHOD', 'ric', 'DISPLAY', 'on'<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<pre class="example">
|
|
[H2b, ~, gamma, ~] = hinfsyn(P, 1, 1,'TOLGAM', 0.001, 'METHOD', 'ric', 'DISPLAY', 'on');
|
|
Test bounds: 0.0000 < gamma <= 32.8125
|
|
|
|
gamma hamx_eig xinf_eig hamy_eig yinf_eig nrho_xy p/f
|
|
32.812 1.8e+01 3.4e-10 6.3e+00 -2.9e-13 0.0000 p
|
|
16.406 1.8e+01 3.4e-10 6.3e+00 -1.2e-15 0.0000 p
|
|
8.203 1.8e+01 3.3e-10 6.3e+00 -2.6e-13 0.0000 p
|
|
4.102 1.8e+01 3.3e-10 6.3e+00 -2.1e-13 0.0000 p
|
|
2.051 1.7e+01 3.4e-10 6.3e+00 -7.2e-16 0.0000 p
|
|
1.025 1.6e+01 -1.3e+06# 6.3e+00 -8.3e-14 0.0000 f
|
|
1.538 1.7e+01 3.4e-10 6.3e+00 -2.0e-13 0.0000 p
|
|
1.282 1.7e+01 3.4e-10 6.3e+00 -7.9e-17 0.0000 p
|
|
1.154 1.7e+01 3.6e-10 6.3e+00 -1.8e-13 0.0000 p
|
|
1.089 1.7e+01 -3.4e+06# 6.3e+00 -1.7e-13 0.0000 f
|
|
1.122 1.7e+01 -1.0e+07# 6.3e+00 -3.2e-13 0.0000 f
|
|
1.138 1.7e+01 -1.3e+08# 6.3e+00 -1.8e-13 0.0000 f
|
|
1.146 1.7e+01 3.2e-10 6.3e+00 -3.0e-13 0.0000 p
|
|
1.142 1.7e+01 5.5e-10 6.3e+00 -2.8e-13 0.0000 p
|
|
1.140 1.7e+01 -1.5e-10 6.3e+00 -2.3e-13 0.0000 p
|
|
1.139 1.7e+01 -4.8e+08# 6.3e+00 -6.2e-14 0.0000 f
|
|
1.139 1.7e+01 1.3e-09 6.3e+00 -8.9e-17 0.0000 p
|
|
|
|
Gamma value achieved: 1.1390
|
|
</pre>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">H1b = <span class="org-highlight-numbers-number">1</span> <span class="org-type">-</span> H2b;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="org21b99ba" class="figure">
|
|
<p><img src="figs/weights_comp_filters_Hinfb.png" alt="weights_comp_filters_Hinfb.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 10: </span>Weights and Complementary Fitlers obtained (<a href="./figs/weights_comp_filters_Hinfb.png">png</a>, <a href="./figs/weights_comp_filters_Hinfb.pdf">pdf</a>)</p>
|
|
</div>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">PSD_Hb = abs<span class="org-rainbow-delimiters-depth-1">(</span>squeeze<span class="org-rainbow-delimiters-depth-2">(</span>freqresp<span class="org-rainbow-delimiters-depth-3">(</span>N1<span class="org-type">*</span>H1b, freqs, 'Hz'<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-type">.^</span><span class="org-highlight-numbers-number">2</span><span class="org-type">+</span>abs<span class="org-rainbow-delimiters-depth-1">(</span>squeeze<span class="org-rainbow-delimiters-depth-2">(</span>freqresp<span class="org-rainbow-delimiters-depth-3">(</span>N2<span class="org-type">*</span>H2b, freqs, 'Hz'<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-type">.^</span><span class="org-highlight-numbers-number">2</span>;
|
|
CPS_Hb = <span class="org-highlight-numbers-number">1</span><span class="org-type">/</span><span class="org-constant">pi</span><span class="org-type">*</span>cumtrapz<span class="org-rainbow-delimiters-depth-1">(</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>freqs, PSD_Hb<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org36e53f2" class="outline-3">
|
|
<h3 id="org36e53f2"><span class="section-number-3">1.7</span> H-Infinity Synthesis - method C</h3>
|
|
<div class="outline-text-3" id="text-1-7">
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">Wp = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">56</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-1">(</span>inv<span class="org-rainbow-delimiters-depth-2">(</span>N1<span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">+</span>inv<span class="org-rainbow-delimiters-depth-2">(</span>N2<span class="org-rainbow-delimiters-depth-2">)</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-highlight-numbers-number">1</span> <span class="org-type">+</span> s<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">1000</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
W1c = N1<span class="org-type">*</span>Wp;
|
|
W2c = N2<span class="org-type">*</span>Wp;
|
|
</pre>
|
|
</div>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">P = <span class="org-rainbow-delimiters-depth-1">[</span>W1c <span class="org-type">-</span>W1c;
|
|
<span class="org-highlight-numbers-number">0</span> W2c;
|
|
<span class="org-highlight-numbers-number">1</span> <span class="org-highlight-numbers-number">0</span><span class="org-rainbow-delimiters-depth-1">]</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
And we do the \(\mathcal{H}_\infty\) synthesis using the <code>hinfsyn</code> command.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab"><span class="org-rainbow-delimiters-depth-1">[</span>H2c, <span class="org-type">~</span>, gamma, <span class="org-type">~</span><span class="org-rainbow-delimiters-depth-1">]</span> = hinfsyn<span class="org-rainbow-delimiters-depth-1">(</span>P, <span class="org-highlight-numbers-number">1</span>, <span class="org-highlight-numbers-number">1</span>,'TOLGAM', <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">001</span>, 'METHOD', 'ric', 'DISPLAY', 'on'<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<pre class="example">
|
|
[H2c, ~, gamma, ~] = hinfsyn(P, 1, 1,'TOLGAM', 0.001, 'METHOD', 'ric', 'DISPLAY', 'on');
|
|
Test bounds: 0.0000 < gamma <= 36.7543
|
|
|
|
gamma hamx_eig xinf_eig hamy_eig yinf_eig nrho_xy p/f
|
|
36.754 5.7e+00 -1.0e-13 6.3e+00 -6.2e-25 0.0000 p
|
|
18.377 5.7e+00 -1.4e-12 6.3e+00 -1.8e-13 0.0000 p
|
|
9.189 5.7e+00 -4.3e-13 6.3e+00 -4.7e-15 0.0000 p
|
|
4.594 5.7e+00 -9.4e-13 6.3e+00 -4.7e-15 0.0000 p
|
|
2.297 5.7e+00 -1.3e-16 6.3e+00 -6.8e-14 0.0000 p
|
|
1.149 5.7e+00 -1.6e-17 6.3e+00 -1.5e-15 0.0000 p
|
|
0.574 5.7e+00 -5.2e+02# 6.3e+00 -5.9e-14 0.0000 f
|
|
0.861 5.7e+00 -3.1e+04# 6.3e+00 -3.8e-14 0.0000 f
|
|
1.005 5.7e+00 -1.6e-12 6.3e+00 -1.1e-14 0.0000 p
|
|
0.933 5.7e+00 -1.1e+05# 6.3e+00 -7.2e-14 0.0000 f
|
|
0.969 5.7e+00 -3.3e+05# 6.3e+00 -5.6e-14 0.0000 f
|
|
0.987 5.7e+00 -1.2e+06# 6.3e+00 -4.5e-15 0.0000 f
|
|
0.996 5.7e+00 -6.5e-16 6.3e+00 -1.7e-15 0.0000 p
|
|
0.992 5.7e+00 -2.9e+06# 6.3e+00 -6.1e-14 0.0000 f
|
|
0.994 5.7e+00 -9.7e+06# 6.3e+00 -3.0e-16 0.0000 f
|
|
0.995 5.7e+00 -8.0e-10 6.3e+00 -1.9e-13 0.0000 p
|
|
0.994 5.7e+00 -2.3e+07# 6.3e+00 -4.3e-14 0.0000 f
|
|
|
|
Gamma value achieved: 0.9949
|
|
</pre>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">H1c = <span class="org-highlight-numbers-number">1</span> <span class="org-type">-</span> H2c;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="org8161811" class="figure">
|
|
<p><img src="figs/weights_comp_filters_Hinfc.png" alt="weights_comp_filters_Hinfc.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 11: </span>Weights and Complementary Fitlers obtained (<a href="./figs/weights_comp_filters_Hinfc.png">png</a>, <a href="./figs/weights_comp_filters_Hinfc.pdf">pdf</a>)</p>
|
|
</div>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">PSD_Hc = abs<span class="org-rainbow-delimiters-depth-1">(</span>squeeze<span class="org-rainbow-delimiters-depth-2">(</span>freqresp<span class="org-rainbow-delimiters-depth-3">(</span>N1<span class="org-type">*</span>H1c, freqs, 'Hz'<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-type">.^</span><span class="org-highlight-numbers-number">2</span><span class="org-type">+</span>abs<span class="org-rainbow-delimiters-depth-1">(</span>squeeze<span class="org-rainbow-delimiters-depth-2">(</span>freqresp<span class="org-rainbow-delimiters-depth-3">(</span>N2<span class="org-type">*</span>H2c, freqs, 'Hz'<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-type">.^</span><span class="org-highlight-numbers-number">2</span>;
|
|
CPS_Hc = <span class="org-highlight-numbers-number">1</span><span class="org-type">/</span><span class="org-constant">pi</span><span class="org-type">*</span>cumtrapz<span class="org-rainbow-delimiters-depth-1">(</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>freqs, PSD_Hc<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgd63da98" class="outline-3">
|
|
<h3 id="orgd63da98"><span class="section-number-3">1.8</span> Comparison of the methods</h3>
|
|
<div class="outline-text-3" id="text-1-8">
|
|
<p>
|
|
The three methods are now compared.
|
|
</p>
|
|
|
|
<p>
|
|
The Power Spectral Density of the super sensors obtained with the complementary filters designed using the three methods are shown in Fig. <a href="#org44c7c2c">12</a>.
|
|
</p>
|
|
|
|
<p>
|
|
The Cumulative Power Spectrum for the same sensors are shown on Fig. <a href="#org348025f">13</a>.
|
|
</p>
|
|
|
|
<p>
|
|
The RMS value of the obtained super sensors are shown on table <a href="#orgc246ff3">1</a>.
|
|
</p>
|
|
|
|
<table id="orgc246ff3" border="2" cellspacing="0" cellpadding="6" rules="groups" frame="hsides">
|
|
<caption class="t-above"><span class="table-number">Table 1:</span> RMS value of the estimation error when using the sensor individually and when using the two sensor merged using the optimal complementary filters</caption>
|
|
|
|
<colgroup>
|
|
<col class="org-left" />
|
|
|
|
<col class="org-right" />
|
|
</colgroup>
|
|
<thead>
|
|
<tr>
|
|
<th scope="col" class="org-left"> </th>
|
|
<th scope="col" class="org-right">rms value</th>
|
|
</tr>
|
|
</thead>
|
|
<tbody>
|
|
<tr>
|
|
<td class="org-left">Sensor 1</td>
|
|
<td class="org-right">1.3e-03</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">Sensor 2</td>
|
|
<td class="org-right">1.3e-03</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">H2 Fusion</td>
|
|
<td class="org-right">1.2e-04</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">H-Infinity a</td>
|
|
<td class="org-right">2.4e-04</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">H-Infinity b</td>
|
|
<td class="org-right">1.4e-04</td>
|
|
</tr>
|
|
|
|
<tr>
|
|
<td class="org-left">H-Infinity c</td>
|
|
<td class="org-right">2.2e-04</td>
|
|
</tr>
|
|
</tbody>
|
|
</table>
|
|
|
|
|
|
|
|
<div id="org44c7c2c" class="figure">
|
|
<p><img src="figs/comparison_psd_noise.png" alt="comparison_psd_noise.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 12: </span>Comparison of the obtained Power Spectral Density using the three methods (<a href="./figs/comparison_psd_noise.png">png</a>, <a href="./figs/comparison_psd_noise.pdf">pdf</a>)</p>
|
|
</div>
|
|
|
|
|
|
<div id="org348025f" class="figure">
|
|
<p><img src="figs/comparison_cps_noise.png" alt="comparison_cps_noise.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 13: </span>Comparison of the obtained Cumulative Power Spectrum using the three methods (<a href="./figs/comparison_cps_noise.png">png</a>, <a href="./figs/comparison_cps_noise.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orge74ac09" class="outline-3">
|
|
<h3 id="orge74ac09"><span class="section-number-3">1.9</span> Obtained Super Sensor's noise uncertainty</h3>
|
|
<div class="outline-text-3" id="text-1-9">
|
|
<p>
|
|
We would like to verify if the obtained sensor fusion architecture is robust to change in the sensor dynamics.
|
|
</p>
|
|
|
|
<p>
|
|
To study the dynamical uncertainty on the super sensor, we defined some multiplicative uncertainty on both sensor dynamics.
|
|
Two weights \(w_1(s)\) and \(w_2(s)\) are used to described the amplitude of the dynamical uncertainty.
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">omegac = <span class="org-highlight-numbers-number">100</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>; G0 = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">1</span>; Ginf = <span class="org-highlight-numbers-number">10</span>;
|
|
w1 = <span class="org-rainbow-delimiters-depth-1">(</span>Ginf<span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> G0<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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
omegac = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">2</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>; G0 = <span class="org-highlight-numbers-number">5</span>; Ginf = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">1</span>;
|
|
w2 = <span class="org-rainbow-delimiters-depth-1">(</span>Ginf<span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> G0<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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
omegac = <span class="org-highlight-numbers-number">5000</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>; G0 = <span class="org-highlight-numbers-number">1</span>; Ginf = <span class="org-highlight-numbers-number">50</span>;
|
|
w2 = w2<span class="org-type">*</span><span class="org-rainbow-delimiters-depth-1">(</span>Ginf<span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> G0<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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
The sensor uncertain models are defined below.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">G1 = <span class="org-highlight-numbers-number">1</span> <span class="org-type">+</span> w1<span class="org-type">*</span>ultidyn<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-string">'Delta'</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><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
G2 = <span class="org-highlight-numbers-number">1</span> <span class="org-type">+</span> w2<span class="org-type">*</span>ultidyn<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-string">'Delta'</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><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
The super sensor uncertain model is defined below using the complementary filters obtained with the \(\mathcal{H}_2\) synthesis.
|
|
The dynamical uncertainty bounds of the super sensor is shown in Fig. <a href="#org8f6d8ae">14</a>.
|
|
Right Half Plane zero might be introduced in the super sensor dynamics which will render the feedback system unstable.
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">Gss = G1<span class="org-type">*</span>H1 <span class="org-type">+</span> G2<span class="org-type">*</span>H2;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="org8f6d8ae" class="figure">
|
|
<p><img src="figs/uncertainty_super_sensor_H2_syn.png" alt="uncertainty_super_sensor_H2_syn.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 14: </span>Uncertianty regions of both individual sensors and of the super sensor when using the \(\mathcal{H}_2\) synthesis (<a href="./figs/uncertainty_super_sensor_H2_syn.png">png</a>, <a href="./figs/uncertainty_super_sensor_H2_syn.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orga246751" class="outline-3">
|
|
<h3 id="orga246751"><span class="section-number-3">1.10</span> Conclusion</h3>
|
|
<div class="outline-text-3" id="text-1-10">
|
|
<p>
|
|
From the above complementary filter design with the \(\mathcal{H}_2\) and \(\mathcal{H}_\infty\) synthesis, it still seems that the \(\mathcal{H}_2\) synthesis gives the complementary filters that permits to obtain the minimal super sensor noise (when measuring with the \(\mathcal{H}_2\) norm).
|
|
</p>
|
|
|
|
<p>
|
|
However, the synthesis does not take into account the robustness of the sensor fusion.
|
|
</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgb4f295b" class="outline-2">
|
|
<h2 id="orgb4f295b"><span class="section-number-2">2</span> Optimal Sensor Fusion - Minimize the Super Sensor Dynamical Uncertainty</h2>
|
|
<div class="outline-text-2" id="text-2">
|
|
<p>
|
|
<a id="org707f0a1"></a>
|
|
</p>
|
|
<p>
|
|
We initially considered perfectly known sensor dynamics so that it can be perfectly inverted.
|
|
</p>
|
|
|
|
<p>
|
|
We now take into account the fact that the sensor dynamics is only partially known.
|
|
To do so, we model the uncertainty that we have on the sensor dynamics by multiplicative input uncertainty as shown in Fig. <a href="#org8a1f75c">15</a>.
|
|
</p>
|
|
|
|
|
|
<div id="org8a1f75c" class="figure">
|
|
<p><img src="figs-tikz/sensor_fusion_dynamic_uncertainty.png" alt="sensor_fusion_dynamic_uncertainty.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 15: </span>Sensor fusion architecture with sensor dynamics uncertainty</p>
|
|
</div>
|
|
|
|
<p>
|
|
The objective here is to design complementary filters \(H_1(s)\) and \(H_2(s)\) in order to minimize the dynamical uncertainty of the super sensor.
|
|
</p>
|
|
<div class="note">
|
|
<p>
|
|
The Matlab scripts is accessible <a href="matlab/comp_filter_robustness.m">here</a>.
|
|
</p>
|
|
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgdd8809b" class="outline-3">
|
|
<h3 id="orgdd8809b"><span class="section-number-3">2.1</span> Super Sensor Dynamical Uncertainty</h3>
|
|
<div class="outline-text-3" id="text-2-1">
|
|
<p>
|
|
In practical systems, the sensor dynamics has always some level of uncertainty.
|
|
Let's represent that with multiplicative input uncertainty as shown on figure <a href="#org8a1f75c">15</a>.
|
|
</p>
|
|
|
|
|
|
<div id="org54caa72" class="figure">
|
|
<p><img src="figs-tikz/sensor_fusion_dynamic_uncertainty.png" alt="sensor_fusion_dynamic_uncertainty.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 16: </span>Fusion of two sensors with input multiplicative uncertainty</p>
|
|
</div>
|
|
|
|
<p>
|
|
The dynamics of the super sensor is represented by
|
|
</p>
|
|
\begin{align*}
|
|
\frac{\hat{x}}{x} &= (1 + w_1 \Delta_1) H_1 + (1 + w_2 \Delta_2) H_2 \\
|
|
&= 1 + w_1 H_1 \Delta_1 + w_2 H_2 \Delta_2
|
|
\end{align*}
|
|
<p>
|
|
with \(\Delta_i\) is any transfer function satisfying \(\| \Delta_i \|_\infty < 1\).
|
|
</p>
|
|
|
|
<p>
|
|
We see that as soon as we have some uncertainty in the sensor dynamics, we have that the complementary filters have some effect on the transfer function from \(x\) to \(\hat{x}\).
|
|
</p>
|
|
|
|
<p>
|
|
The uncertainty set of the transfer function from \(\hat{x}\) to \(x\) at frequency \(\omega\) is bounded in the complex plane by a circle centered on 1 and with a radius equal to \(|w_1(j\omega) H_1(j\omega)| + |w_2(j\omega) H_2(j\omega)|\) (figure <a href="#orgc3b96ff">17</a>).
|
|
</p>
|
|
|
|
<p>
|
|
We then have that the angle introduced by the super sensor is bounded by \(\arcsin(\epsilon)\):
|
|
\[ \angle \frac{\hat{x}}{x}(j\omega) \le \arcsin \Big(|w_1(j\omega) H_1(j\omega)| + |w_2(j\omega) H_2(j\omega)|\Big) \]
|
|
</p>
|
|
|
|
|
|
<div id="orgc3b96ff" class="figure">
|
|
<p><img src="figs-tikz/uncertainty_gain_phase_variation.png" alt="uncertainty_gain_phase_variation.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 17: </span>Maximum phase variation</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org3597260" class="outline-3">
|
|
<h3 id="org3597260"><span class="section-number-3">2.2</span> Dynamical uncertainty of the individual sensors</h3>
|
|
<div class="outline-text-3" id="text-2-2">
|
|
<p>
|
|
Let say we want to merge two sensors:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>sensor 1 that has unknown dynamics above 10Hz: \(|w_1(j\omega)| > 1\) for \(\omega > 10\text{ Hz}\)</li>
|
|
<li>sensor 2 that has unknown dynamics below 1Hz and above 1kHz \(|w_2(j\omega)| > 1\) for \(\omega < 1\text{ Hz}\) and \(\omega > 1\text{ kHz}\)</li>
|
|
</ul>
|
|
|
|
<p>
|
|
We define the weights that are used to characterize the dynamic uncertainty of the sensors.
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">omegac = <span class="org-highlight-numbers-number">100</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>; G0 = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">1</span>; Ginf = <span class="org-highlight-numbers-number">10</span>;
|
|
w1 = <span class="org-rainbow-delimiters-depth-1">(</span>Ginf<span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> G0<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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
omegac = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">2</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>; G0 = <span class="org-highlight-numbers-number">5</span>; Ginf = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">1</span>;
|
|
w2 = <span class="org-rainbow-delimiters-depth-1">(</span>Ginf<span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> G0<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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
omegac = <span class="org-highlight-numbers-number">5000</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>; G0 = <span class="org-highlight-numbers-number">1</span>; Ginf = <span class="org-highlight-numbers-number">50</span>;
|
|
w2 = w2<span class="org-type">*</span><span class="org-rainbow-delimiters-depth-1">(</span>Ginf<span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> G0<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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
From the weights, we define the uncertain transfer functions of the sensors. Some of the uncertain dynamics of both sensors are shown on Fig. <a href="#org01a3be8">18</a> with the upper and lower bounds on the magnitude and on the phase.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">G1 = <span class="org-highlight-numbers-number">1</span> <span class="org-type">+</span> w1<span class="org-type">*</span>ultidyn<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-string">'Delta'</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><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
G2 = <span class="org-highlight-numbers-number">1</span> <span class="org-type">+</span> w2<span class="org-type">*</span>ultidyn<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-string">'Delta'</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><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="org01a3be8" class="figure">
|
|
<p><img src="figs/uncertainty_dynamics_sensors.png" alt="uncertainty_dynamics_sensors.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 18: </span>Dynamic uncertainty of the two sensors (<a href="./figs/uncertainty_dynamics_sensors.png">png</a>, <a href="./figs/uncertainty_dynamics_sensors.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orga6f0baf" class="outline-3">
|
|
<h3 id="orga6f0baf"><span class="section-number-3">2.3</span> Synthesis objective</h3>
|
|
<div class="outline-text-3" id="text-2-3">
|
|
<p>
|
|
The uncertainty region of the super sensor dynamics is represented by a circle in the complex plane as shown in Fig. <a href="#orgc3b96ff">17</a>.
|
|
</p>
|
|
|
|
<p>
|
|
At each frequency \(\omega\), the radius of the circle is \(|w_1(j\omega) H_1(j\omega)| + |w_2(j\omega) H_2(j\omega)|\).
|
|
</p>
|
|
|
|
<p>
|
|
Thus, the phase shift \(\Delta\phi(\omega)\) due to the super sensor uncertainty is bounded by:
|
|
\[ |\Delta\phi(\omega)| \leq \arcsin\big( |w_1(j\omega) H_1(j\omega)| + |w_2(j\omega) H_2(j\omega)| \big) \]
|
|
</p>
|
|
|
|
<p>
|
|
Let's define some allowed frequency depend phase shift \(\Delta\phi_\text{max}(\omega) > 0\) such that:
|
|
\[ |\Delta\phi(\omega)| < \Delta\phi_\text{max}(\omega), \quad \forall\omega \]
|
|
</p>
|
|
|
|
|
|
<p>
|
|
If \(H_1(s)\) and \(H_2(s)\) are designed such that
|
|
\[ |w_1(j\omega) H_1(j\omega)| + |w_2(j\omega) H_2(j\omega)| < \sin\big( \Delta\phi_\text{max}(\omega) \big) \]
|
|
</p>
|
|
|
|
<p>
|
|
The maximum phase shift due to dynamic uncertainty at frequency \(\omega\) will be \(\Delta\phi_\text{max}(\omega)\).
|
|
</p>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org071d7dd" class="outline-3">
|
|
<h3 id="org071d7dd"><span class="section-number-3">2.4</span> Requirements as an \(\mathcal{H}_\infty\) norm</h3>
|
|
<div class="outline-text-3" id="text-2-4">
|
|
<p>
|
|
We know try to express this requirement in terms of an \(\mathcal{H}_\infty\) norm.
|
|
</p>
|
|
|
|
<p>
|
|
Let's define one weight \(w_\phi(s)\) that represents the maximum wanted phase uncertainty:
|
|
\[ |w_{\phi}(j\omega)|^{-1} \approx \sin(\Delta\phi_{\text{max}}(\omega)), \quad \forall\omega \]
|
|
</p>
|
|
|
|
<p>
|
|
Then:
|
|
</p>
|
|
\begin{align*}
|
|
& |w_1(j\omega) H_1(j\omega)| + |w_2(j\omega) H_2(j\omega)| < \sin\big( \Delta\phi_\text{max}(\omega) \big), \quad \forall\omega \\
|
|
\Longleftrightarrow & |w_1(j\omega) H_1(j\omega)| + |w_2(j\omega) H_2(j\omega)| < |w_\phi(j\omega)|^{-1}, \quad \forall\omega \\
|
|
\Longleftrightarrow & \left| w_1(j\omega) H_1(j\omega) w_\phi(j\omega) \right| + \left| w_2(j\omega) H_2(j\omega) w_\phi(j\omega) \right| < 1, \quad \forall\omega
|
|
\end{align*}
|
|
|
|
<p>
|
|
Which is approximately equivalent to (with an error of maximum \(\sqrt{2}\)):
|
|
</p>
|
|
\begin{equation}
|
|
\label{org65dc6d4}
|
|
\left\| \begin{matrix} w_1(s) w_\phi(s) H_1(s) \\ w_2(s) w_\phi(s) H_2(s) \end{matrix} \right\|_\infty < 1
|
|
\end{equation}
|
|
|
|
<p>
|
|
One should not forget that at frequency where both sensors has unknown dynamics (\(|w_1(j\omega)| > 1\) and \(|w_2(j\omega)| > 1\)), the super sensor dynamics will also be unknown and the phase uncertainty cannot be bounded.
|
|
Thus, at these frequencies, \(|w_\phi|\) should be smaller than \(1\).
|
|
</p>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgf966f50" class="outline-3">
|
|
<h3 id="orgf966f50"><span class="section-number-3">2.5</span> Weighting Function used to bound the super sensor uncertainty</h3>
|
|
<div class="outline-text-3" id="text-2-5">
|
|
<p>
|
|
Let's define \(w_\phi(s)\) in order to bound the maximum allowed phase uncertainty \(\Delta\phi_\text{max}\) of the super sensor dynamics.
|
|
The magnitude \(|w_\phi(j\omega)|\) is shown in Fig. <a href="#orga27cba9">19</a> and the corresponding maximum allowed phase uncertainty of the super sensor dynamics of shown in Fig. <a href="#orgd938cba">20</a>.
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">Dphi = <span class="org-highlight-numbers-number">20</span>; <span class="org-comment">% [deg]</span>
|
|
|
|
n = <span class="org-highlight-numbers-number">4</span>; w0 = <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">900</span>; G0 = <span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>sin<span class="org-rainbow-delimiters-depth-1">(</span>Dphi<span class="org-type">*</span><span class="org-constant">pi</span><span class="org-type">/</span><span class="org-highlight-numbers-number">180</span><span class="org-rainbow-delimiters-depth-1">)</span>; Ginf = <span class="org-highlight-numbers-number">1</span><span class="org-type">/</span><span class="org-highlight-numbers-number">100</span>; Gc = <span class="org-highlight-numbers-number">1</span>;
|
|
wphi = <span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>sqrt<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>Gc<span class="org-type">/</span>Ginf<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>s <span class="org-type">+</span> <span class="org-rainbow-delimiters-depth-3">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>Ginf<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>sqrt<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>Gc<span class="org-type">/</span>Ginf<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>s <span class="org-type">+</span> <span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<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-type">^</span>n;
|
|
|
|
W1 = w1<span class="org-type">*</span>wphi;
|
|
W2 = w2<span class="org-type">*</span>wphi;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="orga27cba9" class="figure">
|
|
<p><img src="figs/magnitude_wphi.png" alt="magnitude_wphi.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 19: </span>Magnitude of the weght \(w_\phi(s)\) that is used to bound the uncertainty of the super sensor (<a href="./figs/magnitude_wphi.png">png</a>, <a href="./figs/magnitude_wphi.pdf">pdf</a>)</p>
|
|
</div>
|
|
|
|
|
|
<div id="orgd938cba" class="figure">
|
|
<p><img src="figs/maximum_wanted_phase_uncertainty.png" alt="maximum_wanted_phase_uncertainty.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 20: </span>Maximum wanted phase uncertainty using this weight (<a href="./figs/maximum_wanted_phase_uncertainty.png">png</a>, <a href="./figs/maximum_wanted_phase_uncertainty.pdf">pdf</a>)</p>
|
|
</div>
|
|
|
|
<p>
|
|
The obtained upper bounds on the complementary filters in order to limit the phase uncertainty of the super sensor are represented in Fig. <a href="#orgd57dd73">21</a>.
|
|
</p>
|
|
|
|
|
|
<div id="orgd57dd73" class="figure">
|
|
<p><img src="figs/upper_bounds_comp_filter_max_phase_uncertainty.png" alt="upper_bounds_comp_filter_max_phase_uncertainty.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 21: </span>Upper bounds on the complementary filters set in order to limit the maximum phase uncertainty of the super sensor to 30 degrees until 500Hz (<a href="./figs/upper_bounds_comp_filter_max_phase_uncertainty.png">png</a>, <a href="./figs/upper_bounds_comp_filter_max_phase_uncertainty.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org027208c" class="outline-3">
|
|
<h3 id="org027208c"><span class="section-number-3">2.6</span> \(\mathcal{H}_\infty\) Synthesis</h3>
|
|
<div class="outline-text-3" id="text-2-6">
|
|
<p>
|
|
The \(\mathcal{H}_\infty\) synthesis architecture used for the complementary filters is shown in Fig. <a href="#orgcd8d01c">22</a>.
|
|
</p>
|
|
|
|
|
|
<div id="orgcd8d01c" class="figure">
|
|
<p><img src="figs-tikz/h_infinity_robust_fusion.png" alt="h_infinity_robust_fusion.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 22: </span>Architecture used for \(\mathcal{H}_\infty\) synthesis of complementary filters</p>
|
|
</div>
|
|
|
|
<p>
|
|
The generalized plant is defined below.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">P = <span class="org-rainbow-delimiters-depth-1">[</span>W1 <span class="org-type">-</span>W1;
|
|
<span class="org-highlight-numbers-number">0</span> W2;
|
|
<span class="org-highlight-numbers-number">1</span> <span class="org-highlight-numbers-number">0</span><span class="org-rainbow-delimiters-depth-1">]</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
And we do the \(\mathcal{H}_\infty\) synthesis using the <code>hinfsyn</code> command.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab"><span class="org-rainbow-delimiters-depth-1">[</span>H2, <span class="org-type">~</span>, gamma, <span class="org-type">~</span><span class="org-rainbow-delimiters-depth-1">]</span> = hinfsyn<span class="org-rainbow-delimiters-depth-1">(</span>P, <span class="org-highlight-numbers-number">1</span>, <span class="org-highlight-numbers-number">1</span>,'TOLGAM', <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">001</span>, 'METHOD', 'ric', 'DISPLAY', 'on'<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<pre class="example">
|
|
[H2, ~, gamma, ~] = hinfsyn(P, 1, 1,'TOLGAM', 0.001, 'METHOD', 'ric', 'DISPLAY', 'on');
|
|
Resetting value of Gamma min based on D_11, D_12, D_21 terms
|
|
|
|
Test bounds: 0.0447 < gamma <= 1.3318
|
|
|
|
gamma hamx_eig xinf_eig hamy_eig yinf_eig nrho_xy p/f
|
|
1.332 1.3e+01 -1.0e-14 1.3e+00 -2.6e-18 0.0000 p
|
|
0.688 1.3e-11# ******** 1.3e+00 -6.7e-15 ******** f
|
|
1.010 1.1e+01 -1.5e-14 1.3e+00 -2.5e-14 0.0000 p
|
|
0.849 6.9e-11# ******** 1.3e+00 -2.3e-14 ******** f
|
|
0.930 5.2e-12# ******** 1.3e+00 -6.1e-18 ******** f
|
|
0.970 5.6e-11# ******** 1.3e+00 -2.3e-14 ******** f
|
|
0.990 5.0e-11# ******** 1.3e+00 -1.7e-17 ******** f
|
|
1.000 2.1e-10# ******** 1.3e+00 0.0e+00 ******** f
|
|
1.005 1.9e-10# ******** 1.3e+00 -3.7e-14 ******** f
|
|
1.008 1.1e+01 -9.1e-15 1.3e+00 0.0e+00 0.0000 p
|
|
1.006 1.2e-09# ******** 1.3e+00 -6.9e-16 ******** f
|
|
1.007 1.1e+01 -4.6e-15 1.3e+00 -1.8e-16 0.0000 p
|
|
|
|
Gamma value achieved: 1.0069
|
|
</pre>
|
|
|
|
<p>
|
|
And \(H_1(s)\) is defined as the complementary of \(H_2(s)\).
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">H1 = <span class="org-highlight-numbers-number">1</span> <span class="org-type">-</span> H2;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
The obtained complementary filters are shown in Fig. <a href="#org3e6046c">23</a>.
|
|
</p>
|
|
|
|
<div id="org3e6046c" class="figure">
|
|
<p><img src="figs/comp_filter_hinf_uncertainty.png" alt="comp_filter_hinf_uncertainty.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 23: </span>Obtained complementary filters (<a href="./figs/comp_filter_hinf_uncertainty.png">png</a>, <a href="./figs/comp_filter_hinf_uncertainty.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgc2223cb" class="outline-3">
|
|
<h3 id="orgc2223cb"><span class="section-number-3">2.7</span> Super sensor uncertainty</h3>
|
|
<div class="outline-text-3" id="text-2-7">
|
|
<p>
|
|
We can now compute the uncertainty of the super sensor. The result is shown in Fig. <a href="#org6982e48">24</a>.
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">Gss = G1<span class="org-type">*</span>H1 <span class="org-type">+</span> G2<span class="org-type">*</span>H2;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="org6982e48" class="figure">
|
|
<p><img src="figs/super_sensor_uncertainty_bode_plot.png" alt="super_sensor_uncertainty_bode_plot.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 24: </span>Uncertainty on the dynamics of the super sensor (<a href="./figs/super_sensor_uncertainty_bode_plot.png">png</a>, <a href="./figs/super_sensor_uncertainty_bode_plot.pdf">pdf</a>)</p>
|
|
</div>
|
|
|
|
<p>
|
|
The uncertainty of the super sensor cannot be made smaller than both the individual sensor. Ideally, it would follow the minimum uncertainty of both sensors.
|
|
</p>
|
|
|
|
<p>
|
|
We here just used very wimple weights.
|
|
For instance, we could improve the dynamical uncertainty of the super sensor by making \(|w_\phi(j\omega)|\) smaller bellow 2Hz where the dynamical uncertainty of the sensor 1 is small.
|
|
</p>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgb6b7895" class="outline-3">
|
|
<h3 id="orgb6b7895"><span class="section-number-3">2.8</span> Super sensor noise</h3>
|
|
<div class="outline-text-3" id="text-2-8">
|
|
<p>
|
|
We now compute the obtain Power Spectral Density of the super sensor's noise.
|
|
The noise characteristics of both individual sensor are defined below.
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">omegac = <span class="org-highlight-numbers-number">100</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>; G0 = <span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">5</span>; Ginf = <span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">4</span>;
|
|
N1 = <span class="org-rainbow-delimiters-depth-1">(</span>Ginf<span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> G0<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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</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-highlight-numbers-number">1</span> <span class="org-type">+</span> s<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">100</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
omegac = <span class="org-highlight-numbers-number">1</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>; G0 = <span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">3</span>; Ginf = <span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">8</span>;
|
|
N2 = <span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">(</span>sqrt<span class="org-rainbow-delimiters-depth-3">(</span>Ginf<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> sqrt<span class="org-rainbow-delimiters-depth-3">(</span>G0<span class="org-rainbow-delimiters-depth-3">)</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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">)</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-1">(</span><span class="org-highlight-numbers-number">1</span> <span class="org-type">+</span> s<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">4000</span><span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">2</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
The PSD of both sensor and of the super sensor is shown in Fig. <a href="#org319e5e2">25</a>.
|
|
The CPS of both sensor and of the super sensor is shown in Fig. <a href="#orgec999b5">26</a>.
|
|
</p>
|
|
|
|
|
|
<div id="org319e5e2" class="figure">
|
|
<p><img src="figs/psd_sensors_hinf_synthesis.png" alt="psd_sensors_hinf_synthesis.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 25: </span>Power Spectral Density of the obtained super sensor using the \(\mathcal{H}_\infty\) synthesis (<a href="./figs/psd_sensors_hinf_synthesis.png">png</a>, <a href="./figs/psd_sensors_hinf_synthesis.pdf">pdf</a>)</p>
|
|
</div>
|
|
|
|
|
|
<div id="orgec999b5" class="figure">
|
|
<p><img src="figs/cps_sensors_hinf_synthesis.png" alt="cps_sensors_hinf_synthesis.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 26: </span>Cumulative Power Spectrum of the obtained super sensor using the \(\mathcal{H}_\infty\) synthesis (<a href="./figs/cps_sensors_hinf_synthesis.png">png</a>, <a href="./figs/cps_sensors_hinf_synthesis.cps">cps</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org30df8bd" class="outline-3">
|
|
<h3 id="org30df8bd"><span class="section-number-3">2.9</span> Conclusion</h3>
|
|
<div class="outline-text-3" id="text-2-9">
|
|
<p>
|
|
Using the \(\mathcal{H}_\infty\) synthesis, the dynamical uncertainty of the super sensor can be bounded to acceptable values.
|
|
</p>
|
|
|
|
<p>
|
|
However, the RMS of the super sensor noise is not optimized as it was the case with the \(\mathcal{H}_2\) synthesis
|
|
</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org5297284" class="outline-2">
|
|
<h2 id="org5297284"><span class="section-number-2">3</span> Optimal Sensor Fusion - Mixed Synthesis</h2>
|
|
<div class="outline-text-2" id="text-3">
|
|
<p>
|
|
<a id="org51e3caa"></a>
|
|
</p>
|
|
<div class="note">
|
|
<p>
|
|
The Matlab scripts is accessible <a href="matlab/mixed_synthesis_sensor_fusion.m">here</a>.
|
|
</p>
|
|
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgf4ba947" class="outline-3">
|
|
<h3 id="orgf4ba947"><span class="section-number-3">3.1</span> Mixed \(\mathcal{H}_2\) / \(\mathcal{H}_\infty\) Synthesis - Introduction</h3>
|
|
<div class="outline-text-3" id="text-3-1">
|
|
<p>
|
|
The goal is to design complementary filters such that:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>the maximum uncertainty of the super sensor is bounded</li>
|
|
<li>the RMS value of the super sensor noise is minimized</li>
|
|
</ul>
|
|
|
|
<p>
|
|
To do so, we can use the Mixed \(\mathcal{H}_2\) / \(\mathcal{H}_\infty\) Synthesis.
|
|
</p>
|
|
|
|
<p>
|
|
The Matlab function for that is <code>h2hinfsyn</code> (<a href="https://fr.mathworks.com/help/robust/ref/h2hinfsyn.html">doc</a>).
|
|
</p>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org6def3bd" class="outline-3">
|
|
<h3 id="org6def3bd"><span class="section-number-3">3.2</span> Noise characteristics and Uncertainty of the individual sensors</h3>
|
|
<div class="outline-text-3" id="text-3-2">
|
|
<p>
|
|
We define the weights that are used to characterize the dynamic uncertainty of the sensors. This will be used for the \(\mathcal{H}_\infty\) part of the synthesis.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">omegac = <span class="org-highlight-numbers-number">100</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>; G0 = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">1</span>; Ginf = <span class="org-highlight-numbers-number">10</span>;
|
|
w1 = <span class="org-rainbow-delimiters-depth-1">(</span>Ginf<span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> G0<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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
omegac = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">2</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>; G0 = <span class="org-highlight-numbers-number">5</span>; Ginf = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">1</span>;
|
|
w2 = <span class="org-rainbow-delimiters-depth-1">(</span>Ginf<span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> G0<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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
omegac = <span class="org-highlight-numbers-number">5000</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>; G0 = <span class="org-highlight-numbers-number">1</span>; Ginf = <span class="org-highlight-numbers-number">50</span>;
|
|
w2 = w2<span class="org-type">*</span><span class="org-rainbow-delimiters-depth-1">(</span>Ginf<span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> G0<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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
We define the noise characteristics of the two sensors by choosing \(N_1\) and \(N_2\). This will be used for the \(\mathcal{H}_2\) part of the synthesis.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">omegac = <span class="org-highlight-numbers-number">100</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>; G0 = <span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">5</span>; Ginf = <span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">4</span>;
|
|
N1 = <span class="org-rainbow-delimiters-depth-1">(</span>Ginf<span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> G0<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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</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-highlight-numbers-number">1</span> <span class="org-type">+</span> s<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">100</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
omegac = <span class="org-highlight-numbers-number">1</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>; G0 = <span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">3</span>; Ginf = <span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">8</span>;
|
|
N2 = <span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">(</span>sqrt<span class="org-rainbow-delimiters-depth-3">(</span>Ginf<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> sqrt<span class="org-rainbow-delimiters-depth-3">(</span>G0<span class="org-rainbow-delimiters-depth-3">)</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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">)</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-1">(</span><span class="org-highlight-numbers-number">1</span> <span class="org-type">+</span> s<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">4000</span><span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">2</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
Both dynamical uncertainty and noise characteristics of the individual sensors are shown in Fig. <a href="#org1943010">27</a>.
|
|
</p>
|
|
|
|
|
|
<div id="org1943010" class="figure">
|
|
<p><img src="figs/mixed_synthesis_noise_uncertainty_sensors.png" alt="mixed_synthesis_noise_uncertainty_sensors.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 27: </span>Noise characteristsics and Dynamical uncertainty of the individual sensors (<a href="./figs/mixed_synthesis_noise_uncertainty_sensors.png">png</a>, <a href="./figs/mixed_synthesis_noise_uncertainty_sensors.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org69f8283" class="outline-3">
|
|
<h3 id="org69f8283"><span class="section-number-3">3.3</span> Weighting Functions on the uncertainty of the super sensor</h3>
|
|
<div class="outline-text-3" id="text-3-3">
|
|
<p>
|
|
We design weights for the \(\mathcal{H}_\infty\) part of the synthesis in order to limit the dynamical uncertainty of the super sensor.
|
|
The maximum wanted multiplicative uncertainty is shown in Fig. <a href="#org9f8b664">28</a>. The idea here is that we don't really need low uncertainty at low frequency but only near the crossover frequency that is suppose to be around 300Hz here.
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">n = <span class="org-highlight-numbers-number">4</span>; w0 = <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">900</span>; G0 = <span class="org-highlight-numbers-number">9</span>; G1 = <span class="org-highlight-numbers-number">1</span>; Gc = <span class="org-highlight-numbers-number">1</span>.<span class="org-highlight-numbers-number">1</span>;
|
|
H = <span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>sqrt<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>Gc<span class="org-type">/</span>G1<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>s <span class="org-type">+</span> <span class="org-rainbow-delimiters-depth-3">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>G1<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>sqrt<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>Gc<span class="org-type">/</span>G1<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>s <span class="org-type">+</span> <span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<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-type">^</span>n;
|
|
wphi = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">2</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">3</span>.<span class="org-highlight-numbers-number">142e04</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">628</span>.<span class="org-highlight-numbers-number">3</span><span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">/</span>H;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="org9f8b664" class="figure">
|
|
<p><img src="figs/mixed_syn_hinf_weight.png" alt="mixed_syn_hinf_weight.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 28: </span>Wanted maximum module uncertainty of the super sensor (<a href="./figs/mixed_syn_hinf_weight.png">png</a>, <a href="./figs/mixed_syn_hinf_weight.pdf">pdf</a>)</p>
|
|
</div>
|
|
|
|
<p>
|
|
The equivalent Magnitude and Phase uncertainties are shown in Fig. <a href="#orgf4dd3a1">29</a>.
|
|
</p>
|
|
|
|
|
|
<div id="orgf4dd3a1" class="figure">
|
|
<p><img src="figs/mixed_syn_objective_hinf.png" alt="mixed_syn_objective_hinf.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 29: </span>\(\mathcal{H}_\infty\) synthesis objective part of the mixed-synthesis (<a href="./figs/mixed_syn_objective_hinf.png">png</a>, <a href="./figs/mixed_syn_objective_hinf.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgc087ca6" class="outline-3">
|
|
<h3 id="orgc087ca6"><span class="section-number-3">3.4</span> Mixed Synthesis Architecture</h3>
|
|
<div class="outline-text-3" id="text-3-4">
|
|
<p>
|
|
The synthesis architecture that is used here is shown in Fig. <a href="#org7222c2f">30</a>.
|
|
</p>
|
|
|
|
<p>
|
|
The controller \(K\) is synthesized such that it:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>Keeps the \(\mathcal{H}_\infty\) norm \(G\) of the transfer function from \(w\) to \(z_\infty\) bellow some specified value</li>
|
|
<li>Keeps the \(\mathcal{H}_2\) norm \(H\) of the transfer function from \(w\) to \(z_2\) bellow some specified value</li>
|
|
<li>Minimizes a trade-off criterion of the form \(W_1 G^2 + W_2 H^2\) where \(W_1\) and \(W_2\) are specified values</li>
|
|
</ul>
|
|
|
|
|
|
<div id="org7222c2f" class="figure">
|
|
<p><img src="figs-tikz/mixed_h2_hinf_synthesis.png" alt="mixed_h2_hinf_synthesis.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 30: </span>Mixed H2/H-Infinity Synthesis</p>
|
|
</div>
|
|
|
|
<p>
|
|
Here, we define \(P\) such that:
|
|
</p>
|
|
\begin{align*}
|
|
\left\| \frac{z_\infty}{w} \right\|_\infty &= \left\| \begin{matrix}W_1(s) H_1(s) \\ W_2(s) H_2(s)\end{matrix} \right\|_\infty \\
|
|
\left\| \frac{z_2}{w} \right\|_2 &= \left\| \begin{matrix}N_1(s) H_1(s) \\ N_2(s) H_2(s)\end{matrix} \right\|_2
|
|
\end{align*}
|
|
|
|
<p>
|
|
Then:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>we specify the maximum value for the \(\mathcal{H}_\infty\) norm between \(w\) and \(z_\infty\) to be \(1\)</li>
|
|
<li>we don't specify any maximum value for the \(\mathcal{H}_2\) norm between \(w\) and \(z_2\)</li>
|
|
<li>we choose \(W_1 = 0\) and \(W_2 = 1\) such that the objective is to minimize the \(\mathcal{H}_2\) norm between \(w\) and \(z_2\)</li>
|
|
</ul>
|
|
|
|
<p>
|
|
The synthesis objective is to have:
|
|
\[ \left\| \frac{z_\infty}{w} \right\|_\infty = \left\| \begin{matrix}W_1(s) H_1(s) \\ W_2(s) H_2(s)\end{matrix} \right\|_\infty < 1 \]
|
|
and to minimize:
|
|
\[ \left\| \frac{z_2}{w} \right\|_2 = \left\| \begin{matrix}N_1(s) H_1(s) \\ N_2(s) H_2(s)\end{matrix} \right\|_2 \]
|
|
which is what we wanted.
|
|
</p>
|
|
|
|
<p>
|
|
We define the generalized plant that will be used for the mixed synthesis.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">W1u = ss<span class="org-rainbow-delimiters-depth-1">(</span>w1<span class="org-type">*</span>wphi<span class="org-rainbow-delimiters-depth-1">)</span>; W2u = ss<span class="org-rainbow-delimiters-depth-1">(</span>w2<span class="org-type">*</span>wphi<span class="org-rainbow-delimiters-depth-1">)</span>; <span class="org-comment">% Weight on the uncertainty</span>
|
|
W1n = ss<span class="org-rainbow-delimiters-depth-1">(</span>N1<span class="org-rainbow-delimiters-depth-1">)</span>; W2n = ss<span class="org-rainbow-delimiters-depth-1">(</span>N2<span class="org-rainbow-delimiters-depth-1">)</span>; <span class="org-comment">% Weight on the noise</span>
|
|
|
|
P = <span class="org-rainbow-delimiters-depth-1">[</span>W1u <span class="org-type">-</span>W1u;
|
|
<span class="org-highlight-numbers-number">0</span> W2u;
|
|
W1n <span class="org-type">-</span>W1n;
|
|
<span class="org-highlight-numbers-number">0</span> W2n;
|
|
<span class="org-highlight-numbers-number">1</span> <span class="org-highlight-numbers-number">0</span><span class="org-rainbow-delimiters-depth-1">]</span>;
|
|
</pre>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orga44c183" class="outline-3">
|
|
<h3 id="orga44c183"><span class="section-number-3">3.5</span> Mixed \(\mathcal{H}_2\) / \(\mathcal{H}_\infty\) Synthesis</h3>
|
|
<div class="outline-text-3" id="text-3-5">
|
|
<p>
|
|
The mixed $\mathcal{H}<sub>2</sub>$/\(\mathcal{H}_\infty\) synthesis is performed below.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">Nmeas = <span class="org-highlight-numbers-number">1</span>; Ncon = <span class="org-highlight-numbers-number">1</span>; Nz2 = <span class="org-highlight-numbers-number">2</span>;
|
|
|
|
<span class="org-rainbow-delimiters-depth-1">[</span>H2,<span class="org-type">~</span>,normz,<span class="org-type">~</span><span class="org-rainbow-delimiters-depth-1">]</span> = h2hinfsyn<span class="org-rainbow-delimiters-depth-1">(</span>P, Nmeas, Ncon, Nz2, <span class="org-rainbow-delimiters-depth-2">[</span><span class="org-highlight-numbers-number">0</span>, <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-2">]</span>, 'HINFMAX', <span class="org-highlight-numbers-number">1</span>, 'H2MAX', <span class="org-constant">Inf</span>, 'DKMAX', <span class="org-highlight-numbers-number">100</span>, 'TOL', <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">01</span>, 'DISPLAY', 'on'<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
H1 = <span class="org-highlight-numbers-number">1</span> <span class="org-type">-</span> H2;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
The obtained complementary filters are shown in Fig. <a href="#org90b3b07">31</a>.
|
|
</p>
|
|
|
|
|
|
<div id="org90b3b07" class="figure">
|
|
<p><img src="figs/comp_filters_mixed_synthesis.png" alt="comp_filters_mixed_synthesis.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 31: </span>Obtained complementary filters after mixed $\mathcal{H}<sub>2</sub>$/\(\mathcal{H}_\infty\) synthesis (<a href="./figs/comp_filters_mixed_synthesis.png">png</a>, <a href="./figs/comp_filters_mixed_synthesis.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgcc3cb0c" class="outline-3">
|
|
<h3 id="orgcc3cb0c"><span class="section-number-3">3.6</span> Obtained Super Sensor's noise</h3>
|
|
<div class="outline-text-3" id="text-3-6">
|
|
<p>
|
|
The PSD and CPS of the super sensor's noise are shown in Fig. <a href="#org24c2f1c">32</a> and Fig. <a href="#org22959e9">33</a> respectively.
|
|
</p>
|
|
|
|
|
|
<div id="org24c2f1c" class="figure">
|
|
<p><img src="figs/psd_super_sensor_mixed_syn.png" alt="psd_super_sensor_mixed_syn.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 32: </span>Power Spectral Density of the Super Sensor obtained with the mixed $\mathcal{H}<sub>2</sub>$/\(\mathcal{H}_\infty\) synthesis (<a href="./figs/psd_super_sensor_mixed_syn.png">png</a>, <a href="./figs/psd_super_sensor_mixed_syn.pdf">pdf</a>)</p>
|
|
</div>
|
|
|
|
|
|
|
|
<div id="org22959e9" class="figure">
|
|
<p><img src="figs/cps_super_sensor_mixed_syn.png" alt="cps_super_sensor_mixed_syn.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 33: </span>Cumulative Power Spectrum of the Super Sensor obtained with the mixed $\mathcal{H}<sub>2</sub>$/\(\mathcal{H}_\infty\) synthesis (<a href="./figs/cps_super_sensor_mixed_syn.png">png</a>, <a href="./figs/cps_super_sensor_mixed_syn.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org4be95ec" class="outline-3">
|
|
<h3 id="org4be95ec"><span class="section-number-3">3.7</span> Obtained Super Sensor's Uncertainty</h3>
|
|
<div class="outline-text-3" id="text-3-7">
|
|
<p>
|
|
The uncertainty on the super sensor's dynamics is shown in Fig. [[]].
|
|
</p>
|
|
|
|
|
|
<div id="org97f2e05" class="figure">
|
|
<p><img src="figs/super_sensor_dyn_uncertainty_mixed_syn.png" alt="super_sensor_dyn_uncertainty_mixed_syn.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 34: </span>Super Sensor Dynamical Uncertainty obtained with the mixed synthesis (<a href="./figs/super_sensor_dyn_uncertainty_mixed_syn.png">png</a>, <a href="./figs/super_sensor_dyn_uncertainty_mixed_syn.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org578a3af" class="outline-3">
|
|
<h3 id="org578a3af"><span class="section-number-3">3.8</span> Conclusion</h3>
|
|
<div class="outline-text-3" id="text-3-8">
|
|
<p>
|
|
This synthesis methods allows both to:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>limit the dynamical uncertainty of the super sensor</li>
|
|
<li>minimize the RMS value of the estimation</li>
|
|
</ul>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orge21a905" class="outline-2">
|
|
<h2 id="orge21a905"><span class="section-number-2">4</span> H-Infinity synthesis to ensure both performance and robustness</h2>
|
|
<div class="outline-text-2" id="text-4">
|
|
<p>
|
|
<a id="org474865c"></a>
|
|
</p>
|
|
<div class="note">
|
|
<p>
|
|
The Matlab scripts is accessible <a href="matlab/hinf_syn_perf_robust.m">here</a>.
|
|
</p>
|
|
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgc9411c5" class="outline-3">
|
|
<h3 id="orgc9411c5"><span class="section-number-3">4.1</span> Introduction</h3>
|
|
<div class="outline-text-3" id="text-4-1">
|
|
<p>
|
|
The idea is to use only the \(\mathcal{H}_\infty\) norm to express both the maximum wanted super sensor uncertainty and the fact that we want to minimize the super sensor's noise.
|
|
</p>
|
|
|
|
<p>
|
|
For <b>performance</b>, we may want to obtain a super sensor's noise that is close to the minimum of the individual sensor noises.
|
|
</p>
|
|
|
|
<p>
|
|
The noise of the super sensor is:
|
|
\[ |N_{ss}(j\omega)|^2 = | H_1(j\omega) N_1(j\omega) |^2 + | H_2(j\omega) N_2(j\omega) |^2 \quad \forall\omega \]
|
|
</p>
|
|
|
|
<p>
|
|
The minimum noise that we can obtain follows the minimum noise of the individual sensor:
|
|
</p>
|
|
\begin{align*}
|
|
& |N_{ss}(j\omega)| \approx |N_1(j\omega)| \quad \text{when} \quad |N_1(j\omega)| < |N_2(j\omega)| \\
|
|
& |N_{ss}(j\omega)| \approx |N_2(j\omega)| \quad \text{when} \quad |N_2(j\omega)| < |N_1(j\omega)|
|
|
\end{align*}
|
|
|
|
<p>
|
|
To do so, we want to design the complementary filters such that:
|
|
</p>
|
|
\begin{align*}
|
|
& |H_2(j\omega)| \ll 1 \quad \text{when} \quad |N_1(j\omega)| < |N_2(j\omega)| \\
|
|
& |H_1(j\omega)| \ll 1 \quad \text{when} \quad |N_2(j\omega)| < |N_1(j\omega)|
|
|
\end{align*}
|
|
|
|
|
|
|
|
|
|
<p>
|
|
For the <b>uncertainty</b> of the super sensor.
|
|
The equivalent super sensor uncertainty is:
|
|
\[ |w_{ss}(j\omega)| = |H_1(j\omega) w_1(j\omega)| + |H_2(j\omega) w_2(j\omega)|, \quad \forall\omega \]
|
|
</p>
|
|
|
|
<p>
|
|
The minimum uncertainty that we can obtain follows the minimum uncertainty of the individual sensor:
|
|
</p>
|
|
\begin{align*}
|
|
& |w_{ss}(j\omega)| \approx |w_1(j\omega)| \quad \text{when} \quad |w_1(j\omega)| < |w_2(j\omega)| \\
|
|
& |w_{ss}(j\omega)| \approx |w_2(j\omega)| \quad \text{when} \quad |w_2(j\omega)| < |w_1(j\omega)|
|
|
\end{align*}
|
|
|
|
<p>
|
|
To do so, we want to design the complementary filters such that:
|
|
</p>
|
|
\begin{align*}
|
|
& |H_2(j\omega)| \ll 1 \quad \text{when} \quad |w_1(j\omega)| < |w_2(j\omega)| \\
|
|
& |H_1(j\omega)| \ll 1 \quad \text{when} \quad |w_2(j\omega)| < |w_1(j\omega)|
|
|
\end{align*}
|
|
|
|
|
|
<p>
|
|
Of course, the conditions for performance and uncertainty may not be compatible.
|
|
</p>
|
|
|
|
<p>
|
|
We may not want to follow the minimum uncertainty.
|
|
</p>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgd416fee" class="outline-3">
|
|
<h3 id="orgd416fee"><span class="section-number-3">4.2</span> Dynamical uncertainty and Noise level of the individual sensors</h3>
|
|
<div class="outline-text-3" id="text-4-2">
|
|
<p>
|
|
Uncertainty on the individual sensors:
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">omegac = <span class="org-highlight-numbers-number">100</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>; G0 = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">1</span>; Ginf = <span class="org-highlight-numbers-number">10</span>;
|
|
w1 = <span class="org-rainbow-delimiters-depth-1">(</span>Ginf<span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> G0<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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
omegac = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">2</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>; G0 = <span class="org-highlight-numbers-number">5</span>; Ginf = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">1</span>;
|
|
w2 = <span class="org-rainbow-delimiters-depth-1">(</span>Ginf<span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> G0<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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
omegac = <span class="org-highlight-numbers-number">5000</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>; G0 = <span class="org-highlight-numbers-number">1</span>; Ginf = <span class="org-highlight-numbers-number">50</span>;
|
|
w2 = w2<span class="org-type">*</span><span class="org-rainbow-delimiters-depth-1">(</span>Ginf<span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> G0<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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
Noise level of the individual sensors:
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">omegac = <span class="org-highlight-numbers-number">100</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>; G0 = <span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">5</span>; Ginf = <span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">4</span>;
|
|
N1 = <span class="org-rainbow-delimiters-depth-1">(</span>Ginf<span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> G0<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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</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-highlight-numbers-number">1</span> <span class="org-type">+</span> s<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">100</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
omegac = <span class="org-highlight-numbers-number">1</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>; G0 = <span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">3</span>; Ginf = <span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">8</span>;
|
|
N2 = <span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">(</span>sqrt<span class="org-rainbow-delimiters-depth-3">(</span>Ginf<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>s<span class="org-type">/</span>omegac <span class="org-type">+</span> sqrt<span class="org-rainbow-delimiters-depth-3">(</span>G0<span class="org-rainbow-delimiters-depth-3">)</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>omegac <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">)</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-1">(</span><span class="org-highlight-numbers-number">1</span> <span class="org-type">+</span> s<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">4000</span><span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">2</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="orgc01787e" class="figure">
|
|
<p><img src="figs/noise_uncertainty_sensors_hinf.png" alt="noise_uncertainty_sensors_hinf.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 35: </span>Noise and Uncertainty characteristics of the sensors (<a href="./figs/noise_uncertainty_sensors_hinf.png">png</a>, <a href="./figs/noise_uncertainty_sensors_hinf.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org2be762e" class="outline-3">
|
|
<h3 id="org2be762e"><span class="section-number-3">4.3</span> Weights for uncertainty and performance</h3>
|
|
<div class="outline-text-3" id="text-4-3">
|
|
<p>
|
|
We design weights that are used to describe the wanted upper bound on the super sensor's noise and super sensor's uncertainty.
|
|
</p>
|
|
|
|
<p>
|
|
Weight on the uncertainty:
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">n = <span class="org-highlight-numbers-number">4</span>; w0 = <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">500</span>; G0 = <span class="org-highlight-numbers-number">6</span>; G1 = <span class="org-highlight-numbers-number">1</span>; Gc = <span class="org-highlight-numbers-number">1</span>.<span class="org-highlight-numbers-number">1</span>;
|
|
H = <span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>sqrt<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>Gc<span class="org-type">/</span>G1<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>s <span class="org-type">+</span> <span class="org-rainbow-delimiters-depth-3">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>G1<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>sqrt<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>Gc<span class="org-type">/</span>G1<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>s <span class="org-type">+</span> <span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<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-type">^</span>n;
|
|
|
|
Wu = <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">2</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">3</span>.<span class="org-highlight-numbers-number">142e04</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">628</span>.<span class="org-highlight-numbers-number">3</span><span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">/</span>H;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
Weight on the performance:
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">n = <span class="org-highlight-numbers-number">1</span>; w0 = <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">9</span>; A = <span class="org-highlight-numbers-number">6</span>;
|
|
a = sqrt<span class="org-rainbow-delimiters-depth-1">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">*</span>A<span class="org-type">^</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-2">)</span> <span class="org-type">-</span> <span class="org-highlight-numbers-number">1</span> <span class="org-type">+</span> <span class="org-highlight-numbers-number">2</span><span class="org-type">*</span>A<span class="org-type">^</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">*</span>sqrt<span class="org-rainbow-delimiters-depth-2">(</span>A<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>n<span class="org-rainbow-delimiters-depth-3">)</span> <span class="org-type">-</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
G = <span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-highlight-numbers-number">1</span> <span class="org-type">+</span> s<span class="org-type">/</span><span class="org-rainbow-delimiters-depth-3">(</span>w0<span class="org-type">/</span>a<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-highlight-numbers-number">1</span> <span class="org-type">+</span> s<span class="org-type">/</span><span class="org-rainbow-delimiters-depth-3">(</span>w0<span class="org-type">*</span>a<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-highlight-numbers-number">1</span> <span class="org-type">+</span> s<span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">2</span><span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">^</span>n;
|
|
|
|
n = <span class="org-highlight-numbers-number">2</span>; w0 = <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">9</span>; G0 = <span class="org-highlight-numbers-number">1e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">2</span>; G1 = <span class="org-highlight-numbers-number">1</span>; Gc = <span class="org-highlight-numbers-number">5e</span><span class="org-type">-</span><span class="org-highlight-numbers-number">1</span>;
|
|
G2 = <span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>sqrt<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>Gc<span class="org-type">/</span>G1<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>s <span class="org-type">+</span> <span class="org-rainbow-delimiters-depth-3">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>G1<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>sqrt<span class="org-rainbow-delimiters-depth-3">(</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>G0<span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-4">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">-</span><span class="org-rainbow-delimiters-depth-5">(</span>Gc<span class="org-type">/</span>G1<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-5">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span>n<span class="org-rainbow-delimiters-depth-5">)</span><span class="org-rainbow-delimiters-depth-4">)</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span>s <span class="org-type">+</span> <span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>Gc<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-3">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>n<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-type">^</span>n;
|
|
|
|
Wp = inv<span class="org-rainbow-delimiters-depth-1">(</span>G2<span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">*</span>inv<span class="org-rainbow-delimiters-depth-1">(</span>G<span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">*</span>inv<span class="org-rainbow-delimiters-depth-1">(</span>N2<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
The noise and uncertainty weights of the individual sensors and the asked noise/uncertainty of the super sensor are displayed in Fig. <a href="#org5f31b01">36</a>.
|
|
</p>
|
|
|
|
<div id="org5f31b01" class="figure">
|
|
<p><img src="figs/charac_sensors_weights.png" alt="charac_sensors_weights.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 36: </span>Upper bounds on the super sensor's noise and super sensor's uncertainty (<a href="./figs/charac_sensors_weights.png">png</a>, <a href="./figs/charac_sensors_weights.pdf">pdf</a>)</p>
|
|
</div>
|
|
|
|
|
|
<p>
|
|
The corresponding maximum norms of the filters to have the perf/robust asked are shown in Fig. <a href="#org3e11e14">37</a>.
|
|
</p>
|
|
|
|
<div id="org3e11e14" class="figure">
|
|
<p><img src="figs/upper_bound_complementary_filters_perf_robust.png" alt="upper_bound_complementary_filters_perf_robust.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 37: </span>Upper bounds on the complementary filters (<a href="./figs/upper_bound_complementary_filters_perf_robust.png">png</a>, <a href="./figs/upper_bound_complementary_filters_perf_robust.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org67abdbf" class="outline-3">
|
|
<h3 id="org67abdbf"><span class="section-number-3">4.4</span> H-infinity synthesis with 4 outputs corresponding to the 4 weights</h3>
|
|
<div class="outline-text-3" id="text-4-4">
|
|
<p>
|
|
We do the \(\mathcal{H}_\infty\) synthesis with 4 weights and 4 outputs.
|
|
</p>
|
|
|
|
\begin{equation*}
|
|
\left\| \begin{matrix}
|
|
W_{1p}(s) (1 - N_2(s)) \\
|
|
W_{2p}(s) N_2(s) \\
|
|
W_{1u}(s) (1 - N_2(s)) \\
|
|
W_{2u}(s) N_2(s)
|
|
\end{matrix} \right\|_\infty < 1
|
|
\end{equation*}
|
|
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">W1p = N1<span class="org-type">*</span>Wp<span class="org-type">/</span><span class="org-rainbow-delimiters-depth-1">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">+</span>s<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">1000</span><span class="org-rainbow-delimiters-depth-1">)</span>; <span class="org-comment">% Used to render W1p proper</span>
|
|
W2p = N2<span class="org-type">*</span>Wp;
|
|
W1u = w1<span class="org-type">*</span>Wu;
|
|
W2u = w2<span class="org-type">*</span>Wu;
|
|
</pre>
|
|
</div>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">P = <span class="org-rainbow-delimiters-depth-1">[</span>W1p <span class="org-type">-</span>W1p;
|
|
<span class="org-highlight-numbers-number">0</span> W2p;
|
|
W1u <span class="org-type">-</span>W1u;
|
|
<span class="org-highlight-numbers-number">0</span> W2u;
|
|
<span class="org-highlight-numbers-number">1</span> <span class="org-highlight-numbers-number">0</span><span class="org-rainbow-delimiters-depth-1">]</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
And we do the \(\mathcal{H}_\infty\) synthesis using the <code>hinfsyn</code> command.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab"><span class="org-rainbow-delimiters-depth-1">[</span>H2, <span class="org-type">~</span>, gamma, <span class="org-type">~</span><span class="org-rainbow-delimiters-depth-1">]</span> = hinfsyn<span class="org-rainbow-delimiters-depth-1">(</span>P, <span class="org-highlight-numbers-number">1</span>, <span class="org-highlight-numbers-number">1</span>,'TOLGAM', <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">001</span>, 'METHOD', 'ric', 'DISPLAY', 'on'<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<pre class="example">
|
|
[H2, ~, gamma, ~] = hinfsyn(P, 1, 1,'TOLGAM', 0.001, 'METHOD', 'ric', 'DISPLAY', 'on');
|
|
Resetting value of Gamma min based on D_11, D_12, D_21 terms
|
|
|
|
Test bounds: 1.4139 < gamma <= 65.6899
|
|
|
|
gamma hamx_eig xinf_eig hamy_eig yinf_eig nrho_xy p/f
|
|
65.690 1.3e+00 -6.7e-15 1.3e+00 -4.5e-13 0.0000 p
|
|
33.552 1.3e+00 -9.4e-15 1.3e+00 -3.7e-14 0.0000 p
|
|
17.483 1.3e+00 -5.6e-16 1.3e+00 -4.8e-13 0.0000 p
|
|
9.448 1.3e+00 -3.2e-15 1.3e+00 -1.2e-13 0.0000 p
|
|
5.431 1.3e+00 -2.3e-16 1.3e+00 -3.6e-13 0.0000 p
|
|
3.422 1.3e+00 -7.3e-16 1.3e+00 -2.6e-15 0.0000 p
|
|
2.418 1.3e+00 9.3e-17 1.3e+00 -3.0e-14 0.0000 p
|
|
1.916 1.3e+00 2.4e-17 1.3e+00 -2.2e-14 0.0000 p
|
|
1.665 1.3e+00 -2.5e-16 1.3e+00 -2.1e-14 0.0000 p
|
|
1.539 1.3e+00 -6.9e-15 1.3e+00 -5.3e-14 0.0000 p
|
|
1.477 1.3e+00 -2.1e-14 1.3e+00 -2.3e-13 0.0000 p
|
|
1.445 1.3e+00 -1.3e-16 1.3e+00 -2.6e-15 0.0000 p
|
|
1.430 1.3e+00 -4.9e-13 1.3e+00 -2.2e-13 0.0000 p
|
|
1.422 1.3e+00 -1.2e+08# 1.3e+00 -2.6e-13 0.0000 f
|
|
1.426 1.3e+00 -6.3e-13 1.3e+00 -3.3e-14 0.0000 p
|
|
1.424 1.3e+00 -3.4e+08# 1.3e+00 -4.5e-14 0.0000 f
|
|
1.425 1.3e+00 -1.7e+09# 1.3e+00 -5.2e-13 0.0000 f
|
|
|
|
Gamma value achieved: 1.4256
|
|
</pre>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">H1 = <span class="org-highlight-numbers-number">1</span> <span class="org-type">-</span> H2;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
The obtained complementary filters with the upper bounds are shown in Fig. <a href="#org5ee5c05">38</a>.
|
|
</p>
|
|
|
|
<div id="org5ee5c05" class="figure">
|
|
<p><img src="figs/hinf_result_comp_filters_4_outputs.png" alt="hinf_result_comp_filters_4_outputs.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 38: </span>caption (<a href="./figs/hinf_result_comp_filters_4_outputs.png">png</a>, <a href="./figs/hinf_result_comp_filters_4_outputs.pdf">pdf</a>)</p>
|
|
</div>
|
|
|
|
|
|
|
|
|
|
<div id="orgd4b2cc6" class="figure">
|
|
<p><img src="figs/upper_bounds_perf_robust_result_4_outputs.png" alt="upper_bounds_perf_robust_result_4_outputs.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 39: </span>Obtained PSD and uncertainty with the corresponding upper bounds (<a href="./figs/upper_bounds_perf_robust_result_4_outputs.png">png</a>, <a href="./figs/upper_bounds_perf_robust_result_4_outputs.pdf">pdf</a>)</p>
|
|
</div>
|
|
|
|
|
|
<div id="org775228e" class="figure">
|
|
<p><img src="figs/4outputs_hinf_psd_cps2svg.png" alt="4outputs_hinf_psd_cps2svg.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 40: </span>PSD and CPS (<a href="./figs/4outputs_hinf_psd_cps2svg.png">png</a>, <a href="./figs/4outputs_hinf_psd_cps2svg.pdf">pdf</a>)</p>
|
|
</div>
|
|
|
|
|
|
|
|
<div id="org3985f45" class="figure">
|
|
<p><img src="figs/4outputs_uncertainty.png" alt="4outputs_uncertainty.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 41: </span>Dynamical uncertainty (<a href="./figs/4outputs_uncertainty.png">png</a>, <a href="./figs/4outputs_uncertainty.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgeddf530" class="outline-3">
|
|
<h3 id="orgeddf530"><span class="section-number-3">4.5</span> Conclusion</h3>
|
|
<div class="outline-text-3" id="text-4-5">
|
|
<p>
|
|
The \(\mathcal{H}_\infty\) synthesis has been used to design complementary filters that permits to robustly merge sensors while ensuring a maximum noise level.
|
|
However, no guarantee is made that the RMS value of the super sensor's noise is minimized.
|
|
</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orge0c4fba" class="outline-2">
|
|
<h2 id="orge0c4fba"><span class="section-number-2">5</span> Equivalent Super Sensor</h2>
|
|
<div class="outline-text-2" id="text-5">
|
|
<p>
|
|
<a id="orge2278c6"></a>
|
|
</p>
|
|
<p>
|
|
The goal here is to find the parameters of a single sensor that would best represent a super sensor.
|
|
</p>
|
|
</div>
|
|
<div id="outline-container-orgb9f88a6" class="outline-3">
|
|
<h3 id="orgb9f88a6"><span class="section-number-3">5.1</span> Sensor Fusion Architecture</h3>
|
|
<div class="outline-text-3" id="text-5-1">
|
|
<p>
|
|
Let consider figure <a href="#org3117a49">42</a> where two sensors are merged.
|
|
The dynamic uncertainty of each sensor is represented by a weight \(w_i(s)\), the frequency characteristics each of the sensor noise is represented by the weights \(N_i(s)\).
|
|
The noise sources \(\tilde{n}_i\) are considered to be white noise: \(\Phi_{\tilde{n}_i}(\omega) = 1, \ \forall\omega\).
|
|
</p>
|
|
|
|
|
|
<div id="org3117a49" class="figure">
|
|
<p><img src="figs-tikz/sensor_fusion_full.png" alt="sensor_fusion_full.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 42: </span>Sensor fusion architecture (<a href="./figs/sensor_fusion_full.png">png</a>, <a href="./figs/sensor_fusion_full.pdf">pdf</a>).</p>
|
|
</div>
|
|
|
|
|
|
\begin{align*}
|
|
\hat{x} &= H_1(s) N_1(s) \tilde{n}_1 + H_2(s) N_2(s) \tilde{n}_2 \\
|
|
&\quad \quad + \Big(H_1(s) \big(1 + w_1(s) \Delta_1(s)\big) + H_2(s) \big(1 + w_2(s) \Delta_2(s)\big)\Big) x \\
|
|
&= H_1(s) N_1(s) \tilde{n}_1 + H_2(s) N_2(s) \tilde{n}_2 \\
|
|
&\quad \quad + \big(1 + H_1(s) w_1(s) \Delta_1(s) + H_2(s) w_2(s) \Delta_2(s)\big) x
|
|
\end{align*}
|
|
|
|
<p>
|
|
To the dynamics of the super sensor is:
|
|
</p>
|
|
\begin{equation}
|
|
\frac{\hat{x}}{x} = 1 + H_1(s) w_1(s) \Delta_1(s) + H_2(s) w_2(s) \Delta_2(s)
|
|
\end{equation}
|
|
|
|
<p>
|
|
And the noise of the super sensor is:
|
|
</p>
|
|
\begin{equation}
|
|
n_{ss} = H_1(s) N_1(s) \tilde{n}_1 + H_2(s) N_2(s) \tilde{n}_2
|
|
\end{equation}
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org3ce82ca" class="outline-3">
|
|
<h3 id="org3ce82ca"><span class="section-number-3">5.2</span> Equivalent Configuration</h3>
|
|
<div class="outline-text-3" id="text-5-2">
|
|
<p>
|
|
We try to determine \(w_{ss}(s)\) and \(N_{ss}(s)\) such that the sensor on figure <a href="#org87145c8">43</a> is equivalent to the super sensor of figure <a href="#org3117a49">42</a>.
|
|
</p>
|
|
|
|
|
|
<div id="org87145c8" class="figure">
|
|
<p><img src="figs-tikz/sensor_fusion_equivalent.png" alt="sensor_fusion_equivalent.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 43: </span>Equivalent Super Sensor (<a href="./figs/sensor_fusion_equivalent.png">png</a>, <a href="./figs/sensor_fusion_equivalent.pdf">pdf</a>).</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgaef042e" class="outline-3">
|
|
<h3 id="orgaef042e"><span class="section-number-3">5.3</span> Model the uncertainty of the super sensor</h3>
|
|
<div class="outline-text-3" id="text-5-3">
|
|
<p>
|
|
At each frequency \(\omega\), the uncertainty set of the super sensor shown on figure <a href="#org3117a49">42</a> is a circle centered on \(1\) with a radius equal to \(|H_1(j\omega) w_1(j\omega)| + |H_2(j\omega) w_2(j\omega)|\) on the complex plane.
|
|
The uncertainty set of the sensor shown on figure <a href="#org87145c8">43</a> is a circle centered on \(1\) with a radius equal to \(|w_{ss}(j\omega)|\) on the complex plane.
|
|
</p>
|
|
|
|
<p>
|
|
Ideally, we want to find a weight \(w_{ss}(s)\) so that:
|
|
</p>
|
|
<div class="important">
|
|
<p>
|
|
\[ |w_{ss}(j\omega)| = |H_1(j\omega) w_1(j\omega)| + |H_2(j\omega) w_2(j\omega)|, \quad \forall\omega \]
|
|
</p>
|
|
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org11399c1" class="outline-3">
|
|
<h3 id="org11399c1"><span class="section-number-3">5.4</span> Model the noise of the super sensor</h3>
|
|
<div class="outline-text-3" id="text-5-4">
|
|
<p>
|
|
The PSD of the estimation \(\hat{x}\) when \(x = 0\) of the configuration shown on figure <a href="#org3117a49">42</a> is:
|
|
</p>
|
|
\begin{align*}
|
|
\Phi_{\hat{x}}(\omega) &= | H_1(j\omega) N_1(j\omega) |^2 \Phi_{\tilde{n}_1} + | H_2(j\omega) N_2(j\omega) |^2 \Phi_{\tilde{n}_2} \\
|
|
&= | H_1(j\omega) N_1(j\omega) |^2 + | H_2(j\omega) N_2(j\omega) |^2
|
|
\end{align*}
|
|
|
|
<p>
|
|
The PSD of the estimation \(\hat{x}\) when \(x = 0\) of the configuration shown on figure <a href="#org87145c8">43</a> is:
|
|
</p>
|
|
\begin{align*}
|
|
\Phi_{\hat{x}}(\omega) &= | N_{ss}(j\omega) |^2 \Phi_{\tilde{n}} \\
|
|
&= | N_{ss}(j\omega) |^2
|
|
\end{align*}
|
|
|
|
<p>
|
|
Ideally, we want to find a weight \(N_{ss}(s)\) such that:
|
|
</p>
|
|
<div class="important">
|
|
<p>
|
|
\[ |N_{ss}(j\omega)|^2 = | H_1(j\omega) N_1(j\omega) |^2 + | H_2(j\omega) N_2(j\omega) |^2 \quad \forall\omega \]
|
|
</p>
|
|
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org57d7962" class="outline-3">
|
|
<h3 id="org57d7962"><span class="section-number-3">5.5</span> First guess</h3>
|
|
<div class="outline-text-3" id="text-5-5">
|
|
<p>
|
|
We could choose
|
|
</p>
|
|
\begin{align*}
|
|
w_{ss}(s) &= H_1(s) w_1(s) + H_2(s) w_2(s) \\
|
|
N_{ss}(s) &= H_1(s) N_1(s) + H_2(s) N_2(s)
|
|
\end{align*}
|
|
|
|
<p>
|
|
But we would have:
|
|
</p>
|
|
\begin{align*}
|
|
|w_{ss}(j\omega)| &= |H_1(j\omega) w_1(j\omega) + H_2(j\omega) w_2(j\omega)|, \quad \forall\omega \\
|
|
&\neq |H_1(j\omega) w_1(j\omega)| + |H_2(j\omega) w_2(j\omega)|, \quad \forall\omega
|
|
\end{align*}
|
|
<p>
|
|
and
|
|
</p>
|
|
\begin{align*}
|
|
|N_{ss}(j\omega)|^2 &= | H_1(j\omega) N_1(j\omega) + H_2(j\omega) N_2(j\omega) |^2 \quad \forall\omega \\
|
|
&\neq | H_1(j\omega) N_1(j\omega)|^2 + |H_2(j\omega) N_2(j\omega) |^2 \quad \forall\omega \\
|
|
\end{align*}
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org9ccbf4c" class="outline-2">
|
|
<h2 id="org9ccbf4c"><span class="section-number-2">6</span> Optimal And Robust Sensor Fusion in Practice</h2>
|
|
<div class="outline-text-2" id="text-6">
|
|
<p>
|
|
<a id="org51d0428"></a>
|
|
</p>
|
|
<p>
|
|
Here are the steps in order to apply optimal and robust sensor fusion:
|
|
</p>
|
|
|
|
<ul class="org-ul">
|
|
<li>Measure the noise characteristics of the sensors to be merged (necessary for "optimal" part of the fusion)</li>
|
|
<li>Measure/Estimate the dynamic uncertainty of the sensors (necessary for "robust" part of the fusion)</li>
|
|
<li>Apply H2/H-infinity synthesis of the complementary filters</li>
|
|
</ul>
|
|
</div>
|
|
<div id="outline-container-orgb47b99b" class="outline-3">
|
|
<h3 id="orgb47b99b"><span class="section-number-3">6.1</span> Measurement of the noise characteristics of the sensors</h3>
|
|
<div class="outline-text-3" id="text-6-1">
|
|
</div>
|
|
<div id="outline-container-org5bec3bd" class="outline-4">
|
|
<h4 id="org5bec3bd"><span class="section-number-4">6.1.1</span> Huddle Test</h4>
|
|
<div class="outline-text-4" id="text-6-1-1">
|
|
<p>
|
|
The technique to estimate the sensor noise is taken from <a class='org-ref-reference' href="#barzilai98_techn_measur_noise_sensor_presen">barzilai98_techn_measur_noise_sensor_presen</a>.
|
|
</p>
|
|
|
|
<p>
|
|
Let's consider two sensors (sensor 1 and sensor 2) that are measuring the same quantity \(x\) as shown in figure <a href="#org68123bf">44</a>.
|
|
</p>
|
|
|
|
|
|
<div id="org68123bf" class="figure">
|
|
<p><img src="figs-tikz/huddle_test.png" alt="huddle_test.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 44: </span>Huddle test block diagram</p>
|
|
</div>
|
|
|
|
<p>
|
|
Each sensor has uncorrelated noise \(n_1\) and \(n_2\) and internal dynamics \(G_1(s)\) and \(G_2(s)\) respectively.
|
|
</p>
|
|
|
|
<p>
|
|
We here suppose that each sensor has the same magnitude of instrumental noise: \(n_1 = n_2 = n\).
|
|
We also assume that their dynamics is ideal: \(G_1(s) = G_2(s) = 1\).
|
|
</p>
|
|
|
|
<p>
|
|
We then have:
|
|
</p>
|
|
\begin{equation}
|
|
\label{org1c3cb8d}
|
|
\gamma_{\hat{x}_1\hat{x}_2}^2(\omega) = \frac{1}{1 + 2 \left( \frac{|\Phi_n(\omega)|}{|\Phi_{\hat{x}}(\omega)|} \right) + \left( \frac{|\Phi_n(\omega)|}{|\Phi_{\hat{x}}(\omega)|} \right)^2}
|
|
\end{equation}
|
|
|
|
<p>
|
|
Since the input signal \(x\) and the instrumental noise \(n\) are incoherent:
|
|
</p>
|
|
\begin{equation}
|
|
\label{orge688af5}
|
|
|\Phi_{\hat{x}}(\omega)| = |\Phi_n(\omega)| + |\Phi_x(\omega)|
|
|
\end{equation}
|
|
|
|
<p>
|
|
From equations \eqref{org1c3cb8d} and \eqref{orge688af5}, we finally obtain
|
|
</p>
|
|
<div class="important">
|
|
\begin{equation}
|
|
\label{orgb3cd90c}
|
|
|\Phi_n(\omega)| = |\Phi_{\hat{x}}(\omega)| \left( 1 - \sqrt{\gamma_{\hat{x}_1\hat{x}_2}^2(\omega)} \right)
|
|
\end{equation}
|
|
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org9b36860" class="outline-4">
|
|
<h4 id="org9b36860"><span class="section-number-4">6.1.2</span> Weights that represents the noises' PSD</h4>
|
|
<div class="outline-text-4" id="text-6-1-2">
|
|
<p>
|
|
For further complementary filter synthesis, it is preferred to consider a normalized noise source \(\tilde{n}\) that has a PSD equal to one (\(\Phi_{\tilde{n}}(\omega) = 1\)) and to use a weighting filter \(N(s)\) in order to represent the frequency dependence of the noise.
|
|
</p>
|
|
|
|
<p>
|
|
The weighting filter \(N(s)\) should be designed such that:
|
|
</p>
|
|
\begin{align*}
|
|
& \Phi_n(\omega) \approx |N(j\omega)|^2 \Phi_{\tilde{n}}(\omega) \quad \forall \omega \\
|
|
\Longleftrightarrow & |N(j\omega)| \approx \sqrt{\Phi_n(\omega)} \quad \forall \omega
|
|
\end{align*}
|
|
|
|
<p>
|
|
These weighting filters can then be used to compare the noise level of sensors for the synthesis of complementary filters.
|
|
</p>
|
|
|
|
<p>
|
|
The sensor with a normalized noise input is shown in figure <a href="#org7153b87">45</a>.
|
|
</p>
|
|
|
|
|
|
<div id="org7153b87" class="figure">
|
|
<p><img src="figs-tikz/one_sensor_normalized_noise.png" alt="one_sensor_normalized_noise.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 45: </span>One sensor with normalized noise</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgcaad5c7" class="outline-4">
|
|
<h4 id="orgcaad5c7"><span class="section-number-4">6.1.3</span> Comparison of the noises' PSD</h4>
|
|
<div class="outline-text-4" id="text-6-1-3">
|
|
<p>
|
|
Once the noise of the sensors to be merged have been characterized, the power spectral density of both sensors have to be compared.
|
|
</p>
|
|
|
|
<p>
|
|
Ideally, the PSD of the noise are such that:
|
|
</p>
|
|
\begin{align*}
|
|
\Phi_{n_1}(\omega) &< \Phi_{n_2}(\omega) \text{ for } \omega < \omega_m \\
|
|
\Phi_{n_1}(\omega) &> \Phi_{n_2}(\omega) \text{ for } \omega > \omega_m
|
|
\end{align*}
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org516acb4" class="outline-4">
|
|
<h4 id="org516acb4"><span class="section-number-4">6.1.4</span> Computation of the coherence, power spectral density and cross spectral density of signals</h4>
|
|
<div class="outline-text-4" id="text-6-1-4">
|
|
<p>
|
|
The coherence between signals \(x\) and \(y\) is defined as follow
|
|
\[ \gamma^2_{xy}(\omega) = \frac{|\Phi_{xy}(\omega)|^2}{|\Phi_{x}(\omega)| |\Phi_{y}(\omega)|} \]
|
|
where \(|\Phi_x(\omega)|\) is the output Power Spectral Density (PSD) of signal \(x\) and \(|\Phi_{xy}(\omega)|\) is the Cross Spectral Density (CSD) of signal \(x\) and \(y\).
|
|
</p>
|
|
|
|
<p>
|
|
The PSD and CSD are defined as follow:
|
|
</p>
|
|
\begin{align}
|
|
|\Phi_x(\omega)| &= \frac{2}{n_d T} \sum^{n_d}_{n=1} \left| X_k(\omega, T) \right|^2 \\
|
|
|\Phi_{xy}(\omega)| &= \frac{2}{n_d T} \sum^{n_d}_{n=1} [ X_k^*(\omega, T) ] [ Y_k(\omega, T) ]
|
|
\end{align}
|
|
<p>
|
|
where:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>\(n_d\) is the number for records averaged</li>
|
|
<li>\(T\) is the length of each record</li>
|
|
<li>\(X_k(\omega, T)\) is the finite Fourier transform of the \(k^{\text{th}}\) record</li>
|
|
<li>\(X_k^*(\omega, T)\) is its complex conjugate</li>
|
|
</ul>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org3b36d5b" class="outline-3">
|
|
<h3 id="org3b36d5b"><span class="section-number-3">6.2</span> Estimate the dynamic uncertainty of the sensors</h3>
|
|
<div class="outline-text-3" id="text-6-2">
|
|
<p>
|
|
Let's consider one sensor represented on figure <a href="#orgb319480">46</a>.
|
|
</p>
|
|
|
|
<p>
|
|
The dynamic uncertainty is represented by an input multiplicative uncertainty where \(w(s)\) is a weight that represents the level of the uncertainty.
|
|
</p>
|
|
|
|
<p>
|
|
The goal is to accurately determine \(w(s)\) for the sensors that have to be merged.
|
|
</p>
|
|
|
|
|
|
<div id="orgb319480" class="figure">
|
|
<p><img src="figs-tikz/one_sensor_dyn_uncertainty.png" alt="one_sensor_dyn_uncertainty.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 46: </span>Sensor with dynamic uncertainty</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org78e12d1" class="outline-3">
|
|
<h3 id="org78e12d1"><span class="section-number-3">6.3</span> Optimal and Robust synthesis of the complementary filters</h3>
|
|
<div class="outline-text-3" id="text-6-3">
|
|
<p>
|
|
Once the noise characteristics and dynamic uncertainty of both sensors have been determined and we have determined the following weighting functions:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>\(w_1(s)\) and \(w_2(s)\) representing the dynamic uncertainty of both sensors</li>
|
|
<li>\(N_1(s)\) and \(N_2(s)\) representing the noise characteristics of both sensors</li>
|
|
</ul>
|
|
|
|
<p>
|
|
The goal is to design complementary filters \(H_1(s)\) and \(H_2(s)\) shown in figure <a href="#org3117a49">42</a> such that:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>the uncertainty on the super sensor dynamics is minimized</li>
|
|
<li>the noise sources \(\tilde{n}_1\) and \(\tilde{n}_2\) has the lowest possible effect on the estimation \(\hat{x}\)</li>
|
|
</ul>
|
|
|
|
|
|
<div id="org3f2dfc0" class="figure">
|
|
<p><img src="figs-tikz/sensor_fusion_full.png" alt="sensor_fusion_full.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 47: </span>Sensor fusion architecture with sensor dynamics uncertainty</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org5241fc0" class="outline-2">
|
|
<h2 id="org5241fc0"><span class="section-number-2">7</span> Methods of complementary filter synthesis</h2>
|
|
<div class="outline-text-2" id="text-7">
|
|
<p>
|
|
<a id="orgc984e6e"></a>
|
|
</p>
|
|
</div>
|
|
<div id="outline-container-org6450493" class="outline-3">
|
|
<h3 id="org6450493"><span class="section-number-3">7.1</span> Complementary filters using analytical formula</h3>
|
|
<div class="outline-text-3" id="text-7-1">
|
|
<p>
|
|
<a id="org3fcebf8"></a>
|
|
</p>
|
|
<div class="note">
|
|
<p>
|
|
All the files (data and Matlab scripts) are accessible <a href="data/comp_filters_analytical.zip">here</a>.
|
|
</p>
|
|
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org3e91cf8" class="outline-4">
|
|
<h4 id="org3e91cf8"><span class="section-number-4">7.1.1</span> Analytical 1st order complementary filters</h4>
|
|
<div class="outline-text-4" id="text-7-1-1">
|
|
<p>
|
|
First order complementary filters are defined with following equations:
|
|
</p>
|
|
\begin{align}
|
|
H_L(s) = \frac{1}{1 + \frac{s}{\omega_0}}\\
|
|
H_H(s) = \frac{\frac{s}{\omega_0}}{1 + \frac{s}{\omega_0}}
|
|
\end{align}
|
|
|
|
<p>
|
|
Their bode plot is shown figure <a href="#orgb3b48a1">48</a>.
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">w0 = <span class="org-highlight-numbers-number">2</span><span class="org-type">*</span><span class="org-constant">pi</span>; <span class="org-comment">% [rad/s]</span>
|
|
|
|
Hh1 = <span class="org-rainbow-delimiters-depth-1">(</span>s<span class="org-type">/</span>w0<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>w0<span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">+</span><span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
Hl1 = <span class="org-highlight-numbers-number">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>w0<span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">+</span><span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="orgb3b48a1" class="figure">
|
|
<p><img src="figs/comp_filter_1st_order.png" alt="comp_filter_1st_order.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 48: </span>Bode plot of first order complementary filter (<a href="./figs/comp_filter_1st_order.png">png</a>, <a href="./figs/comp_filter_1st_order.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org6e195db" class="outline-4">
|
|
<h4 id="org6e195db"><span class="section-number-4">7.1.2</span> Second Order Complementary Filters</h4>
|
|
<div class="outline-text-4" id="text-7-1-2">
|
|
<p>
|
|
We here use analytical formula for the complementary filters \(H_L\) and \(H_H\).
|
|
</p>
|
|
|
|
<p>
|
|
The first two formulas that are used to generate complementary filters are:
|
|
</p>
|
|
\begin{align*}
|
|
H_L(s) &= \frac{(1+\alpha) (\frac{s}{\omega_0})+1}{\left((\frac{s}{\omega_0})+1\right) \left((\frac{s}{\omega_0})^2 + \alpha (\frac{s}{\omega_0}) + 1\right)}\\
|
|
H_H(s) &= \frac{(\frac{s}{\omega_0})^2 \left((\frac{s}{\omega_0})+1+\alpha\right)}{\left((\frac{s}{\omega_0})+1\right) \left((\frac{s}{\omega_0})^2 + \alpha (\frac{s}{\omega_0}) + 1\right)}
|
|
\end{align*}
|
|
<p>
|
|
where:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>\(\omega_0\) is the blending frequency in rad/s.</li>
|
|
<li>\(\alpha\) is used to change the shape of the filters:
|
|
<ul class="org-ul">
|
|
<li>Small values for \(\alpha\) will produce high magnitude of the filters \(|H_L(j\omega)|\) and \(|H_H(j\omega)|\) near \(\omega_0\) but smaller value for \(|H_L(j\omega)|\) above \(\approx 1.5 \omega_0\) and for \(|H_H(j\omega)|\) below \(\approx 0.7 \omega_0\)</li>
|
|
<li>A large \(\alpha\) will do the opposite</li>
|
|
</ul></li>
|
|
</ul>
|
|
|
|
<p>
|
|
This is illustrated on figure <a href="#org6531874">49</a>.
|
|
The slope of those filters at high and low frequencies is \(-2\) and \(2\) respectively for \(H_L\) and \(H_H\).
|
|
</p>
|
|
|
|
|
|
<div id="org6531874" class="figure">
|
|
<p><img src="figs/comp_filters_param_alpha.png" alt="comp_filters_param_alpha.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 49: </span>Effect of the parameter \(\alpha\) on the shape of the generated second order complementary filters (<a href="./figs/comp_filters_param_alpha.png">png</a>, <a href="./figs/comp_filters_param_alpha.pdf">pdf</a>)</p>
|
|
</div>
|
|
|
|
<p>
|
|
We now study the maximum norm of the filters function of the parameter \(\alpha\). As we saw that the maximum norm of the filters is important for the robust merging of filters.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab"><span class="org-type">figure</span>;
|
|
plot<span class="org-rainbow-delimiters-depth-1">(</span>alphas, infnorms<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-type">\</span>alpha$'<span class="org-rainbow-delimiters-depth-1">)</span>; ylabel<span class="org-rainbow-delimiters-depth-1">(</span>'$<span class="org-type">\|</span>H_1<span class="org-type">\|</span>_<span class="org-type">\</span>infty$'<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="org033a97f" class="figure">
|
|
<p><img src="figs/param_alpha_hinf_norm.png" alt="param_alpha_hinf_norm.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 50: </span>Evolution of the H-Infinity norm of the complementary filters with the parameter \(\alpha\) (<a href="./figs/param_alpha_hinf_norm.png">png</a>, <a href="./figs/param_alpha_hinf_norm.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org038e979" class="outline-4">
|
|
<h4 id="org038e979"><span class="section-number-4">7.1.3</span> Third Order Complementary Filters</h4>
|
|
<div class="outline-text-4" id="text-7-1-3">
|
|
<p>
|
|
The following formula gives complementary filters with slopes of \(-3\) and \(3\):
|
|
</p>
|
|
\begin{align*}
|
|
H_L(s) &= \frac{\left(1+(\alpha+1)(\beta+1)\right) (\frac{s}{\omega_0})^2 + (1+\alpha+\beta)(\frac{s}{\omega_0}) + 1}{\left(\frac{s}{\omega_0} + 1\right) \left( (\frac{s}{\omega_0})^2 + \alpha (\frac{s}{\omega_0}) + 1 \right) \left( (\frac{s}{\omega_0})^2 + \beta (\frac{s}{\omega_0}) + 1 \right)}\\
|
|
H_H(s) &= \frac{(\frac{s}{\omega_0})^3 \left( (\frac{s}{\omega_0})^2 + (1+\alpha+\beta) (\frac{s}{\omega_0}) + (1+(\alpha+1)(\beta+1)) \right)}{\left(\frac{s}{\omega_0} + 1\right) \left( (\frac{s}{\omega_0})^2 + \alpha (\frac{s}{\omega_0}) + 1 \right) \left( (\frac{s}{\omega_0})^2 + \beta (\frac{s}{\omega_0}) + 1 \right)}
|
|
\end{align*}
|
|
|
|
<p>
|
|
The parameters are:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>\(\omega_0\) is the blending frequency in rad/s</li>
|
|
<li>\(\alpha\) and \(\beta\) that are used to change the shape of the filters similarly to the parameter \(\alpha\) for the second order complementary filters</li>
|
|
</ul>
|
|
|
|
<p>
|
|
The filters are defined below and the result is shown on figure <a href="#org85e7595">51</a>.
|
|
</p>
|
|
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">alpha = <span class="org-highlight-numbers-number">1</span>;
|
|
beta = <span class="org-highlight-numbers-number">10</span>;
|
|
w0 = <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">14</span>;
|
|
|
|
Hh3_ana = <span class="org-rainbow-delimiters-depth-1">(</span>s<span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">3</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>w0<span class="org-rainbow-delimiters-depth-2">)</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-2">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">+</span>alpha<span class="org-type">+</span>beta<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>w0<span class="org-rainbow-delimiters-depth-2">)</span> <span class="org-type">+</span> <span class="org-rainbow-delimiters-depth-2">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">+</span><span class="org-rainbow-delimiters-depth-3">(</span>alpha<span class="org-type">+</span><span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-3">(</span>beta<span class="org-type">+</span><span class="org-highlight-numbers-number">1</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-type">/</span><span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">(</span>s<span class="org-type">/</span>w0 <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span>s<span class="org-type">/</span>w0<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>alpha<span class="org-type">*</span><span class="org-rainbow-delimiters-depth-3">(</span>s<span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">+</span><span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span>s<span class="org-type">/</span>w0<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>beta<span class="org-type">*</span><span class="org-rainbow-delimiters-depth-3">(</span>s<span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">+</span><span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
Hl3_ana = <span class="org-rainbow-delimiters-depth-1">(</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">+</span><span class="org-rainbow-delimiters-depth-3">(</span>alpha<span class="org-type">+</span><span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-3">(</span>beta<span class="org-type">+</span><span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-3">)</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>w0<span class="org-rainbow-delimiters-depth-2">)</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-2">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">+</span>alpha<span class="org-type">+</span>beta<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>w0<span class="org-rainbow-delimiters-depth-2">)</span> <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</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>w0 <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span>s<span class="org-type">/</span>w0<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>alpha<span class="org-type">*</span><span class="org-rainbow-delimiters-depth-3">(</span>s<span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">+</span><span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">*</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-rainbow-delimiters-depth-3">(</span>s<span class="org-type">/</span>w0<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>beta<span class="org-type">*</span><span class="org-rainbow-delimiters-depth-3">(</span>s<span class="org-type">/</span>w0<span class="org-rainbow-delimiters-depth-3">)</span><span class="org-type">+</span><span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="org85e7595" class="figure">
|
|
<p><img src="figs/complementary_filters_third_order.png" alt="complementary_filters_third_order.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 51: </span>Third order complementary filters using the analytical formula (<a href="./figs/complementary_filters_third_order.png">png</a>, <a href="./figs/complementary_filters_third_order.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org3e0bda3" class="outline-3">
|
|
<h3 id="org3e0bda3"><span class="section-number-3">7.2</span> H-Infinity synthesis of complementary filters</h3>
|
|
<div class="outline-text-3" id="text-7-2">
|
|
<p>
|
|
<a id="org6e61b27"></a>
|
|
</p>
|
|
<div class="note">
|
|
<p>
|
|
All the files (data and Matlab scripts) are accessible <a href="data/h_inf_synthesis_complementary_filters.zip">here</a>.
|
|
</p>
|
|
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgd3f44dd" class="outline-4">
|
|
<h4 id="orgd3f44dd"><span class="section-number-4">7.2.1</span> Synthesis Architecture</h4>
|
|
<div class="outline-text-4" id="text-7-2-1">
|
|
<p>
|
|
We here synthesize the complementary filters using the \(\mathcal{H}_\infty\) synthesis.
|
|
The goal is to specify upper bounds on the norms of \(H_L\) and \(H_H\) while ensuring their complementary property (\(H_L + H_H = 1\)).
|
|
</p>
|
|
|
|
<p>
|
|
In order to do so, we use the generalized plant shown on figure <a href="#org0756011">52</a> where \(w_L\) and \(w_H\) weighting transfer functions that will be used to shape \(H_L\) and \(H_H\) respectively.
|
|
</p>
|
|
|
|
|
|
<div id="org0756011" class="figure">
|
|
<p><img src="figs-tikz/sf_hinf_filters_plant_b.png" alt="sf_hinf_filters_plant_b.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 52: </span>Generalized plant used for the \(\mathcal{H}_\infty\) synthesis of the complementary filters</p>
|
|
</div>
|
|
|
|
<p>
|
|
The \(\mathcal{H}_\infty\) synthesis applied on this generalized plant will give a transfer function \(H_L\) (figure <a href="#org4294a3a">53</a>) such that the \(\mathcal{H}_\infty\) norm of the transfer function from \(w\) to \([z_H,\ z_L]\) is less than one:
|
|
\[ \left\| \begin{array}{c} H_L w_L \\ (1 - H_L) w_H \end{array} \right\|_\infty < 1 \]
|
|
</p>
|
|
|
|
<p>
|
|
Thus, if the above condition is verified, we can define \(H_H = 1 - H_L\) and we have that:
|
|
\[ \left\| \begin{array}{c} H_L w_L \\ H_H w_H \end{array} \right\|_\infty < 1 \]
|
|
Which is almost (with an maximum error of \(\sqrt{2}\)) equivalent to:
|
|
</p>
|
|
\begin{align*}
|
|
|H_L| &< \frac{1}{|w_L|}, \quad \forall \omega \\
|
|
|H_H| &< \frac{1}{|w_H|}, \quad \forall \omega
|
|
\end{align*}
|
|
|
|
<p>
|
|
We then see that \(w_L\) and \(w_H\) can be used to shape both \(H_L\) and \(H_H\) while ensuring (by definition of \(H_H = 1 - H_L\)) their complementary property.
|
|
</p>
|
|
|
|
|
|
<div id="org4294a3a" class="figure">
|
|
<p><img src="figs-tikz/sf_hinf_filters_b.png" alt="sf_hinf_filters_b.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 53: </span>\(\mathcal{H}_\infty\) synthesis of the complementary filters</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org3d3c117" class="outline-4">
|
|
<h4 id="org3d3c117"><span class="section-number-4">7.2.2</span> Weights</h4>
|
|
<div class="outline-text-4" id="text-7-2-2">
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">omegab = <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">9</span>;
|
|
wH = <span class="org-rainbow-delimiters-depth-1">(</span>omegab<span class="org-rainbow-delimiters-depth-1">)</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-1">(</span>s <span class="org-type">+</span> omegab<span class="org-type">*</span>sqrt<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">5</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">2</span>;
|
|
omegab = <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">28</span>;
|
|
wL = <span class="org-rainbow-delimiters-depth-1">(</span>s <span class="org-type">+</span> omegab<span class="org-type">/</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-highlight-numbers-number">4</span>.<span class="org-highlight-numbers-number">5</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span><span class="org-highlight-numbers-number">3</span><span class="org-rainbow-delimiters-depth-2">)</span><span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">3</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-1">(</span>s<span class="org-type">*</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-rainbow-delimiters-depth-2">)</span><span class="org-type">^</span><span class="org-rainbow-delimiters-depth-2">(</span><span class="org-highlight-numbers-number">1</span><span class="org-type">/</span><span class="org-highlight-numbers-number">3</span><span class="org-rainbow-delimiters-depth-2">)</span> <span class="org-type">+</span> omegab<span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">3</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="orge91547f" class="figure">
|
|
<p><img src="figs/weights_wl_wh.png" alt="weights_wl_wh.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 54: </span>Weights on the complementary filters \(w_L\) and \(w_H\) and the associated performance weights (<a href="./figs/weights_wl_wh.png">png</a>, <a href="./figs/weights_wl_wh.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgbc7f25c" class="outline-4">
|
|
<h4 id="orgbc7f25c"><span class="section-number-4">7.2.3</span> H-Infinity Synthesis</h4>
|
|
<div class="outline-text-4" id="text-7-2-3">
|
|
<p>
|
|
We define the generalized plant \(P\) on matlab.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">P = <span class="org-rainbow-delimiters-depth-1">[</span><span class="org-highlight-numbers-number">0</span> wL;
|
|
wH <span class="org-type">-</span>wH;
|
|
<span class="org-highlight-numbers-number">1</span> <span class="org-highlight-numbers-number">0</span><span class="org-rainbow-delimiters-depth-1">]</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<p>
|
|
And we do the \(\mathcal{H}_\infty\) synthesis using the <code>hinfsyn</code> command.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab"><span class="org-rainbow-delimiters-depth-1">[</span>Hl_hinf, <span class="org-type">~</span>, gamma, <span class="org-type">~</span><span class="org-rainbow-delimiters-depth-1">]</span> = hinfsyn<span class="org-rainbow-delimiters-depth-1">(</span>P, <span class="org-highlight-numbers-number">1</span>, <span class="org-highlight-numbers-number">1</span>,'TOLGAM', <span class="org-highlight-numbers-number">0</span>.<span class="org-highlight-numbers-number">001</span>, 'METHOD', 'ric', 'DISPLAY', 'on'<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
<pre class="example">
|
|
[Hl_hinf, ~, gamma, ~] = hinfsyn(P, 1, 1,'TOLGAM', 0.001, 'METHOD', 'ric', 'DISPLAY', 'on');
|
|
Test bounds: 0.0000 < gamma <= 1.7285
|
|
|
|
gamma hamx_eig xinf_eig hamy_eig yinf_eig nrho_xy p/f
|
|
1.729 4.1e+01 8.4e-12 1.8e-01 0.0e+00 0.0000 p
|
|
0.864 3.9e+01 -5.8e-02# 1.8e-01 0.0e+00 0.0000 f
|
|
1.296 4.0e+01 8.4e-12 1.8e-01 0.0e+00 0.0000 p
|
|
1.080 4.0e+01 8.5e-12 1.8e-01 0.0e+00 0.0000 p
|
|
0.972 3.9e+01 -4.2e-01# 1.8e-01 0.0e+00 0.0000 f
|
|
1.026 4.0e+01 8.5e-12 1.8e-01 0.0e+00 0.0000 p
|
|
0.999 3.9e+01 8.5e-12 1.8e-01 0.0e+00 0.0000 p
|
|
0.986 3.9e+01 -1.2e+00# 1.8e-01 0.0e+00 0.0000 f
|
|
0.993 3.9e+01 -8.2e+00# 1.8e-01 0.0e+00 0.0000 f
|
|
0.996 3.9e+01 8.5e-12 1.8e-01 0.0e+00 0.0000 p
|
|
0.994 3.9e+01 8.5e-12 1.8e-01 0.0e+00 0.0000 p
|
|
0.993 3.9e+01 -3.2e+01# 1.8e-01 0.0e+00 0.0000 f
|
|
|
|
Gamma value achieved: 0.9942
|
|
</pre>
|
|
|
|
<p>
|
|
We then define the high pass filter \(H_H = 1 - H_L\). The bode plot of both \(H_L\) and \(H_H\) is shown on figure <a href="#org1a55676">55</a>.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">Hh_hinf = <span class="org-highlight-numbers-number">1</span> <span class="org-type">-</span> Hl_hinf;
|
|
</pre>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org6ceb811" class="outline-4">
|
|
<h4 id="org6ceb811"><span class="section-number-4">7.2.4</span> Obtained Complementary Filters</h4>
|
|
<div class="outline-text-4" id="text-7-2-4">
|
|
<p>
|
|
The obtained complementary filters are shown on figure <a href="#org1a55676">55</a>.
|
|
</p>
|
|
|
|
|
|
<div id="org1a55676" class="figure">
|
|
<p><img src="figs/hinf_filters_results.png" alt="hinf_filters_results.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 55: </span>Obtained complementary filters using \(\mathcal{H}_\infty\) synthesis (<a href="./figs/hinf_filters_results.png">png</a>, <a href="./figs/hinf_filters_results.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org3592282" class="outline-3">
|
|
<h3 id="org3592282"><span class="section-number-3">7.3</span> Feedback Control Architecture to generate Complementary Filters</h3>
|
|
<div class="outline-text-3" id="text-7-3">
|
|
<p>
|
|
<a id="org39ef46d"></a>
|
|
</p>
|
|
<p>
|
|
The idea is here to use the fact that in a classical feedback architecture, \(S + T = 1\), in order to design complementary filters.
|
|
</p>
|
|
|
|
<p>
|
|
Thus, all the tools that has been developed for classical feedback control can be used for complementary filter design.
|
|
</p>
|
|
<div class="note">
|
|
<p>
|
|
All the files (data and Matlab scripts) are accessible <a href="data/feedback_generate_comp_filters.zip">here</a>.
|
|
</p>
|
|
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orga8706fd" class="outline-4">
|
|
<h4 id="orga8706fd"><span class="section-number-4">7.3.1</span> Architecture</h4>
|
|
<div class="outline-text-4" id="text-7-3-1">
|
|
|
|
<div id="orgf3d0968" class="figure">
|
|
<p><img src="figs-tikz/complementary_filters_feedback_architecture.png" alt="complementary_filters_feedback_architecture.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 56: </span>Architecture used to generate the complementary filters</p>
|
|
</div>
|
|
|
|
<p>
|
|
We have:
|
|
\[ y = \underbrace{\frac{L}{L + 1}}_{H_L} y_1 + \underbrace{\frac{1}{L + 1}}_{H_H} y_2 \]
|
|
with \(H_L + H_H = 1\).
|
|
</p>
|
|
|
|
<p>
|
|
The only thing to design is \(L\) such that the complementary filters are stable with the wanted shape.
|
|
</p>
|
|
|
|
<p>
|
|
A simple choice is:
|
|
\[ L = \left(\frac{\omega_c}{s}\right)^2 \frac{\frac{s}{\omega_c / \alpha} + 1}{\frac{s}{\omega_c} + \alpha} \]
|
|
</p>
|
|
|
|
<p>
|
|
Which contains two integrator and a lead. \(\omega_c\) is used to tune the crossover frequency and \(\alpha\) the trade-off "bump" around blending frequency and filtering away from blending frequency.
|
|
</p>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org733ed6c" class="outline-4">
|
|
<h4 id="org733ed6c"><span class="section-number-4">7.3.2</span> Loop Gain Design</h4>
|
|
<div class="outline-text-4" id="text-7-3-2">
|
|
<p>
|
|
Let's first define the loop gain \(L\).
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">wc = <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">1</span>;
|
|
alpha = <span class="org-highlight-numbers-number">2</span>;
|
|
|
|
L = <span class="org-rainbow-delimiters-depth-1">(</span>wc<span class="org-type">/</span>s<span class="org-rainbow-delimiters-depth-1">)</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-1">(</span>s<span class="org-type">/</span><span class="org-rainbow-delimiters-depth-2">(</span>wc<span class="org-type">/</span>alpha<span class="org-rainbow-delimiters-depth-2">)</span> <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</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>wc <span class="org-type">+</span> alpha<span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="org7d23163" class="figure">
|
|
<p><img src="figs/loop_gain_bode_plot.png" alt="loop_gain_bode_plot.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 57: </span>Bode plot of the loop gain \(L\) (<a href="./figs/loop_gain_bode_plot.png">png</a>, <a href="./figs/loop_gain_bode_plot.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orga0835dc" class="outline-4">
|
|
<h4 id="orga0835dc"><span class="section-number-4">7.3.3</span> Complementary Filters Obtained</h4>
|
|
<div class="outline-text-4" id="text-7-3-3">
|
|
<p>
|
|
We then compute the resulting low pass and high pass filters.
|
|
</p>
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">Hl = L<span class="org-type">/</span><span class="org-rainbow-delimiters-depth-1">(</span>L <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
Hh = <span class="org-highlight-numbers-number">1</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-1">(</span>L <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="orga0ee5cb" class="figure">
|
|
<p><img src="figs/low_pass_high_pass_filters.png" alt="low_pass_high_pass_filters.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 58: </span>Low pass and High pass filters \(H_L\) and \(H_H\) for different values of \(\alpha\) (<a href="./figs/low_pass_high_pass_filters.png">png</a>, <a href="./figs/low_pass_high_pass_filters.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgcec1071" class="outline-3">
|
|
<h3 id="orgcec1071"><span class="section-number-3">7.4</span> Analytical Formula found in the literature</h3>
|
|
<div class="outline-text-3" id="text-7-4">
|
|
<p>
|
|
<a id="org4071972"></a>
|
|
</p>
|
|
</div>
|
|
|
|
<div id="outline-container-orgc8af80a" class="outline-4">
|
|
<h4 id="orgc8af80a"><span class="section-number-4">7.4.1</span> Analytical Formula</h4>
|
|
<div class="outline-text-4" id="text-7-4-1">
|
|
<p>
|
|
<a class='org-ref-reference' href="#min15_compl_filter_desig_angle_estim">min15_compl_filter_desig_angle_estim</a>
|
|
</p>
|
|
\begin{align*}
|
|
H_L(s) = \frac{K_p s + K_i}{s^2 + K_p s + K_i} \\
|
|
H_H(s) = \frac{s^2}{s^2 + K_p s + K_i}
|
|
\end{align*}
|
|
|
|
<p>
|
|
<a class='org-ref-reference' href="#corke04_inert_visual_sensin_system_small_auton_helic">corke04_inert_visual_sensin_system_small_auton_helic</a>
|
|
</p>
|
|
\begin{align*}
|
|
H_L(s) = \frac{1}{s/p + 1} \\
|
|
H_H(s) = \frac{s/p}{s/p + 1}
|
|
\end{align*}
|
|
|
|
<p>
|
|
<a class='org-ref-reference' href="#jensen13_basic_uas">jensen13_basic_uas</a>
|
|
</p>
|
|
\begin{align*}
|
|
H_L(s) = \frac{2 \omega_0 s + \omega_0^2}{(s + \omega_0)^2} \\
|
|
H_H(s) = \frac{s^2}{(s + \omega_0)^2}
|
|
\end{align*}
|
|
|
|
\begin{align*}
|
|
H_L(s) = \frac{C(s)}{C(s) + s} \\
|
|
H_H(s) = \frac{s}{C(s) + s}
|
|
\end{align*}
|
|
|
|
<p>
|
|
<a class='org-ref-reference' href="#shaw90_bandw_enhan_posit_measur_using_measur_accel">shaw90_bandw_enhan_posit_measur_using_measur_accel</a>
|
|
</p>
|
|
\begin{align*}
|
|
H_L(s) = \frac{3 \tau s + 1}{(\tau s + 1)^3} \\
|
|
H_H(s) = \frac{\tau^3 s^3 + 3 \tau^2 s^2}{(\tau s + 1)^3}
|
|
\end{align*}
|
|
|
|
<p>
|
|
<a class='org-ref-reference' href="#baerveldt97_low_cost_low_weigh_attit">baerveldt97_low_cost_low_weigh_attit</a>
|
|
</p>
|
|
\begin{align*}
|
|
H_L(s) = \frac{2 \tau s + 1}{(\tau s + 1)^2} \\
|
|
H_H(s) = \frac{\tau^2 s^2}{(\tau s + 1)^2}
|
|
\end{align*}
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-org0e2cc35" class="outline-4">
|
|
<h4 id="org0e2cc35"><span class="section-number-4">7.4.2</span> Matlab</h4>
|
|
<div class="outline-text-4" id="text-7-4-2">
|
|
<div class="org-src-container">
|
|
<pre class="src src-matlab">omega0 = <span class="org-highlight-numbers-number">1</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-comment">% [rad/s]</span>
|
|
tau = <span class="org-highlight-numbers-number">1</span><span class="org-type">/</span>omega0; <span class="org-comment">% [s]</span>
|
|
|
|
<span class="org-comment">% From cite:corke04_inert_visual_sensin_system_small_auton_helic</span>
|
|
HL1 = <span class="org-highlight-numbers-number">1</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-1">(</span>s<span class="org-type">/</span>omega0 <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>; HH1 = s<span class="org-type">/</span>omega0<span class="org-type">/</span><span class="org-rainbow-delimiters-depth-1">(</span>s<span class="org-type">/</span>omega0 <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span>;
|
|
|
|
<span class="org-comment">% From cite:jensen13_basic_uas</span>
|
|
HL2 = <span class="org-rainbow-delimiters-depth-1">(</span><span class="org-highlight-numbers-number">2</span><span class="org-type">*</span>omega0<span class="org-type">*</span>s <span class="org-type">+</span> omega0<span class="org-type">^</span><span class="org-highlight-numbers-number">2</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>omega0<span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">2</span>; HH2 = s<span class="org-type">^</span><span class="org-highlight-numbers-number">2</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-1">(</span>s<span class="org-type">+</span>omega0<span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">2</span>;
|
|
|
|
<span class="org-comment">% From cite:shaw90_bandw_enhan_posit_measur_using_measur_accel</span>
|
|
HL3 = <span class="org-rainbow-delimiters-depth-1">(</span><span class="org-highlight-numbers-number">3</span><span class="org-type">*</span>tau<span class="org-type">*</span>s <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-1">(</span>tau<span class="org-type">*</span>s <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">3</span>; HH3 = <span class="org-rainbow-delimiters-depth-1">(</span>tau<span class="org-type">^</span><span class="org-highlight-numbers-number">3</span><span class="org-type">*</span>s<span class="org-type">^</span><span class="org-highlight-numbers-number">3</span> <span class="org-type">+</span> <span class="org-highlight-numbers-number">3</span><span class="org-type">*</span>tau<span class="org-type">^</span><span class="org-highlight-numbers-number">2</span><span class="org-type">*</span>s<span class="org-type">^</span><span class="org-highlight-numbers-number">2</span><span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">/</span><span class="org-rainbow-delimiters-depth-1">(</span>tau<span class="org-type">*</span>s <span class="org-type">+</span> <span class="org-highlight-numbers-number">1</span><span class="org-rainbow-delimiters-depth-1">)</span><span class="org-type">^</span><span class="org-highlight-numbers-number">3</span>;
|
|
</pre>
|
|
</div>
|
|
|
|
|
|
<div id="org708881a" class="figure">
|
|
<p><img src="figs/comp_filters_literature.png" alt="comp_filters_literature.png" />
|
|
</p>
|
|
<p><span class="figure-number">Figure 59: </span>Comparison of some complementary filters found in the literature (<a href="./figs/comp_filters_literature.png">png</a>, <a href="./figs/comp_filters_literature.pdf">pdf</a>)</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orga267e9d" class="outline-4">
|
|
<h4 id="orga267e9d"><span class="section-number-4">7.4.3</span> Discussion</h4>
|
|
<div class="outline-text-4" id="text-7-4-3">
|
|
<p>
|
|
Analytical Formula found in the literature provides either no parameter for tuning the robustness / performance trade-off.
|
|
</p>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<div id="outline-container-orgfc3780b" class="outline-3">
|
|
<h3 id="orgfc3780b"><span class="section-number-3">7.5</span> Comparison of the different methods of synthesis</h3>
|
|
<div class="outline-text-3" id="text-7-5">
|
|
<p>
|
|
<a id="org1bd00b2"></a>
|
|
The generated complementary filters using \(\mathcal{H}_\infty\) and the analytical formulas are very close to each other. However there is some difference to note here:
|
|
</p>
|
|
<ul class="org-ul">
|
|
<li>the analytical formula provides a very simple way to generate the complementary filters (and thus the controller), they could even be used to tune the controller online using the parameters \(\alpha\) and \(\omega_0\). However, these formula have the property that \(|H_H|\) and \(|H_L|\) are symmetrical with the frequency \(\omega_0\) which may not be desirable.</li>
|
|
<li>while the \(\mathcal{H}_\infty\) synthesis of the complementary filters is not as straightforward as using the analytical formula, it provides a more optimized procedure to obtain the complementary filters</li>
|
|
</ul>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
<p>
|
|
|
|
<h1 class='org-ref-bib-h1'>Bibliography</h1>
|
|
<ul class='org-ref-bib'><li><a id="barzilai98_techn_measur_noise_sensor_presen">[barzilai98_techn_measur_noise_sensor_presen]</a> <a name="barzilai98_techn_measur_noise_sensor_presen"></a>Aaron Barzilai, Tom VanZandt & Tom Kenny, Technique for Measurement of the Noise of a Sensor in the Presence of Large Background Signals, <i>Review of Scientific Instruments</i>, <b>69(7)</b>, 2767-2772 (1998). <a href="https://doi.org/10.1063/1.1149013">link</a>. <a href="http://dx.doi.org/10.1063/1.1149013">doi</a>.</li>
|
|
<li><a id="min15_compl_filter_desig_angle_estim">[min15_compl_filter_desig_angle_estim]</a> <a name="min15_compl_filter_desig_angle_estim"></a>Min & Jeung, Complementary Filter Design for Angle Estimation Using Mems Accelerometer and Gyroscope, <i>Department of Control and Instrumentation, Changwon National University, Changwon, Korea</i>, 641-773 (2015).</li>
|
|
<li><a id="corke04_inert_visual_sensin_system_small_auton_helic">[corke04_inert_visual_sensin_system_small_auton_helic]</a> <a name="corke04_inert_visual_sensin_system_small_auton_helic"></a>Peter Corke, An Inertial and Visual Sensing System for a Small Autonomous Helicopter, <i>Journal of Robotic Systems</i>, <b>21(2)</b>, 43-51 (2004). <a href="https://doi.org/10.1002/rob.10127">link</a>. <a href="http://dx.doi.org/10.1002/rob.10127">doi</a>.</li>
|
|
<li><a id="jensen13_basic_uas">[jensen13_basic_uas]</a> <a name="jensen13_basic_uas"></a>Austin Jensen, Cal Coopmans & YangQuan Chen, Basics and guidelines of complementary filters for small UAS navigation, nil, in in: 2013 International Conference on Unmanned Aircraft Systems
|
|
(ICUAS), edited by (2013)</li>
|
|
<li><a id="shaw90_bandw_enhan_posit_measur_using_measur_accel">[shaw90_bandw_enhan_posit_measur_using_measur_accel]</a> <a name="shaw90_bandw_enhan_posit_measur_using_measur_accel"></a>Shaw & Srinivasan, Bandwidth Enhancement of Position Measurements Using Measured Acceleration, <i>Mechanical Systems and Signal Processing</i>, <b>4(1)</b>, 23-38 (1990). <a href="https://doi.org/10.1016/0888-3270(90)90038-m">link</a>. <a href="http://dx.doi.org/10.1016/0888-3270(90)90038-m">doi</a>.</li>
|
|
<li><a id="baerveldt97_low_cost_low_weigh_attit">[baerveldt97_low_cost_low_weigh_attit]</a> <a name="baerveldt97_low_cost_low_weigh_attit"></a>Baerveldt & Klang, A Low-Cost and Low-Weight Attitude Estimation System for an Autonomous Helicopter, nil, in in: Proceedings of IEEE International Conference on Intelligent Engineering Systems, edited by (1997)</li>
|
|
</ul>
|
|
</p>
|
|
</div>
|
|
<div id="postamble" class="status">
|
|
<p class="author">Author: Thomas Dehaeze</p>
|
|
<p class="date">Created: 2019-09-03 mar. 09:02</p>
|
|
<p class="validation"><a href="http://validator.w3.org/check?uri=referer">Validate</a></p>
|
|
</div>
|
|
</body>
|
|
</html>
|