| 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="ekf__obj_8h" kind="file"> |
|---|
| 4 | <compoundname>ekf_obj.h</compoundname> |
|---|
| 5 | <includes local="no">itpp/itbase.h</includes> |
|---|
| 6 | <includes refid="libKF_8h" local="no">estim/libKF.h</includes> |
|---|
| 7 | <includes refid="fixed_8h" local="yes">fixed.h</includes> |
|---|
| 8 | <includes refid="matrix_8h" local="yes">matrix.h</includes> |
|---|
| 9 | <includes refid="reference_8h" local="yes">reference.h</includes> |
|---|
| 10 | <includes refid="parametry__motoru_8h" local="yes">parametry_motoru.h</includes> |
|---|
| 11 | <includedby refid="ekf__obj_8cpp" local="yes">work/git/mixpp/pmsm/simulator_zdenek/ekf_example/ekf_obj.cpp</includedby> |
|---|
| 12 | <incdepgraph> |
|---|
| 13 | <node id="741"> |
|---|
| 14 | <label>libBM.h</label> |
|---|
| 15 | <link refid="libBM_8h"/> |
|---|
| 16 | <childnode refid="738" relation="include"> |
|---|
| 17 | </childnode> |
|---|
| 18 | </node> |
|---|
| 19 | <node id="744"> |
|---|
| 20 | <label>../itpp_ext.h</label> |
|---|
| 21 | <link refid="itpp__ext_8h-source"/> |
|---|
| 22 | <childnode refid="738" relation="include"> |
|---|
| 23 | </childnode> |
|---|
| 24 | </node> |
|---|
| 25 | <node id="742"> |
|---|
| 26 | <label>../stat/libEF.h</label> |
|---|
| 27 | <link refid="libEF_8h"/> |
|---|
| 28 | <childnode refid="738" relation="include"> |
|---|
| 29 | </childnode> |
|---|
| 30 | <childnode refid="743" relation="include"> |
|---|
| 31 | </childnode> |
|---|
| 32 | <childnode refid="741" relation="include"> |
|---|
| 33 | </childnode> |
|---|
| 34 | <childnode refid="744" relation="include"> |
|---|
| 35 | </childnode> |
|---|
| 36 | </node> |
|---|
| 37 | <node id="740"> |
|---|
| 38 | <label>../stat/libFN.h</label> |
|---|
| 39 | <link refid="libFN_8h-source"/> |
|---|
| 40 | <childnode refid="738" relation="include"> |
|---|
| 41 | </childnode> |
|---|
| 42 | <childnode refid="741" relation="include"> |
|---|
| 43 | </childnode> |
|---|
| 44 | </node> |
|---|
| 45 | <node id="748"> |
|---|
| 46 | <label>reference.h</label> |
|---|
| 47 | <link refid="reference_8h-source"/> |
|---|
| 48 | </node> |
|---|
| 49 | <node id="738"> |
|---|
| 50 | <label>itpp/itbase.h</label> |
|---|
| 51 | </node> |
|---|
| 52 | <node id="746"> |
|---|
| 53 | <label>fixed.h</label> |
|---|
| 54 | <link refid="fixed_8h-source"/> |
|---|
| 55 | </node> |
|---|
| 56 | <node id="745"> |
|---|
| 57 | <label>../math/chmat.h</label> |
|---|
| 58 | <link refid="chmat_8h"/> |
|---|
| 59 | <childnode refid="738" relation="include"> |
|---|
| 60 | </childnode> |
|---|
| 61 | <childnode refid="743" relation="include"> |
|---|
| 62 | </childnode> |
|---|
| 63 | <childnode refid="744" relation="include"> |
|---|
| 64 | </childnode> |
|---|
| 65 | </node> |
|---|
| 66 | <node id="739"> |
|---|
| 67 | <label>estim/libKF.h</label> |
|---|
| 68 | <link refid="libKF_8h"/> |
|---|
| 69 | <childnode refid="738" relation="include"> |
|---|
| 70 | </childnode> |
|---|
| 71 | <childnode refid="740" relation="include"> |
|---|
| 72 | </childnode> |
|---|
| 73 | <childnode refid="742" relation="include"> |
|---|
| 74 | </childnode> |
|---|
| 75 | <childnode refid="745" relation="include"> |
|---|
| 76 | </childnode> |
|---|
| 77 | </node> |
|---|
| 78 | <node id="743"> |
|---|
| 79 | <label>../math/libDC.h</label> |
|---|
| 80 | <link refid="libDC_8h"/> |
|---|
| 81 | <childnode refid="738" relation="include"> |
|---|
| 82 | </childnode> |
|---|
| 83 | </node> |
|---|
| 84 | <node id="747"> |
|---|
| 85 | <label>matrix.h</label> |
|---|
| 86 | <link refid="matrix_8h-source"/> |
|---|
| 87 | </node> |
|---|
| 88 | <node id="749"> |
|---|
| 89 | <label>parametry_motoru.h</label> |
|---|
| 90 | <link refid="parametry__motoru_8h-source"/> |
|---|
| 91 | </node> |
|---|
| 92 | <node id="737"> |
|---|
| 93 | <label>work/git/mixpp/pmsm/simulator_zdenek/ekf_example/ekf_obj.h</label> |
|---|
| 94 | <link refid="ekf_obj.h"/> |
|---|
| 95 | <childnode refid="738" relation="include"> |
|---|
| 96 | </childnode> |
|---|
| 97 | <childnode refid="739" relation="include"> |
|---|
| 98 | </childnode> |
|---|
| 99 | <childnode refid="746" relation="include"> |
|---|
| 100 | </childnode> |
|---|
| 101 | <childnode refid="747" relation="include"> |
|---|
| 102 | </childnode> |
|---|
| 103 | <childnode refid="748" relation="include"> |
|---|
| 104 | </childnode> |
|---|
| 105 | <childnode refid="749" relation="include"> |
|---|
| 106 | </childnode> |
|---|
| 107 | </node> |
|---|
| 108 | </incdepgraph> |
|---|
| 109 | <innerclass refid="classEKFfixed" prot="public">EKFfixed</innerclass> |
|---|
| 110 | <sectiondef kind="func"> |
|---|
| 111 | <memberdef kind="function" id="ekf__obj_8h_120a104802ddcb544b8de3fe3e5e03253" prot="public" static="no" const="no" explicit="no" inline="no" virt="non-virtual"> |
|---|
| 112 | <type>double</type> |
|---|
| 113 | <definition>double minQ</definition> |
|---|
| 114 | <argsstring>(double Q)</argsstring> |
|---|
| 115 | <name>minQ</name> |
|---|
| 116 | <param> |
|---|
| 117 | <type>double</type> |
|---|
| 118 | <declname>Q</declname> |
|---|
| 119 | </param> |
|---|
| 120 | <briefdescription> |
|---|
| 121 | </briefdescription> |
|---|
| 122 | <detaileddescription> |
|---|
| 123 | </detaileddescription> |
|---|
| 124 | <inbodydescription> |
|---|
| 125 | </inbodydescription> |
|---|
| 126 | <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/ekf_obj.h" line="25" bodyfile="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/ekf_obj.cpp" bodystart="7" bodyend="7"/> |
|---|
| 127 | </memberdef> |
|---|
| 128 | </sectiondef> |
|---|
| 129 | <briefdescription> |
|---|
| 130 | <para>Bayesian Filtering for linear Gaussian models (<ref refid="classKalman" kindref="compound">Kalman</ref> Filter) and extensions. </para> </briefdescription> |
|---|
| 131 | <detaileddescription> |
|---|
| 132 | <para><simplesect kind="author"><para>Vaclav Smidl.</para></simplesect> |
|---|
| 133 | ----------------------------------- BDM++ - C++ library for Bayesian Decision Making under Uncertainty</para><para>Using IT++ for numerical operations ----------------------------------- </para> </detaileddescription> |
|---|
| 134 | <programlisting> |
|---|
| 135 | <codeline lineno="1"></codeline> |
|---|
| 136 | <codeline lineno="13"><highlight class="preprocessor">#ifndef<sp/>EKFfix_H</highlight></codeline> |
|---|
| 137 | <codeline lineno="14"><highlight class="preprocessor"></highlight><highlight class="preprocessor">#define<sp/>EKFfix_H</highlight></codeline> |
|---|
| 138 | <codeline lineno="15"><highlight class="preprocessor"></highlight><highlight class="normal"></highlight></codeline> |
|---|
| 139 | <codeline lineno="16"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/><itpp/itbase.h></highlight><highlight class="normal"></highlight></codeline> |
|---|
| 140 | <codeline lineno="17"><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> |
|---|
| 141 | <codeline lineno="18"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>"fixed.h"</highlight><highlight class="normal"></highlight></codeline> |
|---|
| 142 | <codeline lineno="19"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>"matrix.h"</highlight><highlight class="normal"></highlight></codeline> |
|---|
| 143 | <codeline lineno="20"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>"reference.h"</highlight><highlight class="normal"></highlight></codeline> |
|---|
| 144 | <codeline lineno="21"><highlight class="normal"></highlight><highlight class="preprocessor">#include<sp/>"parametry_motoru.h"</highlight><highlight class="normal"></highlight></codeline> |
|---|
| 145 | <codeline lineno="22"><highlight class="normal"></highlight></codeline> |
|---|
| 146 | <codeline lineno="23"><highlight class="normal"></highlight><highlight class="keyword">using<sp/>namespace<sp/></highlight><highlight class="normal">itpp;</highlight></codeline> |
|---|
| 147 | <codeline lineno="24"><highlight class="normal"></highlight></codeline> |
|---|
| 148 | <codeline lineno="25"><highlight class="normal"></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>minQ(</highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>Q);</highlight></codeline> |
|---|
| 149 | <codeline lineno="26"><highlight class="normal"></highlight></codeline> |
|---|
| 150 | <codeline lineno="32" refid="classEKFfixed" refkind="compound"><highlight class="keyword">class<sp/></highlight><highlight class="normal"><ref refid="classEKFfixed" kindref="compound" tooltip="Extended Kalman Filter with full matrices in fixed point arithmetic.">EKFfixed</ref><sp/>:<sp/></highlight><highlight class="keyword">public</highlight><highlight class="normal"><sp/><ref refid="classBM" kindref="compound" tooltip="Bayesian Model of the world, i.e. all uncertainty is modeled by probabilities.">BM</ref>,<sp/></highlight><highlight class="keyword">public</highlight><highlight class="normal"><sp/><ref refid="classBMcond" kindref="compound" tooltip="Conditional Bayesian Filter.">BMcond</ref><sp/>{</highlight></codeline> |
|---|
| 151 | <codeline lineno="33"><highlight class="normal"></highlight><highlight class="keyword">public</highlight><highlight class="normal">:</highlight></codeline> |
|---|
| 152 | <codeline lineno="34"><highlight class="normal"></highlight><highlight class="keywordtype">void</highlight><highlight class="normal"><sp/>init_ekf(</highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>Tv);</highlight></codeline> |
|---|
| 153 | <codeline lineno="35"><highlight class="normal"></highlight><highlight class="keywordtype">void</highlight><highlight class="normal"><sp/>ekf(</highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>ux,<sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>uy,<sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>isxd,<sp/></highlight><highlight class="keywordtype">double</highlight><highlight class="normal"><sp/>isyd);</highlight></codeline> |
|---|
| 154 | <codeline lineno="36"><highlight class="normal"></highlight></codeline> |
|---|
| 155 | <codeline lineno="37"><highlight class="normal"></highlight><highlight class="comment">/*<sp/>Declaration<sp/>of<sp/>local<sp/>functions<sp/>*/</highlight><highlight class="normal"></highlight></codeline> |
|---|
| 156 | <codeline lineno="38"><highlight class="normal"></highlight><highlight class="keywordtype">void</highlight><highlight class="normal"><sp/>prediction(</highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>*ux);</highlight></codeline> |
|---|
| 157 | <codeline lineno="39"><highlight class="normal"></highlight><highlight class="keywordtype">void</highlight><highlight class="normal"><sp/>correction(</highlight><highlight class="keywordtype">void</highlight><highlight class="normal">);</highlight></codeline> |
|---|
| 158 | <codeline lineno="40"><highlight class="normal"></highlight><highlight class="keywordtype">void</highlight><highlight class="normal"><sp/>update_psi(</highlight><highlight class="keywordtype">void</highlight><highlight class="normal">);</highlight></codeline> |
|---|
| 159 | <codeline lineno="41"><highlight class="normal"></highlight></codeline> |
|---|
| 160 | <codeline lineno="42"><highlight class="normal"></highlight><highlight class="comment">/*<sp/>Constants<sp/>-<sp/>definovat<sp/>jako<sp/>konstanty<sp/>??<sp/>?kde<sp/>je<sp/>vyhodnejsi<sp/>aby<sp/>v<sp/>pameti<sp/>byli?*/</highlight><highlight class="normal"></highlight></codeline> |
|---|
| 161 | <codeline lineno="43"><highlight class="normal"><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>Q[16];<sp/></highlight><highlight class="comment">/*<sp/>matrix<sp/>[4,4]<sp/>*/</highlight><highlight class="normal"></highlight></codeline> |
|---|
| 162 | <codeline lineno="44"><highlight class="normal"><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>R[4];<sp/></highlight><highlight class="comment">/*<sp/>matrix<sp/>[2,2]<sp/>*/</highlight><highlight class="normal"></highlight></codeline> |
|---|
| 163 | <codeline lineno="45"><highlight class="normal"></highlight></codeline> |
|---|
| 164 | <codeline lineno="46"><highlight class="normal"><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>x_est[4];</highlight></codeline> |
|---|
| 165 | <codeline lineno="47"><highlight class="normal"><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>x_pred[4];</highlight></codeline> |
|---|
| 166 | <codeline lineno="48"><highlight class="normal"><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>P_pred[16];<sp/></highlight><highlight class="comment">/*<sp/>matrix<sp/>[4,4]<sp/>*/</highlight><highlight class="normal"></highlight></codeline> |
|---|
| 167 | <codeline lineno="49"><highlight class="normal"><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>P_est[16];<sp/></highlight><highlight class="comment">/*<sp/>matrix<sp/>[4,4]<sp/>*/</highlight><highlight class="normal"></highlight></codeline> |
|---|
| 168 | <codeline lineno="50"><highlight class="normal"><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>Y_mes[2];</highlight></codeline> |
|---|
| 169 | <codeline lineno="51"><highlight class="normal"><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>ukalm[2];</highlight></codeline> |
|---|
| 170 | <codeline lineno="52"><highlight class="normal"><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>Kalm[8];<sp/></highlight><highlight class="comment">/*<sp/>matrix<sp/>[5,2]<sp/>*/</highlight><highlight class="normal"></highlight></codeline> |
|---|
| 171 | <codeline lineno="53"><highlight class="normal"></highlight></codeline> |
|---|
| 172 | <codeline lineno="54"><highlight class="normal"><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>PSI[16];<sp/></highlight><highlight class="comment">/*<sp/>matrix<sp/>[4,4]<sp/>*/</highlight><highlight class="normal"></highlight></codeline> |
|---|
| 173 | <codeline lineno="55"><highlight class="normal"></highlight></codeline> |
|---|
| 174 | <codeline lineno="56"><highlight class="normal"><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>temp15a[16];</highlight></codeline> |
|---|
| 175 | <codeline lineno="57"><highlight class="normal"></highlight></codeline> |
|---|
| 176 | <codeline lineno="58"><highlight class="normal"><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>cA,<sp/>cB,<sp/>cC,<sp/>cG,<sp/>cH;<sp/><sp/></highlight><highlight class="comment">//<sp/>cD,<sp/>cE,<sp/>cF,<sp/>cI<sp/>...<sp/>nepouzivane</highlight><highlight class="normal"></highlight></codeline> |
|---|
| 177 | <codeline lineno="59"><highlight class="normal"></highlight></codeline> |
|---|
| 178 | <codeline lineno="60"><highlight class="normal"><sp/></highlight><highlight class="keywordtype">long</highlight><highlight class="normal"><sp/>temp30a[4];<sp/></highlight><highlight class="comment">/*<sp/>matrix<sp/>[2,2]<sp/>-<sp/>temporary<sp/>matrix<sp/>for<sp/>inversion<sp/>*/</highlight><highlight class="normal"></highlight></codeline> |
|---|
| 179 | <codeline lineno="61"><highlight class="normal"><sp/><ref refid="classenorm" kindref="compound" tooltip="Gaussian density with positive definite (decomposed) covariance matrix.">enorm<fsqmat></ref><sp/>E;</highlight></codeline> |
|---|
| 180 | <codeline lineno="62"><highlight class="normal"><sp/>mat<sp/>Ry;</highlight></codeline> |
|---|
| 181 | <codeline lineno="63"><highlight class="normal"><sp/><sp/></highlight></codeline> |
|---|
| 182 | <codeline lineno="64"><highlight class="normal"></highlight><highlight class="keyword">public</highlight><highlight class="normal">:</highlight></codeline> |
|---|
| 183 | <codeline lineno="66" refid="classEKFfixed_164d7b1a39c27b1846bcd5628928748ef" refkind="member"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><ref refid="classEKFfixed_164d7b1a39c27b1846bcd5628928748ef" kindref="member" tooltip="Default constructor.">EKFfixed</ref><sp/>(<sp/><ref refid="classRV" kindref="compound" tooltip="Class representing variables, most often random variables.">RV</ref><sp/>rvx,<ref refid="classRV" kindref="compound" tooltip="Class representing variables, most often random variables.">RV</ref><sp/><ref refid="classBMcond_19ba793c8ec453f04d372d17195ed8dec" kindref="member" tooltip="Identificator of the conditioning variable.">rvc</ref><sp/>):<ref refid="classBM" kindref="compound" tooltip="Bayesian Model of the world, i.e. all uncertainty is modeled by probabilities.">BM</ref>(rvx),<ref refid="classBMcond" kindref="compound" tooltip="Conditional Bayesian Filter.">BMcond</ref>(rvc),E(rvx),Ry(2,2){</highlight></codeline> |
|---|
| 184 | <codeline lineno="67"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordtype">int</highlight><highlight class="normal"><sp/>i;</highlight></codeline> |
|---|
| 185 | <codeline lineno="68"><highlight class="normal"><sp/></highlight><highlight class="keywordflow">for</highlight><highlight class="normal">(i=0;i<16;i++){Q[i]=0;}</highlight></codeline> |
|---|
| 186 | <codeline lineno="69"><highlight class="normal"><sp/></highlight><highlight class="keywordflow">for</highlight><highlight class="normal">(i=0;i<4;i++){R[i]=0;}</highlight></codeline> |
|---|
| 187 | <codeline lineno="70"><highlight class="normal"></highlight></codeline> |
|---|
| 188 | <codeline lineno="71"><highlight class="normal"><sp/></highlight><highlight class="keywordflow">for</highlight><highlight class="normal">(i=0;i<4;i++){x_est[i]=0;}</highlight></codeline> |
|---|
| 189 | <codeline lineno="72"><highlight class="normal"><sp/></highlight><highlight class="keywordflow">for</highlight><highlight class="normal">(i=0;i<4;i++){x_pred[i]=0;}</highlight></codeline> |
|---|
| 190 | <codeline lineno="73"><highlight class="normal"><sp/></highlight><highlight class="keywordflow">for</highlight><highlight class="normal">(i=0;i<16;i++){P_pred[i]=0;}</highlight></codeline> |
|---|
| 191 | <codeline lineno="74"><highlight class="normal"><sp/></highlight><highlight class="keywordflow">for</highlight><highlight class="normal">(i=0;i<16;i++){P_est[i]=0;}</highlight></codeline> |
|---|
| 192 | <codeline lineno="75"><highlight class="normal"><sp/>P_est[0]=0x7FFF;</highlight></codeline> |
|---|
| 193 | <codeline lineno="76"><highlight class="normal"><sp/>P_est[5]=0x7FFF;</highlight></codeline> |
|---|
| 194 | <codeline lineno="77"><highlight class="normal"><sp/>P_est[10]=0x7FFF;</highlight></codeline> |
|---|
| 195 | <codeline lineno="78"><highlight class="normal"><sp/>P_est[15]=0x7FFF;</highlight></codeline> |
|---|
| 196 | <codeline lineno="79"><highlight class="normal"><sp/></highlight><highlight class="keywordflow">for</highlight><highlight class="normal">(i=0;i<2;i++){Y_mes[i]=0;}</highlight></codeline> |
|---|
| 197 | <codeline lineno="80"><highlight class="normal"><sp/></highlight><highlight class="keywordflow">for</highlight><highlight class="normal">(i=0;i<2;i++){ukalm[i]=0;}</highlight></codeline> |
|---|
| 198 | <codeline lineno="81"><highlight class="normal"><sp/></highlight><highlight class="keywordflow">for</highlight><highlight class="normal">(i=0;i<8;i++){Kalm[i]=0;}</highlight></codeline> |
|---|
| 199 | <codeline lineno="82"><highlight class="normal"></highlight></codeline> |
|---|
| 200 | <codeline lineno="83"><highlight class="normal"><sp/></highlight><highlight class="keywordflow">for</highlight><highlight class="normal">(i=0;i<16;i++){PSI[i]=0;}</highlight></codeline> |
|---|
| 201 | <codeline lineno="84"><highlight class="normal">};</highlight></codeline> |
|---|
| 202 | <codeline lineno="86"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordtype">void</highlight><highlight class="normal"><sp/><ref refid="classEKFfixed_1ddf5334bc1207658fd53698fffbac028" kindref="member" tooltip="Here dt = [yt;ut] of appropriate dimensions.">bayes</ref><sp/>(<sp/></highlight><highlight class="keyword">const</highlight><highlight class="normal"><sp/>vec<sp/>&dt<sp/>);</highlight></codeline> |
|---|
| 203 | <codeline lineno="88" refid="classEKFfixed_1085cf16c573eda32d8d03619c6c4b518" refkind="member"><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/><ref refid="classEKFfixed_1085cf16c573eda32d8d03619c6c4b518" kindref="member" tooltip="dummy!">_epdf</ref>(){</highlight><highlight class="keywordflow">return</highlight><highlight class="normal"><sp/>E;};</highlight></codeline> |
|---|
| 204 | <codeline lineno="89" refid="classEKFfixed_1c7fee79e75ad7f0c0e96c5a322cbf44e" refkind="member"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="keywordtype">void</highlight><highlight class="normal"><sp/><ref refid="classEKFfixed_1c7fee79e75ad7f0c0e96c5a322cbf44e" kindref="member" tooltip="Substitute val for rvc.">condition</ref><sp/>(<sp/></highlight><highlight class="keyword">const</highlight><highlight class="normal"><sp/>vec<sp/>&Q0<sp/>)<sp/>{</highlight></codeline> |
|---|
| 205 | <codeline lineno="90"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight></codeline> |
|---|
| 206 | <codeline lineno="91"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Q[0]=prevod(minQ(Q0(0)),15);<sp/><sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>0.05</highlight><highlight class="normal"></highlight></codeline> |
|---|
| 207 | <codeline lineno="92"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Q[5]=prevod(minQ(Q0(1)),15);</highlight></codeline> |
|---|
| 208 | <codeline lineno="93"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Q[10]=prevod(minQ(Q0(2)),15);<sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1e-3</highlight><highlight class="normal"></highlight></codeline> |
|---|
| 209 | <codeline lineno="94"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>Q[15]=prevod(minQ(Q0(3)),15);<sp/><sp/><sp/><sp/><sp/><sp/></highlight><highlight class="comment">//<sp/>1e-3</highlight><highlight class="normal"></highlight></codeline> |
|---|
| 210 | <codeline lineno="95"><highlight class="normal"></highlight></codeline> |
|---|
| 211 | <codeline lineno="96"><highlight class="normal"><sp/><sp/><sp/><sp/><sp/><sp/><sp/><sp/>}</highlight></codeline> |
|---|
| 212 | <codeline lineno="97"><highlight class="normal">};</highlight></codeline> |
|---|
| 213 | <codeline lineno="98"><highlight class="normal"></highlight></codeline> |
|---|
| 214 | <codeline lineno="99"><highlight class="normal"></highlight></codeline> |
|---|
| 215 | <codeline lineno="100"><highlight class="normal"></highlight><highlight class="preprocessor">#endif<sp/>//<sp/>KF_H</highlight></codeline> |
|---|
| 216 | <codeline lineno="101"><highlight class="preprocessor"></highlight><highlight class="normal"></highlight></codeline> |
|---|
| 217 | <codeline lineno="102"><highlight class="normal"></highlight></codeline> |
|---|
| 218 | </programlisting> |
|---|
| 219 | <location file="/home/smidl/work/git/mixpp/pmsm/simulator_zdenek/ekf_example/ekf_obj.h"/> |
|---|
| 220 | </compounddef> |
|---|
| 221 | </doxygen> |
|---|