root/doc/html/ekf__obj_8h-source.html @ 84

Revision 84, 9.5 kB (checked in by smidl, 16 years ago)

doxy

Line 
1<!DOCTYPE HTML PUBLIC "-//W3C//DTD HTML 4.01 Transitional//EN">
2<html><head><meta http-equiv="Content-Type" content="text/html;charset=UTF-8">
3<title>mixpp: work/mixpp/pmsm/simulator_zdenek/ekf_example/ekf_obj.h Source File</title>
4<link href="doxygen.css" rel="stylesheet" type="text/css">
5<link href="tabs.css" rel="stylesheet" type="text/css">
6</head><body>
7<!-- Generated by Doxygen 1.5.3 -->
8<div class="tabs">
9  <ul>
10    <li><a href="index.html"><span>Main&nbsp;Page</span></a></li>
11    <li><a href="annotated.html"><span>Classes</span></a></li>
12    <li class="current"><a href="files.html"><span>Files</span></a></li>
13    <li><a href="pages.html"><span>Related&nbsp;Pages</span></a></li>
14  </ul>
15</div>
16<h1>work/mixpp/pmsm/simulator_zdenek/ekf_example/ekf_obj.h</h1><a href="ekf__obj_8h.html">Go to the documentation of this file.</a><div class="fragment"><pre class="fragment"><a name="l00001"></a>00001
17<a name="l00013"></a>00013 <span class="preprocessor">#ifndef EKFfix_H</span>
18<a name="l00014"></a>00014 <span class="preprocessor"></span><span class="preprocessor">#define EKFfix_H</span>
19<a name="l00015"></a>00015 <span class="preprocessor"></span>
20<a name="l00016"></a>00016 <span class="preprocessor">#include &lt;itpp/itbase.h&gt;</span>
21<a name="l00017"></a>00017 <span class="preprocessor">#include &lt;<a class="code" href="libKF_8h.html" title="Bayesian Filtering for linear Gaussian models (Kalman Filter) and extensions.">estim/libKF.h</a>&gt;</span>
22<a name="l00018"></a>00018 <span class="preprocessor">#include "fixed.h"</span>
23<a name="l00019"></a>00019 <span class="preprocessor">#include "matrix.h"</span>
24<a name="l00020"></a>00020 <span class="preprocessor">#include "reference.h"</span>
25<a name="l00021"></a>00021 <span class="preprocessor">#include "parametry_motoru.h"</span>
26<a name="l00022"></a>00022
27<a name="l00023"></a>00023 <span class="keyword">using namespace </span>itpp;
28<a name="l00024"></a>00024
29<a name="l00025"></a>00025 <span class="keywordtype">double</span> minQ(<span class="keywordtype">double</span> Q);
30<a name="l00026"></a>00026
31<a name="l00032"></a><a class="code" href="classEKFfixed.html">00032</a> <span class="keyword">class </span><a class="code" href="classEKFfixed.html" title="Extended Kalman Filter in full matrices.">EKFfixed</a> : <span class="keyword">public</span> <a class="code" href="classBM.html" title="Bayesian Model of the world, i.e. all uncertainty is modeled by probabilities.">BM</a>, <span class="keyword">public</span> <a class="code" href="classBMcond.html" title="Conditional Bayesian Filter.">BMcond</a> {
32<a name="l00033"></a>00033 <span class="keyword">public</span>:
33<a name="l00034"></a>00034 <span class="keywordtype">void</span> init_ekf(<span class="keywordtype">double</span> Tv);
34<a name="l00035"></a>00035 <span class="keywordtype">void</span> ekf(<span class="keywordtype">double</span> ux, <span class="keywordtype">double</span> uy, <span class="keywordtype">double</span> isxd, <span class="keywordtype">double</span> isyd);
35<a name="l00036"></a>00036
36<a name="l00037"></a>00037 <span class="comment">/* Declaration of local functions */</span>
37<a name="l00038"></a>00038 <span class="keywordtype">void</span> prediction(<span class="keywordtype">int</span> *ux);
38<a name="l00039"></a>00039 <span class="keywordtype">void</span> correction(<span class="keywordtype">void</span>);
39<a name="l00040"></a>00040 <span class="keywordtype">void</span> update_psi(<span class="keywordtype">void</span>);
40<a name="l00041"></a>00041
41<a name="l00042"></a>00042 <span class="comment">/* Constants - definovat jako konstanty ?? ?kde je vyhodnejsi aby v pameti byli?*/</span>
42<a name="l00043"></a>00043  <span class="keywordtype">int</span> Q[16]; <span class="comment">/* matrix [4,4] */</span>
43<a name="l00044"></a>00044  <span class="keywordtype">int</span> R[4]; <span class="comment">/* matrix [2,2] */</span>
44<a name="l00045"></a>00045
45<a name="l00046"></a>00046  <span class="keywordtype">int</span> x_est[4];
46<a name="l00047"></a>00047  <span class="keywordtype">int</span> x_pred[4];
47<a name="l00048"></a>00048  <span class="keywordtype">int</span> P_pred[16]; <span class="comment">/* matrix [4,4] */</span>
48<a name="l00049"></a>00049  <span class="keywordtype">int</span> P_est[16]; <span class="comment">/* matrix [4,4] */</span>
49<a name="l00050"></a>00050  <span class="keywordtype">int</span> Y_mes[2];
50<a name="l00051"></a>00051  <span class="keywordtype">int</span> ukalm[2];
51<a name="l00052"></a>00052  <span class="keywordtype">int</span> Kalm[8]; <span class="comment">/* matrix [5,2] */</span>
52<a name="l00053"></a>00053
53<a name="l00054"></a>00054  <span class="keywordtype">int</span> PSI[16]; <span class="comment">/* matrix [4,4] */</span>
54<a name="l00055"></a>00055
55<a name="l00056"></a>00056  <span class="keywordtype">int</span> temp15a[16];
56<a name="l00057"></a>00057
57<a name="l00058"></a>00058  <span class="keywordtype">int</span> cA, cB, cC, cG, cH;  <span class="comment">// cD, cE, cF, cI ... nepouzivane</span>
58<a name="l00059"></a>00059
59<a name="l00060"></a>00060  <span class="keywordtype">long</span> temp30a[4]; <span class="comment">/* matrix [2,2] - temporary matrix for inversion */</span>
60<a name="l00061"></a>00061  <a class="code" href="classenorm.html" title="Gaussian density with positive definite (decomposed) covariance matrix.">enorm&lt;fsqmat&gt;</a> E;
61<a name="l00062"></a>00062  mat Ry;
62<a name="l00063"></a>00063   
63<a name="l00064"></a>00064 <span class="keyword">public</span>:
64<a name="l00066"></a><a class="code" href="classEKFfixed.html#64d7b1a39c27b1846bcd5628928748ef">00066</a>         <a class="code" href="classEKFfixed.html#64d7b1a39c27b1846bcd5628928748ef" title="Default constructor.">EKFfixed</a> ( <a class="code" href="classRV.html" title="Class representing variables, most often random variables.">RV</a> rvx,<a class="code" href="classRV.html" title="Class representing variables, most often random variables.">RV</a> <a class="code" href="classBMcond.html#9ba793c8ec453f04d372d17195ed8dec" title="Identificator of the conditioning variable.">rvc</a> ):<a class="code" href="classBM.html" title="Bayesian Model of the world, i.e. all uncertainty is modeled by probabilities.">BM</a>(rvx),<a class="code" href="classBMcond.html" title="Conditional Bayesian Filter.">BMcond</a>(rvc),E(rvx),Ry(2,2){
65<a name="l00067"></a>00067         <span class="keywordtype">int</span> i;
66<a name="l00068"></a>00068  <span class="keywordflow">for</span>(i=0;i&lt;16;i++){Q[i]=0;}
67<a name="l00069"></a>00069  <span class="keywordflow">for</span>(i=0;i&lt;4;i++){R[i]=0;}
68<a name="l00070"></a>00070
69<a name="l00071"></a>00071  <span class="keywordflow">for</span>(i=0;i&lt;4;i++){x_est[i]=0;}
70<a name="l00072"></a>00072  <span class="keywordflow">for</span>(i=0;i&lt;4;i++){x_pred[i]=0;}
71<a name="l00073"></a>00073  <span class="keywordflow">for</span>(i=0;i&lt;16;i++){P_pred[i]=0;}
72<a name="l00074"></a>00074  <span class="keywordflow">for</span>(i=0;i&lt;16;i++){P_est[i]=0;}
73<a name="l00075"></a>00075  P_est[0]=0x7FFF;
74<a name="l00076"></a>00076  P_est[5]=0x7FFF;
75<a name="l00077"></a>00077  P_est[10]=0x7FFF;
76<a name="l00078"></a>00078  P_est[15]=0x7FFF;
77<a name="l00079"></a>00079  <span class="keywordflow">for</span>(i=0;i&lt;2;i++){Y_mes[i]=0;}
78<a name="l00080"></a>00080  <span class="keywordflow">for</span>(i=0;i&lt;2;i++){ukalm[i]=0;}
79<a name="l00081"></a>00081  <span class="keywordflow">for</span>(i=0;i&lt;8;i++){Kalm[i]=0;}
80<a name="l00082"></a>00082
81<a name="l00083"></a>00083  <span class="keywordflow">for</span>(i=0;i&lt;16;i++){PSI[i]=0;}
82<a name="l00084"></a>00084 };
83<a name="l00086"></a>00086         <span class="keywordtype">void</span> <a class="code" href="classEKFfixed.html#ddf5334bc1207658fd53698fffbac028" title="Here dt = [yt;ut] of appropriate dimensions.">bayes</a> ( <span class="keyword">const</span> vec &amp;dt );
84<a name="l00088"></a><a class="code" href="classEKFfixed.html#085cf16c573eda32d8d03619c6c4b518">00088</a>         <a class="code" href="classepdf.html" title="Probability density function with numerical statistics, e.g. posterior density.">epdf</a>&amp; <a class="code" href="classEKFfixed.html#085cf16c573eda32d8d03619c6c4b518" title="dummy!">_epdf</a>(){<span class="keywordflow">return</span> E;};
85<a name="l00089"></a><a class="code" href="classEKFfixed.html#c7fee79e75ad7f0c0e96c5a322cbf44e">00089</a>         <span class="keywordtype">void</span> <a class="code" href="classEKFfixed.html#c7fee79e75ad7f0c0e96c5a322cbf44e" title="Substitute val for rvc.">condition</a> ( <span class="keyword">const</span> vec &amp;Q0 ) {
86<a name="l00090"></a>00090                 
87<a name="l00091"></a>00091                 Q[0]=prevod(minQ(Q0(0)),15);       <span class="comment">// 0.05</span>
88<a name="l00092"></a>00092                 Q[5]=prevod(minQ(Q0(1)),15);
89<a name="l00093"></a>00093                 Q[10]=prevod(minQ(Q0(2)),15);      <span class="comment">// 1e-3</span>
90<a name="l00094"></a>00094                 Q[15]=prevod(minQ(Q0(3)),15);      <span class="comment">// 1e-3</span>
91<a name="l00095"></a>00095
92<a name="l00096"></a>00096         }
93<a name="l00097"></a>00097 };
94<a name="l00098"></a>00098
95<a name="l00099"></a>00099
96<a name="l00100"></a>00100 <span class="preprocessor">#endif // KF_H</span>
97<a name="l00101"></a>00101 <span class="preprocessor"></span>
98<a name="l00102"></a>00102
99</pre></div><hr size="1"><address style="text-align: right;"><small>Generated on Fri Apr 18 11:15:15 2008 for mixpp by&nbsp;
100<a href="http://www.doxygen.org/index.html">
101<img src="doxygen.png" alt="doxygen" align="middle" border="0"></a> 1.5.3 </small></address>
102</body>
103</html>
Note: See TracBrowser for help on using the browser.