1 | <?xml version='1.0' encoding='UTF-8' standalone='no'?> |
---|
2 | <doxygen xmlns:xsi="http://www.w3.org/2001/XMLSchema-instance" xsi:noNamespaceSchemaLocation="compound.xsd" version="1.5.6"> |
---|
3 | <compounddef id="pmsm__sim3_8cpp" kind="file"> |
---|
4 | <compoundname>pmsm_sim3.cpp</compoundname> |
---|
5 | <includes local="no">itpp/itbase.h</includes> |
---|
6 | <includes refid="libKF_8h" local="no">estim/libKF.h</includes> |
---|
7 | <includes refid="libPF_8h" local="no">estim/libPF.h</includes> |
---|
8 | <includes refid="libFN_8h" local="no">stat/libFN.h</includes> |
---|
9 | <includes refid="pmsm_8h" local="yes">pmsm.h</includes> |
---|
10 | <includes refid="simulator_8h" local="yes">simulator.h</includes> |
---|
11 | <includes local="yes">../simulator_zdenek/ekf_example/ekf_obj.h</includes> |
---|
12 | <includes local="yes">iopom.h</includes> |
---|
13 | <incdepgraph> |
---|
14 | <node id="624"> |
---|
15 | <label>../simulator_zdenek/ekf_example/ekf_obj.h</label> |
---|
16 | </node> |
---|
17 | <node id="616"> |
---|
18 | <label>libBM.h</label> |
---|
19 | <link refid="libBM_8h"/> |
---|
20 | <childnode refid="613" relation="include"> |
---|
21 | </childnode> |
---|
22 | </node> |
---|
23 | <node id="623"> |
---|
24 | <label>simulator.h</label> |
---|
25 | <link refid="simulator_8h-source"/> |
---|
26 | </node> |
---|
27 | <node id="622"> |
---|
28 | <label>pmsm.h</label> |
---|
29 | <link refid="pmsm_8h-source"/> |
---|
30 | <childnode refid="615" relation="include"> |
---|
31 | </childnode> |
---|
32 | </node> |
---|
33 | <node id="625"> |
---|
34 | <label>iopom.h</label> |
---|
35 | </node> |
---|
36 | <node id="619"> |
---|
37 | <label>../itpp_ext.h</label> |
---|
38 | <link refid="itpp__ext_8h-source"/> |
---|
39 | <childnode refid="613" relation="include"> |
---|
40 | </childnode> |
---|
41 | </node> |
---|
42 | <node id="617"> |
---|
43 | <label>../stat/libEF.h</label> |
---|
44 | <link refid="libEF_8h"/> |
---|
45 | <childnode refid="613" relation="include"> |
---|
46 | </childnode> |
---|
47 | <childnode refid="618" relation="include"> |
---|
48 | </childnode> |
---|
49 | <childnode refid="616" relation="include"> |
---|
50 | </childnode> |
---|
51 | <childnode refid="619" relation="include"> |
---|
52 | </childnode> |
---|
53 | </node> |
---|
54 | <node id="621"> |
---|
55 | <label>estim/libPF.h</label> |
---|
56 | <link refid="libPF_8h"/> |
---|
57 | <childnode refid="613" relation="include"> |
---|
58 | </childnode> |
---|
59 | <childnode refid="617" relation="include"> |
---|
60 | </childnode> |
---|
61 | <childnode refid="618" relation="include"> |
---|
62 | </childnode> |
---|
63 | </node> |
---|
64 | <node id="615"> |
---|
65 | <label>../stat/libFN.h</label> |
---|
66 | <link refid="libFN_8h-source"/> |
---|
67 | <childnode refid="613" relation="include"> |
---|
68 | </childnode> |
---|
69 | <childnode refid="616" relation="include"> |
---|
70 | </childnode> |
---|
71 | </node> |
---|
72 | <node id="613"> |
---|
73 | <label>itpp/itbase.h</label> |
---|
74 | </node> |
---|
75 | <node id="612"> |
---|
76 | <label>work/git/mixpp/pmsm/pmsm_sim3.cpp</label> |
---|
77 | <link refid="pmsm_sim3.cpp"/> |
---|
78 | <childnode refid="613" relation="include"> |
---|
79 | </childnode> |
---|
80 | <childnode refid="614" relation="include"> |
---|
81 | </childnode> |
---|
82 | <childnode refid="621" relation="include"> |
---|
83 | </childnode> |
---|
84 | <childnode refid="615" relation="include"> |
---|
85 | </childnode> |
---|
86 | <childnode refid="622" relation="include"> |
---|
87 | </childnode> |
---|
88 | <childnode refid="623" relation="include"> |
---|
89 | </childnode> |
---|
90 | <childnode refid="624" relation="include"> |
---|
91 | </childnode> |
---|
92 | <childnode refid="625" relation="include"> |
---|
93 | </childnode> |
---|
94 | </node> |
---|
95 | <node id="620"> |
---|
96 | <label>../math/chmat.h</label> |
---|
97 | <link refid="chmat_8h"/> |
---|
98 | <childnode refid="613" relation="include"> |
---|
99 | </childnode> |
---|
100 | <childnode refid="618" relation="include"> |
---|
101 | </childnode> |
---|
102 | <childnode refid="619" relation="include"> |
---|
103 | </childnode> |
---|
104 | </node> |
---|
105 | <node id="614"> |
---|
106 | <label>estim/libKF.h</label> |
---|
107 | <link refid="libKF_8h"/> |
---|
108 | <childnode refid="613" relation="include"> |
---|
109 | </childnode> |
---|
110 | <childnode refid="615" relation="include"> |
---|
111 | </childnode> |
---|
112 | <childnode refid="617" relation="include"> |
---|
113 | </childnode> |
---|
114 | <childnode refid="620" relation="include"> |
---|
115 | </childnode> |
---|
116 | </node> |
---|
117 | <node id="618"> |
---|
118 | <label>../math/libDC.h</label> |
---|
119 | <link refid="libDC_8h"/> |
---|
120 | <childnode refid="613" relation="include"> |
---|
121 | </childnode> |
---|
122 | </node> |
---|
123 | </incdepgraph> |
---|
124 | <sectiondef kind="func"> |
---|
125 | <memberdef kind="function" id="pmsm__sim3_8cpp_1e447b6cc84b8f808272762ff23bc5eaa" prot="public" static="no" const="no" explicit="no" inline="no" virt="non-virtual"> |
---|
126 | <type>void</type> |
---|
127 | <definition>void set_simulator_t</definition> |
---|
128 | <argsstring>(double &Ww)</argsstring> |
---|
129 | <name>set_simulator_t</name> |
---|
130 | <param> |
---|
131 | <type>double &</type> |
---|
132 | <declname>Ww</declname> |
---|
133 | </param> |
---|
134 | <briefdescription> |
---|
135 | <para>Extended <ref refid="classKalman" kindref="compound">Kalman</ref> filter with unknown <computeroutput>Q</computeroutput>. </para> </briefdescription> |
---|
136 | <detaileddescription> |
---|
137 | </detaileddescription> |
---|
138 | <inbodydescription> |
---|
139 | </inbodydescription> |
---|
140 | <location file="/home/smidl/work/git/mixpp/pmsm/pmsm_sim3.cpp" line="27" bodyfile="/home/smidl/work/git/mixpp/pmsm/pmsm_sim3.cpp" bodystart="27" bodyend="76"/> |
---|
141 | </memberdef> |
---|
142 | <memberdef kind="function" id="pmsm__sim3_8cpp_1e66f6b31b5ad750f1fe042a706a4e3d4" prot="public" static="no" const="no" explicit="no" inline="no" virt="non-virtual"> |
---|
143 | <type>int</type> |
---|
144 | <definition>int main</definition> |
---|
145 | <argsstring>()</argsstring> |
---|
146 | <name>main</name> |
---|
147 | <briefdescription> |
---|
148 | </briefdescription> |
---|
149 | <detaileddescription> |
---|
150 | </detaileddescription> |
---|
151 | <inbodydescription> |
---|
152 | </inbodydescription> |
---|
153 | <location file="/home/smidl/work/git/mixpp/pmsm/pmsm_sim3.cpp" line="78" bodyfile="/home/smidl/work/git/mixpp/pmsm/pmsm_sim3.cpp" bodystart="78" bodyend="165"/> |
---|
154 | </memberdef> |
---|
155 | </sectiondef> |
---|
156 | <briefdescription> |
---|
157 | </briefdescription> |
---|
158 | <detaileddescription> |
---|
159 | </detaileddescription> |
---|
160 | <programlisting> |
---|
161 | <codeline lineno="1"><highlight class="comment">/*</highlight></codeline> |
---|
162 | <codeline lineno="2"><highlight class="comment"><sp/><sp/>\file</highlight></codeline> |
---|
163 | <codeline lineno="3"><highlight class="comment"><sp/><sp/>\brief<sp/>Models<sp/>for<sp/>synchronous<sp/>electric<sp/>drive<sp/>using<sp/>IT++<sp/>and<sp/>BDM</highlight></codeline> |
---|
164 | <codeline lineno="4"><highlight class="comment"><sp/><sp/>\author<sp/>Vaclav<sp/>Smidl.</highlight></codeline> |
---|
165 | <codeline lineno="5"><highlight class="comment"></highlight></codeline> |
---|
166 | <codeline lineno="6"><highlight class="comment"><sp/><sp/>-----------------------------------</highlight></codeline> |
---|
167 | <codeline lineno="7"><highlight class="comment"><sp/><sp/>BDM++<sp/>-<sp/>C++<sp/>library<sp/>for<sp/>Bayesian<sp/>Decision<sp/>Making<sp/>under<sp/>Uncertainty</highlight></codeline> |
---|
168 | <codeline lineno="8"><highlight class="comment"></highlight></codeline> |
---|
169 | <codeline lineno="9"><highlight class="comment"><sp/><sp/>Using<sp/>IT++<sp/>for<sp/>numerical<sp/>operations</highlight></codeline> |
---|
170 | <codeline lineno="10"><highlight class="comment"><sp/><sp/>-----------------------------------</highlight></codeline> |
---|
171 | <codeline lineno="11"><highlight class="comment">*/</highlight><highlight class="normal"></highlight></codeline> |
---|
172 | <codeline lineno="12"><highlight class="normal"></highlight></codeline> |
---|
173 | <codeline lineno="13"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/><itpp/itbase.h></highlight><highlight class="normal"></highlight></codeline> |
---|
174 | <codeline lineno="14"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/><<ref refid="libKF_8h" kindref="compound" tooltip="Bayesian Filtering for linear Gaussian models (Kalman Filter) and extensions.">estim/libKF.h</ref>></highlight><highlight class="normal"></highlight></codeline> |
---|
175 | <codeline lineno="15"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/><<ref refid="libPF_8h" kindref="compound" tooltip="Bayesian Filtering using stochastic sampling (Particle Filters).">estim/libPF.h</ref>></highlight><highlight class="normal"></highlight></codeline> |
---|
176 | <codeline lineno="16"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/><stat/libFN.h></highlight><highlight class="normal"></highlight></codeline> |
---|
177 | <codeline lineno="17"><highlight class="normal"></highlight></codeline> |
---|
178 | <codeline lineno="18"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>"pmsm.h"</highlight><highlight class="normal"></highlight></codeline> |
---|
179 | <codeline lineno="19"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>"simulator.h"</highlight><highlight class="normal"></highlight></codeline> |
---|
180 | <codeline lineno="20"><highlight class="normal"></highlight></codeline> |
---|
181 | <codeline lineno="21"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>"../simulator_zdenek/ekf_example/ekf_obj.h"</highlight><highlight class="normal"></highlight></codeline> |
---|
182 | <codeline lineno="22"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>"iopom.h"</highlight><highlight class="normal"></highlight></codeline> |
---|
183 | <codeline lineno="23"><highlight class="normal"></highlight></codeline> |
---|
184 | <codeline lineno="24"><highlight class="normal"></highlight><highlight class="keyword">using<sp/>namespace<sp/></highlight><highlight class="normal">itpp;</highlight></codeline> |
---|
185 | <codeline lineno="26"><highlight class="normal"></highlight></codeline> |
---|
186 | <codeline lineno="27"><highlight class="normal"></highlight><highlight class="keywordtype">void</highlight><highlight class="normal"><sp/>set_simulator_t(</highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>&Ww)<sp/>{</highlight></codeline> |
---|
187 | <codeline lineno="28"><highlight class="normal"></highlight></codeline> |
---|
188 | <codeline lineno="29"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>0.0002)<sp/>x[8]=1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A<sp/>//0.2ZP</highlight><highlight class="normal"></highlight></codeline> |
---|
189 | <codeline lineno="30"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>0.4)<sp/>x[8]=10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline> |
---|
190 | <codeline lineno="31"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>0.6)<sp/>x[8]=25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline> |
---|
191 | <codeline lineno="32"><highlight class="normal"></highlight></codeline> |
---|
192 | <codeline lineno="33"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>0.7)<sp/>Ww=2.*M_PI*10.;</highlight></codeline> |
---|
193 | <codeline lineno="34"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>1.0)<sp/>x[8]=1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A</highlight><highlight class="normal"></highlight></codeline> |
---|
194 | <codeline lineno="35"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>1.2)<sp/>x[8]=10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline> |
---|
195 | <codeline lineno="36"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>1.4)<sp/>x[8]=25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline> |
---|
196 | <codeline lineno="37"><highlight class="normal"></highlight></codeline> |
---|
197 | <codeline lineno="38"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>1.6)<sp/>Ww=2.*M_PI*50.;</highlight></codeline> |
---|
198 | <codeline lineno="39"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>1.9)<sp/>x[8]=1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A</highlight><highlight class="normal"></highlight></codeline> |
---|
199 | <codeline lineno="40"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>2.1)<sp/>x[8]=10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline> |
---|
200 | <codeline lineno="41"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>2.3)<sp/>x[8]=25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline> |
---|
201 | <codeline lineno="42"><highlight class="normal"></highlight></codeline> |
---|
202 | <codeline lineno="43"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>2.5)<sp/>Ww=2.*M_PI*100;</highlight></codeline> |
---|
203 | <codeline lineno="44"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>2.8)<sp/>x[8]=1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A</highlight><highlight class="normal"></highlight></codeline> |
---|
204 | <codeline lineno="45"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>3.0)<sp/>x[8]=10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline> |
---|
205 | <codeline lineno="46"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>3.2)<sp/>x[8]=25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline> |
---|
206 | <codeline lineno="47"><highlight class="normal"></highlight></codeline> |
---|
207 | <codeline lineno="48"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>3.4)<sp/>Ww=2.*M_PI*150;</highlight></codeline> |
---|
208 | <codeline lineno="49"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>3.7)<sp/>x[8]=1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A</highlight><highlight class="normal"></highlight></codeline> |
---|
209 | <codeline lineno="50"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>3.9)<sp/>x[8]=10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline> |
---|
210 | <codeline lineno="51"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>4.1)<sp/>x[8]=25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline> |
---|
211 | <codeline lineno="52"><highlight class="normal"></highlight></codeline> |
---|
212 | <codeline lineno="53"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>4.3)<sp/>Ww=2.*M_PI*0;</highlight></codeline> |
---|
213 | <codeline lineno="54"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>4.8)<sp/>x[8]=-1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A</highlight><highlight class="normal"></highlight></codeline> |
---|
214 | <codeline lineno="55"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>5.0)<sp/>x[8]=-10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline> |
---|
215 | <codeline lineno="56"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>5.2)<sp/>x[8]=-25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline> |
---|
216 | <codeline lineno="57"><highlight class="normal"></highlight></codeline> |
---|
217 | <codeline lineno="58"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>5.4)<sp/>Ww=2.*M_PI*(-10.);</highlight></codeline> |
---|
218 | <codeline lineno="59"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>5.7)<sp/>x[8]=-1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A</highlight><highlight class="normal"></highlight></codeline> |
---|
219 | <codeline lineno="60"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>5.9)<sp/>x[8]=-10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline> |
---|
220 | <codeline lineno="61"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>6.1)<sp/>x[8]=-25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline> |
---|
221 | <codeline lineno="62"><highlight class="normal"></highlight></codeline> |
---|
222 | <codeline lineno="63"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>6.3)<sp/>Ww=2.*M_PI*(-50.);</highlight></codeline> |
---|
223 | <codeline lineno="64"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>6.7)<sp/>x[8]=-1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A</highlight><highlight class="normal"></highlight></codeline> |
---|
224 | <codeline lineno="65"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>6.9)<sp/>x[8]=-10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline> |
---|
225 | <codeline lineno="66"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>7.1)<sp/>x[8]=-25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline> |
---|
226 | <codeline lineno="67"><highlight class="normal"></highlight></codeline> |
---|
227 | <codeline lineno="68"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>7.3)<sp/>Ww=2.*M_PI*(-100.);</highlight></codeline> |
---|
228 | <codeline lineno="69"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>7.7)<sp/>x[8]=-1.2;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1A</highlight><highlight class="normal"></highlight></codeline> |
---|
229 | <codeline lineno="70"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>7.9)<sp/>x[8]=-10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline> |
---|
230 | <codeline lineno="71"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>8.1)<sp/>x[8]=-25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline> |
---|
231 | <codeline lineno="72"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>8.3)<sp/>x[8]=10.8;<sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>9A</highlight><highlight class="normal"></highlight></codeline> |
---|
232 | <codeline lineno="73"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(t>8.5)<sp/>x[8]=25.2;<sp/><sp/></highlight><highlight class="comment">//<sp/>21A</highlight><highlight class="normal"></highlight></codeline> |
---|
233 | <codeline lineno="74"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight></codeline> |
---|
234 | <codeline lineno="75"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>x[8]=0.0;</highlight></codeline> |
---|
235 | <codeline lineno="76"><highlight class="normal">}</highlight></codeline> |
---|
236 | <codeline lineno="77"><highlight class="normal"></highlight></codeline> |
---|
237 | <codeline lineno="78"><highlight class="normal"></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/><ref refid="sim__var_8cpp_1e66f6b31b5ad750f1fe042a706a4e3d4" kindref="member" tooltip="Extended Kalman filter with unknown Q.">main</ref>()<sp/>{</highlight></codeline> |
---|
238 | <codeline lineno="79"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>Kalman<sp/>filter</highlight><highlight class="normal"></highlight></codeline> |
---|
239 | <codeline lineno="80"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>Ndat<sp/>=<sp/>90000;</highlight></codeline> |
---|
240 | <codeline lineno="81"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>h<sp/>=<sp/>1e-6;</highlight></codeline> |
---|
241 | <codeline lineno="82"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>Nsimstep<sp/>=<sp/>125;</highlight></codeline> |
---|
242 | <codeline lineno="83"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>Npart<sp/>=<sp/>100;</highlight></codeline> |
---|
243 | <codeline lineno="84"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight></codeline> |
---|
244 | <codeline lineno="85"><highlight class="normal"></highlight></codeline> |
---|
245 | <codeline lineno="86"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>vec<sp/>mu0=<sp/></highlight><highlight class="stringliteral">"0.0<sp/>0.0<sp/>0.0<sp/>0.0"</highlight><highlight class="normal">;</highlight></codeline> |
---|
246 | <codeline lineno="87"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>vec<sp/>Qdiag<sp/>(<sp/></highlight><highlight class="stringliteral">"0.05<sp/>0.05<sp/>0.002<sp/>0.001"</highlight><highlight class="normal"><sp/>);<sp/></highlight><highlight class="comment">//zdenek:<sp/>0.01<sp/>0.01<sp/>0.0001<sp/>0.0001</highlight><highlight class="normal"></highlight></codeline> |
---|
247 | <codeline lineno="88"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>vec<sp/>Rdiag<sp/>(<sp/></highlight><highlight class="stringliteral">"0.05<sp/>0.05"</highlight><highlight class="normal"><sp/>);<sp/></highlight><highlight class="comment">//var(diff(xth))<sp/>=<sp/>"0.034<sp/>0.034"</highlight><highlight class="normal"></highlight></codeline> |
---|
248 | <codeline lineno="89"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><ref refid="classchmat" kindref="compound" tooltip="Symmetric matrix stored in square root decomposition using upper cholesky.">chmat</ref><sp/>Q<sp/>(<sp/>Qdiag<sp/>);</highlight></codeline> |
---|
249 | <codeline lineno="90"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><ref refid="classchmat" kindref="compound" tooltip="Symmetric matrix stored in square root decomposition using upper cholesky.">chmat</ref><sp/>R<sp/>(<sp/>Rdiag<sp/>);</highlight></codeline> |
---|
250 | <codeline lineno="91"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight></codeline> |
---|
251 | <codeline lineno="92"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><ref refid="classRV" kindref="compound" tooltip="Class representing variables, most often random variables.">RV</ref><sp/>rQ<sp/>(<sp/></highlight><highlight class="stringliteral">"100"</highlight><highlight class="normal">,</highlight><highlight class="stringliteral">"{Q}"</highlight><highlight class="normal">,</highlight><highlight class="stringliteral">"4"</highlight><highlight class="normal">,</highlight><highlight class="stringliteral">"0"</highlight><highlight class="normal"><sp/>);</highlight></codeline> |
---|
252 | <codeline lineno="93"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><ref refid="classEKFfixed" kindref="compound" tooltip="Extended Kalman Filter with full matrices in fixed point arithmetic.">EKFfixed</ref><sp/>KFE<sp/>(<sp/>rx,<sp/>rQ);</highlight></codeline> |
---|
253 | <codeline lineno="94"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>KFE.init_ekf<sp/>(<sp/>Nsimstep*h);</highlight></codeline> |
---|
254 | <codeline lineno="95"><highlight class="normal"></highlight></codeline> |
---|
255 | <codeline lineno="96"><highlight class="normal"></highlight></codeline> |
---|
256 | <codeline lineno="98"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><ref refid="classmgamma__fix" kindref="compound" tooltip="Gamma random walk around a fixed point.">mgamma_fix</ref><sp/>evolQ<sp/>(<sp/>rQ,rQ<sp/>);</highlight></codeline> |
---|
257 | <codeline lineno="99"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><ref refid="classMPF" kindref="compound" tooltip="Marginalized Particle filter.">MPF<EKFfixed></ref><sp/>M<sp/>(<sp/>rx,rQ,evolQ,evolQ,Npart,KFE<sp/>);</highlight></codeline> |
---|
258 | <codeline lineno="100"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>initialize</highlight><highlight class="normal"></highlight></codeline> |
---|
259 | <codeline lineno="101"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>evolQ.set_parameters<sp/>(<sp/>10.0<sp/>,Qdiag,<sp/>1.0);<sp/></highlight><highlight class="comment">//sigma<sp/>=<sp/>1/10<sp/>mu</highlight><highlight class="normal"></highlight></codeline> |
---|
260 | <codeline lineno="102"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>evolQ.condition<sp/>(<sp/>Qdiag<sp/>);<sp/></highlight><highlight class="comment">//Zdenek<sp/>default</highlight><highlight class="normal"></highlight></codeline> |
---|
261 | <codeline lineno="103"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><ref refid="classepdf" kindref="compound" tooltip="Probability density function with numerical statistics, e.g. posterior density.">epdf</ref>&<sp/>pfinit=evolQ._epdf();</highlight></codeline> |
---|
262 | <codeline lineno="104"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>M.set_est<sp/>(<sp/>pfinit<sp/>);</highlight></codeline> |
---|
263 | <codeline lineno="105"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>evolQ.set_parameters<sp/>(<sp/>500000.0,<sp/>Qdiag,<sp/>0.9999<sp/>);</highlight></codeline> |
---|
264 | <codeline lineno="106"><highlight class="normal"></highlight></codeline> |
---|
265 | <codeline lineno="107"><highlight class="normal"></highlight></codeline> |
---|
266 | <codeline lineno="108"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><ref refid="classepdf" kindref="compound" tooltip="Probability density function with numerical statistics, e.g. posterior density.">epdf</ref>&<sp/>KFEep<sp/>=<sp/>KFE._epdf();</highlight></codeline> |
---|
267 | <codeline lineno="109"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><ref refid="classepdf" kindref="compound" tooltip="Probability density function with numerical statistics, e.g. posterior density.">epdf</ref>&<sp/>Mep<sp/>=<sp/>M._epdf();</highlight></codeline> |
---|
268 | <codeline lineno="110"><highlight class="normal"></highlight></codeline> |
---|
269 | <codeline lineno="111"><highlight class="normal"></highlight></codeline> |
---|
270 | <codeline lineno="112"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>mat<sp/>Xt=zeros<sp/>(<sp/>Ndat<sp/>,9<sp/>);<sp/></highlight><highlight class="comment">//true<sp/>state<sp/>from<sp/>simulator</highlight><highlight class="normal"></highlight></codeline> |
---|
271 | <codeline lineno="113"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>mat<sp/>Dt=zeros<sp/>(<sp/>Ndat,4<sp/>);<sp/></highlight><highlight class="comment">//observation</highlight><highlight class="normal"></highlight></codeline> |
---|
272 | <codeline lineno="114"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>mat<sp/>XtE=zeros<sp/>(<sp/>Ndat,<sp/>4<sp/>);</highlight></codeline> |
---|
273 | <codeline lineno="115"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>mat<sp/>XtM=zeros<sp/>(<sp/>Ndat,4+4<sp/>);<sp/></highlight><highlight class="comment">//Q<sp/>+<sp/>x</highlight><highlight class="normal"></highlight></codeline> |
---|
274 | <codeline lineno="116"><highlight class="normal"></highlight></codeline> |
---|
275 | <codeline lineno="117"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>SET<sp/>SIMULATOR</highlight><highlight class="normal"></highlight></codeline> |
---|
276 | <codeline lineno="118"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>pmsmsim_set_parameters<sp/>(<sp/>0.28,0.003465,0.1989,0.0,4,1.5,0.04,<sp/>200.,<sp/>3e-6,<sp/>h<sp/>);</highlight></codeline> |
---|
277 | <codeline lineno="119"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>Ww=0.0;</highlight></codeline> |
---|
278 | <codeline lineno="120"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>k_rampa=1;</highlight></codeline> |
---|
279 | <codeline lineno="121"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keyword">static</highlight><highlight class="normal"><sp/></highlight><highlight class="keywordtype">long</highlight><highlight class="normal"><sp/>k_rampa_tmp=0;</highlight></codeline> |
---|
280 | <codeline lineno="122"><highlight class="normal"></highlight></codeline> |
---|
281 | <codeline lineno="123"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>vec<sp/>dt<sp/>(<sp/>2<sp/>);</highlight></codeline> |
---|
282 | <codeline lineno="124"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>vec<sp/>ut<sp/>(<sp/>2<sp/>);</highlight></codeline> |
---|
283 | <codeline lineno="125"><highlight class="normal"></highlight></codeline> |
---|
284 | <codeline lineno="126"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">for</highlight><highlight class="normal"><sp/>(<sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>tK=1;tK<Ndat;tK++<sp/>)<sp/>{</highlight></codeline> |
---|
285 | <codeline lineno="127"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//Number<sp/>of<sp/>steps<sp/>of<sp/>a<sp/>simulator<sp/>for<sp/>one<sp/>step<sp/>of<sp/>Kalman</highlight><highlight class="normal"></highlight></codeline> |
---|
286 | <codeline lineno="128"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">for</highlight><highlight class="normal"><sp/>(<sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>ii=0;<sp/>ii<Nsimstep;ii++<sp/>)<sp/>{</highlight></codeline> |
---|
287 | <codeline lineno="129"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//simulator</highlight><highlight class="normal"></highlight></codeline> |
---|
288 | <codeline lineno="130"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Ww+=k_rampa*2.*M_PI*2e-4;<sp/><sp/><sp/><sp/></highlight><highlight class="comment">//1000Hz/s</highlight><highlight class="normal"></highlight></codeline> |
---|
289 | <codeline lineno="131"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(<sp/>Ww>2.*M_PI*150.<sp/>)<sp/>{</highlight></codeline> |
---|
290 | <codeline lineno="132"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Ww=2.*M_PI*150.;</highlight></codeline> |
---|
291 | <codeline lineno="133"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(<sp/>k_rampa_tmp<500000<sp/>)<sp/>k_rampa_tmp++;</highlight></codeline> |
---|
292 | <codeline lineno="134"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">else</highlight><highlight class="normal"><sp/>{k_rampa=-1;k_rampa_tmp=0;}</highlight></codeline> |
---|
293 | <codeline lineno="135"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>};</highlight></codeline> |
---|
294 | <codeline lineno="136"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">if</highlight><highlight class="normal"><sp/>(<sp/>Ww<-2.*M_PI*150.<sp/>)<sp/>Ww=-2.*M_PI*150.;<sp/></highlight><highlight class="comment">/*<sp/>*/</highlight><highlight class="normal"></highlight></codeline> |
---|
295 | <codeline lineno="137"><highlight class="normal"></highlight><highlight class="comment">//<sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>set_simulator_t(Ww);</highlight><highlight class="normal"></highlight></codeline> |
---|
296 | <codeline lineno="138"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>pmsmsim_step<sp/>(<sp/>Ww<sp/>);</highlight></codeline> |
---|
297 | <codeline lineno="139"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>};</highlight></codeline> |
---|
298 | <codeline lineno="140"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>collect<sp/>data</highlight><highlight class="normal"></highlight></codeline> |
---|
299 | <codeline lineno="141"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>ut<sp/>(<sp/>0<sp/>)<sp/>=<sp/>KalmanObs[0];</highlight></codeline> |
---|
300 | <codeline lineno="142"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>ut<sp/>(<sp/>1<sp/>)<sp/>=<sp/>KalmanObs[1];</highlight></codeline> |
---|
301 | <codeline lineno="143"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>dt<sp/>(<sp/>0<sp/>)<sp/>=<sp/>KalmanObs[2];</highlight></codeline> |
---|
302 | <codeline lineno="144"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>dt<sp/>(<sp/>1<sp/>)<sp/>=<sp/>KalmanObs[3];</highlight></codeline> |
---|
303 | <codeline lineno="145"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//estimator</highlight><highlight class="normal"></highlight></codeline> |
---|
304 | <codeline lineno="146"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>KFE.bayes<sp/>(<sp/>concat<sp/>(<sp/>dt,ut<sp/>)<sp/>);</highlight></codeline> |
---|
305 | <codeline lineno="147"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>M.bayes<sp/>(<sp/>concat<sp/>(<sp/>dt,ut<sp/>)<sp/>);</highlight></codeline> |
---|
306 | <codeline lineno="148"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight></codeline> |
---|
307 | <codeline lineno="149"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Xt.set_row<sp/>(<sp/>tK,vec<sp/>(<sp/>x,9<sp/>)<sp/>);<sp/></highlight><highlight class="comment">//vec<sp/>from<sp/>C-array</highlight><highlight class="normal"></highlight></codeline> |
---|
308 | <codeline lineno="150"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Dt.set_row<sp/>(<sp/>tK,<sp/>concat<sp/>(<sp/>dt,ut));</highlight></codeline> |
---|
309 | <codeline lineno="151"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>XtE.set_row<sp/>(<sp/>tK,KFEep.<ref refid="classepdf_1bf0a070a8f3e67a93604ca724638b870" kindref="member" tooltip="return expected value">mean</ref>()<sp/>);</highlight></codeline> |
---|
310 | <codeline lineno="152"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>XtM.set_row<sp/>(<sp/>tK,Mep.<ref refid="classepdf_1bf0a070a8f3e67a93604ca724638b870" kindref="member" tooltip="return expected value">mean</ref>()<sp/>);</highlight></codeline> |
---|
311 | <codeline lineno="153"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>}</highlight></codeline> |
---|
312 | <codeline lineno="154"><highlight class="normal"></highlight></codeline> |
---|
313 | <codeline lineno="155"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordtype">char</highlight><highlight class="normal"><sp/>tmpstr[200];</highlight></codeline> |
---|
314 | <codeline lineno="156"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>sprintf(tmpstr,</highlight><highlight class="stringliteral">"%s/%s"</highlight><highlight class="normal">,</highlight><highlight class="stringliteral">"herez/"</highlight><highlight class="normal">,</highlight><highlight class="stringliteral">"format"</highlight><highlight class="normal">);</highlight></codeline> |
---|
315 | <codeline lineno="157"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>ofstream<sp/><sp/>form(tmpstr);</highlight></codeline> |
---|
316 | <codeline lineno="158"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>form<sp/><<<sp/></highlight><highlight class="stringliteral">"#<sp/>Experimetal<sp/>header<sp/>file"</highlight><highlight class="normal"><<<sp/>endl;</highlight></codeline> |
---|
317 | <codeline lineno="159"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>dirfile_write(form,</highlight><highlight class="stringliteral">"herez/"</highlight><highlight class="normal">,Xt,</highlight><highlight class="stringliteral">"X"</highlight><highlight class="normal">,</highlight><highlight class="stringliteral">"{isa<sp/>isb<sp/>om<sp/>th<sp/>}"</highlight><highlight class="normal"><sp/>);</highlight></codeline> |
---|
318 | <codeline lineno="160"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>dirfile_write<sp/>(<sp/>form,</highlight><highlight class="stringliteral">"herez"</highlight><highlight class="normal">,XtM,</highlight><highlight class="stringliteral">"XtM"</highlight><highlight class="normal">,</highlight><highlight class="stringliteral">"{q1<sp/>q2<sp/>q3<sp/>q4<sp/>isa<sp/>isb<sp/>om<sp/>th<sp/>}"</highlight><highlight class="normal"><sp/>);</highlight></codeline> |
---|
319 | <codeline lineno="161"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>dirfile_write<sp/>(<sp/>form,</highlight><highlight class="stringliteral">"herez"</highlight><highlight class="normal">,XtE,</highlight><highlight class="stringliteral">"XE"</highlight><highlight class="normal">,</highlight><highlight class="stringliteral">"{isa<sp/>isb<sp/>om<sp/>th<sp/>}"</highlight><highlight class="normal"><sp/>);</highlight></codeline> |
---|
320 | <codeline lineno="162"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>dirfile_write<sp/>(<sp/>form,</highlight><highlight class="stringliteral">"herez"</highlight><highlight class="normal">,Dt,</highlight><highlight class="stringliteral">"Dt"</highlight><highlight class="normal">,</highlight><highlight class="stringliteral">"{isa<sp/>isb<sp/>ua<sp/>ub<sp/>}"</highlight><highlight class="normal"><sp/>);</highlight></codeline> |
---|
321 | <codeline lineno="163"><highlight class="normal"></highlight></codeline> |
---|
322 | <codeline lineno="164"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordflow">return</highlight><highlight class="normal"><sp/>0;</highlight></codeline> |
---|
323 | <codeline lineno="165"><highlight class="normal">}</highlight></codeline> |
---|
324 | <codeline lineno="166"><highlight class="normal"></highlight></codeline> |
---|
325 | </programlisting> |
---|
326 | <location file="/home/smidl/work/git/mixpp/pmsm/pmsm_sim3.cpp"/> |
---|
327 | </compounddef> |
---|
328 | </doxygen> |
---|