Show
Ignore:
Timestamp:
08/30/09 22:13:15 (15 years ago)
Author:
smidl
Message:

doc

Files:
1 modified

Legend:

Unmodified
Added
Removed

  • library/doc/html/kalman_8h_source.html

    r472 r591  
    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"> 
     1<!DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Transitional//EN" "http://www.w3.org/TR/xhtml1/DTD/xhtml1-transitional.dtd"> 
     2<html xmlns="http://www.w3.org/1999/xhtml"> 
     3<head> 
     4<meta http-equiv="Content-Type" content="text/xhtml;charset=UTF-8"/> 
    35<title>mixpp: kalman.h Source File</title> 
    4 <link href="tabs.css" rel="stylesheet" type="text/css"> 
    5 <link href="doxygen.css" rel="stylesheet" type="text/css"> 
    6 </head><body> 
    7 <!-- Generated by Doxygen 1.5.9 --> 
     6<link href="tabs.css" rel="stylesheet" type="text/css"/> 
     7<link href="doxygen.css" rel="stylesheet" type="text/css"/> 
     8</head> 
     9<body> 
     10<!-- Generated by Doxygen 1.6.1 --> 
    811<script type="text/javascript"> 
    912<!-- 
    … …  
    6770<a name="l00015"></a>00015 <span class="preprocessor"></span> 
    6871<a name="l00016"></a>00016  
    69 <a name="l00017"></a>00017 <span class="preprocessor">#include "../math/functions.h"</span> 
    70 <a name="l00018"></a>00018 <span class="preprocessor">#include "../stat/exp_family.h"</span> 
    71 <a name="l00019"></a>00019 <span class="preprocessor">#include "../math/chmat.h"</span> 
    72 <a name="l00020"></a>00020 <span class="preprocessor">#include "../base/user_info.h"</span> 
     72<a name="l00017"></a>00017 <span class="preprocessor">#include &quot;../math/functions.h&quot;</span> 
     73<a name="l00018"></a>00018 <span class="preprocessor">#include &quot;../stat/exp_family.h&quot;</span> 
     74<a name="l00019"></a>00019 <span class="preprocessor">#include &quot;../math/chmat.h&quot;</span> 
     75<a name="l00020"></a>00020 <span class="preprocessor">#include &quot;../base/user_info.h&quot;</span> 
    7376<a name="l00021"></a>00021  
    7477<a name="l00022"></a>00022 <span class="keyword">namespace </span>bdm 
    7578<a name="l00023"></a>00023 { 
    7679<a name="l00024"></a>00024  
    77 <a name="l00029"></a><a class="code" href="classbdm_1_1KalmanFull.html">00029</a>         <span class="keyword">class </span><a class="code" href="classbdm_1_1KalmanFull.html" title="Basic Kalman filter with full matrices (education purpose only)! Will be deleted...">KalmanFull</a> 
    78 <a name="l00030"></a>00030         { 
    79 <a name="l00031"></a>00031                 <span class="keyword">protected</span>: 
    80 <a name="l00032"></a>00032                         <span class="keywordtype">int</span> dimx, dimy, dimu; 
    81 <a name="l00033"></a>00033                         mat A, B, C, D, R, Q; 
    82 <a name="l00034"></a>00034  
    83 <a name="l00035"></a>00035                         <span class="comment">//cache</span> 
    84 <a name="l00036"></a>00036                         mat _Pp, _Ry, _iRy, _K; 
    85 <a name="l00037"></a>00037                 <span class="keyword">public</span>: 
    86 <a name="l00038"></a>00038                         <span class="comment">//posterior</span> 
    87 <a name="l00040"></a><a class="code" href="classbdm_1_1KalmanFull.html#2defb75e58892615c5f95fd844f3a666">00040</a> <span class="comment"></span>                        vec <a class="code" href="classbdm_1_1KalmanFull.html#2defb75e58892615c5f95fd844f3a666" title="Mean value of the posterior density.">mu</a>; 
    88 <a name="l00042"></a><a class="code" href="classbdm_1_1KalmanFull.html#acacd228e100c3e937de575ad2d7cd9c">00042</a>                         mat <a class="code" href="classbdm_1_1KalmanFull.html#acacd228e100c3e937de575ad2d7cd9c" title="Variance of the posterior density.">P</a>; 
    89 <a name="l00043"></a>00043  
    90 <a name="l00044"></a>00044                         <span class="keywordtype">bool</span> evalll; 
    91 <a name="l00045"></a>00045                         <span class="keywordtype">double</span> ll; 
    92 <a name="l00046"></a>00046                 <span class="keyword">public</span>: 
    93 <a name="l00048"></a>00048                         <a class="code" href="classbdm_1_1KalmanFull.html#bdcc98c8b18c1cbdebdf218ae838fd11" title="For EKFfull;.">KalmanFull</a> ( mat A, mat B, mat C, mat D, mat R, mat Q, mat P0, vec mu0 ); 
    94 <a name="l00050"></a>00050                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1KalmanFull.html#081924bc97f453f674bb982b7951d053" title="Here dt = [yt;ut] of appropriate dimensions.">bayes</a> ( <span class="keyword">const</span> vec &amp;dt ); 
    95 <a name="l00052"></a>00052                         <span class="keyword">friend</span> std::ostream &amp;<a class="code" href="classbdm_1_1KalmanFull.html#86ba216243ed95bb46d80d88775d16af" title="print elements of KF">operator&lt;&lt; </a>( std::ostream &amp;os, <span class="keyword">const</span> <a class="code" href="classbdm_1_1KalmanFull.html" title="Basic Kalman filter with full matrices (education purpose only)! Will be deleted...">KalmanFull</a> &amp;kf ); 
    96 <a name="l00054"></a><a class="code" href="classbdm_1_1KalmanFull.html#bdcc98c8b18c1cbdebdf218ae838fd11">00054</a>                         <a class="code" href="classbdm_1_1KalmanFull.html#bdcc98c8b18c1cbdebdf218ae838fd11" title="For EKFfull;.">KalmanFull</a>() {}; 
    97 <a name="l00055"></a>00055         }; 
    98 <a name="l00056"></a>00056  
    99 <a name="l00057"></a>00057  
    100 <a name="l00065"></a>00065         <span class="keyword">template</span>&lt;<span class="keyword">class</span> sq_T&gt; 
    101 <a name="l00066"></a>00066  
    102 <a name="l00067"></a><a class="code" href="classbdm_1_1Kalman.html">00067</a>         <span class="keyword">class </span><a class="code" href="classbdm_1_1Kalman.html" title="Kalman filter with covariance matrices in square root form.">Kalman</a> : <span class="keyword">public</span> <a class="code" href="classbdm_1_1BM.html" title="Bayesian Model of a system, i.e. all uncertainty is modeled by probabilities.">BM</a> 
    103 <a name="l00068"></a>00068         { 
    104 <a name="l00069"></a>00069                 <span class="keyword">protected</span>: 
    105 <a name="l00071"></a><a class="code" href="classbdm_1_1Kalman.html#3fe475a1e920b20b63bb342c0e1571f7">00071</a>                         <a class="code" href="classbdm_1_1RV.html" title="Class representing variables, most often random variables.">RV</a> <a class="code" href="classbdm_1_1Kalman.html#3fe475a1e920b20b63bb342c0e1571f7" title="Indetifier of output rv.">rvy</a>; 
    106 <a name="l00073"></a><a class="code" href="classbdm_1_1Kalman.html#149e27424fd1a7cc1c998ea088618a94">00073</a>                         <a class="code" href="classbdm_1_1RV.html" title="Class representing variables, most often random variables.">RV</a> <a class="code" href="classbdm_1_1Kalman.html#149e27424fd1a7cc1c998ea088618a94" title="Indetifier of exogeneous rv.">rvu</a>; 
    107 <a name="l00075"></a><a class="code" href="classbdm_1_1Kalman.html#ba7699cdb3b1382a54d3e28b9b7517fa">00075</a>                         <span class="keywordtype">int</span> <a class="code" href="classbdm_1_1Kalman.html#ba7699cdb3b1382a54d3e28b9b7517fa" title="cache of rv.count()">dimx</a>; 
    108 <a name="l00077"></a><a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f">00077</a>                         <span class="keywordtype">int</span> <a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a>; 
    109 <a name="l00079"></a><a class="code" href="classbdm_1_1Kalman.html#c5136ef617f6ac0e426bea222755d92b">00079</a>                         <span class="keywordtype">int</span> <a class="code" href="classbdm_1_1Kalman.html#c5136ef617f6ac0e426bea222755d92b" title="cache of rvu.count()">dimu</a>; 
    110 <a name="l00081"></a><a class="code" href="classbdm_1_1Kalman.html#0a2072e2090c10fac74ad30a023a4ace">00081</a>                         mat <a class="code" href="classbdm_1_1Kalman.html#0a2072e2090c10fac74ad30a023a4ace" title="Matrix A.">A</a>; 
    111 <a name="l00083"></a><a class="code" href="classbdm_1_1Kalman.html#5977b2c81857948a35105f0e7840203c">00083</a>                         mat <a class="code" href="classbdm_1_1Kalman.html#5977b2c81857948a35105f0e7840203c" title="Matrix B.">B</a>; 
    112 <a name="l00085"></a><a class="code" href="classbdm_1_1Kalman.html#818eba63a23972786a4579ad30294177">00085</a>                         mat <a class="code" href="classbdm_1_1Kalman.html#818eba63a23972786a4579ad30294177" title="Matrix C.">C</a>; 
    113 <a name="l00087"></a><a class="code" href="classbdm_1_1Kalman.html#7b56ac423d0654b5755e4f852a870456">00087</a>                         mat <a class="code" href="classbdm_1_1Kalman.html#7b56ac423d0654b5755e4f852a870456" title="Matrix D.">D</a>; 
    114 <a name="l00089"></a><a class="code" href="classbdm_1_1Kalman.html#70f8bf19e81b532c60fd3a7a152425ee">00089</a>                         sq_T <a class="code" href="classbdm_1_1Kalman.html#70f8bf19e81b532c60fd3a7a152425ee" title="Matrix Q in square-root form.">Q</a>; 
    115 <a name="l00091"></a><a class="code" href="classbdm_1_1Kalman.html#475b088287cdfbba4dc60a3d027728b7">00091</a>                         sq_T <a class="code" href="classbdm_1_1Kalman.html#475b088287cdfbba4dc60a3d027728b7" title="Matrix R in square-root form.">R</a>; 
    116 <a name="l00092"></a>00092  
    117 <a name="l00094"></a><a class="code" href="classbdm_1_1Kalman.html#383f329ff18bbe219254c8b3b916f40d">00094</a>                         <a class="code" href="classbdm_1_1enorm.html" title="Gaussian density with positive definite (decomposed) covariance matrix.">enorm&lt;sq_T&gt;</a> <a class="code" href="classbdm_1_1Kalman.html#383f329ff18bbe219254c8b3b916f40d" title="posterior density on $x_t$">est</a>; 
    118 <a name="l00096"></a><a class="code" href="classbdm_1_1Kalman.html#ba555c394c429f6831c9bbabfa2c944c">00096</a>                         <a class="code" href="classbdm_1_1enorm.html" title="Gaussian density with positive definite (decomposed) covariance matrix.">enorm&lt;sq_T&gt;</a> <a class="code" href="classbdm_1_1Kalman.html#ba555c394c429f6831c9bbabfa2c944c" title="preditive density on $y_t$">fy</a>; 
    119 <a name="l00097"></a>00097  
    120 <a name="l00099"></a><a class="code" href="classbdm_1_1Kalman.html#bd69dfb802465f22dd84d73a180d5c92">00099</a>                         mat <a class="code" href="classbdm_1_1Kalman.html#bd69dfb802465f22dd84d73a180d5c92" title="placeholder for Kalman gain">_K</a>; 
    121 <a name="l00101"></a><a class="code" href="classbdm_1_1Kalman.html#c249d45258c8578b13858ad3e7b729b1">00101</a>                         vec&amp; <a class="code" href="classbdm_1_1Kalman.html#c249d45258c8578b13858ad3e7b729b1" title="cache of fy.mu">_yp</a>; 
    122 <a name="l00103"></a><a class="code" href="classbdm_1_1Kalman.html#2dd268f2d7fbe6382cb8825a1114192a">00103</a>                         sq_T&amp; <a class="code" href="classbdm_1_1Kalman.html#2dd268f2d7fbe6382cb8825a1114192a" title="cache of fy.R">_Ry</a>; 
    123 <a name="l00105"></a><a class="code" href="classbdm_1_1Kalman.html#fa172078091e45561343fa513dd573b0">00105</a>                         vec&amp; <a class="code" href="classbdm_1_1Kalman.html#fa172078091e45561343fa513dd573b0" title="cache of est.mu">_mu</a>; 
    124 <a name="l00107"></a><a class="code" href="classbdm_1_1Kalman.html#00c27b0bf324f0018497921ca23c71ed">00107</a>                         sq_T&amp; <a class="code" href="classbdm_1_1Kalman.html#00c27b0bf324f0018497921ca23c71ed" title="cache of est.R">_P</a>; 
    125 <a name="l00108"></a>00108  
    126 <a name="l00109"></a>00109                 <span class="keyword">public</span>: 
    127 <a name="l00111"></a>00111                         <a class="code" href="classbdm_1_1Kalman.html#025a0196cbcc2e6adb13311f9d3d52b4" title="Default constructor.">Kalman</a> ( ); 
    128 <a name="l00113"></a>00113                         <a class="code" href="classbdm_1_1Kalman.html#025a0196cbcc2e6adb13311f9d3d52b4" title="Default constructor.">Kalman</a> ( <span class="keyword">const</span> <a class="code" href="classbdm_1_1Kalman.html" title="Kalman filter with covariance matrices in square root form.">Kalman&lt;sq_T&gt;</a> &amp;K0 ); 
    129 <a name="l00115"></a>00115                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1Kalman.html#3c7fb87fb6b87d08deb6a5a7862da957" title="Set parameters with check of relevance.">set_parameters</a> ( <span class="keyword">const</span> mat &amp;A0,<span class="keyword">const</span> mat &amp;B0,<span class="keyword">const</span> mat &amp;C0,<span class="keyword">const</span> mat &amp;D0,<span class="keyword">const</span> sq_T &amp;Q0,<span class="keyword">const</span> sq_T &amp;R0 ); 
    130 <a name="l00117"></a><a class="code" href="classbdm_1_1Kalman.html#9264fc6b173ecb803d2684b883f32c68">00117</a>                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1Kalman.html#9264fc6b173ecb803d2684b883f32c68" title="Set estimate values, used e.g. in initialization.">set_est</a> ( <span class="keyword">const</span> vec &amp;mu0, <span class="keyword">const</span> sq_T &amp;P0 ) 
    131 <a name="l00118"></a>00118                         { 
    132 <a name="l00119"></a>00119                                 sq_T pom ( <a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a> ); 
    133 <a name="l00120"></a>00120                                 <a class="code" href="classbdm_1_1Kalman.html#383f329ff18bbe219254c8b3b916f40d" title="posterior density on $x_t$">est</a>.set_parameters ( mu0,P0 ); 
    134 <a name="l00121"></a>00121                                 P0.mult_sym ( <a class="code" href="classbdm_1_1Kalman.html#818eba63a23972786a4579ad30294177" title="Matrix C.">C</a>,pom ); 
    135 <a name="l00122"></a>00122                                 <a class="code" href="classbdm_1_1Kalman.html#ba555c394c429f6831c9bbabfa2c944c" title="preditive density on $y_t$">fy</a>.set_parameters ( <a class="code" href="classbdm_1_1Kalman.html#818eba63a23972786a4579ad30294177" title="Matrix C.">C</a>*mu0, pom ); 
    136 <a name="l00123"></a>00123                         }; 
    137 <a name="l00124"></a>00124  
    138 <a name="l00126"></a>00126                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1Kalman.html#4a39330c14eff8d13179e868a1d1aa8c" title="Here dt = [yt;ut] of appropriate dimensions.">bayes</a> ( <span class="keyword">const</span> vec &amp;dt ); 
    139 <a name="l00128"></a><a class="code" href="classbdm_1_1Kalman.html#f75e487ff6c129d7012d702030f8c890">00128</a>                         <span class="keyword">const</span> <a class="code" href="classbdm_1_1epdf.html" title="Probability density function with numerical statistics, e.g. posterior density.">epdf</a>&amp; <a class="code" href="classbdm_1_1Kalman.html#f75e487ff6c129d7012d702030f8c890" title="access function">posterior</a>()<span class="keyword"> const </span>{<span class="keywordflow">return</span> <a class="code" href="classbdm_1_1Kalman.html#383f329ff18bbe219254c8b3b916f40d" title="posterior density on $x_t$">est</a>;} 
    140 <a name="l00129"></a>00129                         <span class="keyword">const</span> <a class="code" href="classbdm_1_1enorm.html" title="Gaussian density with positive definite (decomposed) covariance matrix.">enorm&lt;sq_T&gt;</a>* _e()<span class="keyword"> const </span>{<span class="keywordflow">return</span> &amp;<a class="code" href="classbdm_1_1Kalman.html#383f329ff18bbe219254c8b3b916f40d" title="posterior density on $x_t$">est</a>;} 
    141 <a name="l00131"></a><a class="code" href="classbdm_1_1Kalman.html#c788ec6e6c6f5f5861ae8a56d8ede277">00131</a>                         mat&amp; <a class="code" href="classbdm_1_1Kalman.html#c788ec6e6c6f5f5861ae8a56d8ede277" title="access function">__K</a>() {<span class="keywordflow">return</span> <a class="code" href="classbdm_1_1Kalman.html#bd69dfb802465f22dd84d73a180d5c92" title="placeholder for Kalman gain">_K</a>;} 
    142 <a name="l00133"></a><a class="code" href="classbdm_1_1Kalman.html#a250d1dbe7bba861dba2a324520cfa48">00133</a>                         vec <a class="code" href="classbdm_1_1Kalman.html#a250d1dbe7bba861dba2a324520cfa48" title="access function">_dP</a>() {<span class="keywordflow">return</span> <a class="code" href="classbdm_1_1Kalman.html#00c27b0bf324f0018497921ca23c71ed" title="cache of est.R">_P</a>-&gt;getD();} 
    143 <a name="l00134"></a>00134         }; 
    144 <a name="l00135"></a>00135  
    145 <a name="l00142"></a><a class="code" href="classbdm_1_1KalmanCh.html">00142</a>         <span class="keyword">class </span><a class="code" href="classbdm_1_1KalmanCh.html" title="Kalman filter in square root form.">KalmanCh</a> : <span class="keyword">public</span> <a class="code" href="classbdm_1_1Kalman.html" title="Kalman filter with covariance matrices in square root form.">Kalman</a>&lt;chmat&gt; 
    146 <a name="l00143"></a>00143         { 
    147 <a name="l00144"></a>00144                 <span class="keyword">protected</span>: 
    148 <a name="l00146"></a><a class="code" href="classbdm_1_1KalmanCh.html#48611c8582706cfa62e832be0972e75d">00146</a>                         mat <a class="code" href="classbdm_1_1KalmanCh.html#48611c8582706cfa62e832be0972e75d" title="pre array (triangular matrix)">preA</a>; 
    149 <a name="l00148"></a><a class="code" href="classbdm_1_1KalmanCh.html#bcbd68f51d4b57246e7784ca5900171f">00148</a>                         mat <a class="code" href="classbdm_1_1KalmanCh.html#bcbd68f51d4b57246e7784ca5900171f" title="post array (triangular matrix)">postA</a>; 
    150 <a name="l00149"></a>00149  
    151 <a name="l00150"></a>00150                 <span class="keyword">public</span>: 
    152 <a name="l00152"></a><a class="code" href="classbdm_1_1KalmanCh.html#24ce65bdaa538d4d5153d709a929b996">00152</a>                         <a class="code" href="classbdm_1_1BM.html" title="Bayesian Model of a system, i.e. all uncertainty is modeled by probabilities.">BM</a>* <a class="code" href="classbdm_1_1KalmanCh.html#24ce65bdaa538d4d5153d709a929b996" title="copy constructor">_copy_</a>()<span class="keyword"> const</span> 
    153 <a name="l00153"></a>00153 <span class="keyword">                        </span>{ 
    154 <a name="l00154"></a>00154                                 <a class="code" href="classbdm_1_1KalmanCh.html" title="Kalman filter in square root form.">KalmanCh</a>* K=<span class="keyword">new</span> <a class="code" href="classbdm_1_1KalmanCh.html" title="Kalman filter in square root form.">KalmanCh</a>; 
    155 <a name="l00155"></a>00155                                 K-&gt;<a class="code" href="classbdm_1_1KalmanCh.html#20a4d4c664e8ac8a3f1bb7b0d11c6d87" title="Set parameters with check of relevance.">set_parameters</a> ( <a class="code" href="classbdm_1_1Kalman.html#0a2072e2090c10fac74ad30a023a4ace" title="Matrix A.">A</a>,<a class="code" href="classbdm_1_1Kalman.html#5977b2c81857948a35105f0e7840203c" title="Matrix B.">B</a>,<a class="code" href="classbdm_1_1Kalman.html#818eba63a23972786a4579ad30294177" title="Matrix C.">C</a>,<a class="code" href="classbdm_1_1Kalman.html#7b56ac423d0654b5755e4f852a870456" title="Matrix D.">D</a>,<a class="code" href="classbdm_1_1Kalman.html#70f8bf19e81b532c60fd3a7a152425ee" title="Matrix Q in square-root form.">Q</a>,<a class="code" href="classbdm_1_1Kalman.html#475b088287cdfbba4dc60a3d027728b7" title="Matrix R in square-root form.">R</a> ); 
    156 <a name="l00156"></a>00156                                 K-&gt;set_statistics ( <a class="code" href="classbdm_1_1Kalman.html#fa172078091e45561343fa513dd573b0" title="cache of est.mu">_mu</a>,<a class="code" href="classbdm_1_1Kalman.html#00c27b0bf324f0018497921ca23c71ed" title="cache of est.R">_P</a> ); 
    157 <a name="l00157"></a>00157                                 <span class="keywordflow">return</span> K; 
    158 <a name="l00158"></a>00158                         } 
    159 <a name="l00160"></a>00160                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1KalmanCh.html#20a4d4c664e8ac8a3f1bb7b0d11c6d87" title="Set parameters with check of relevance.">set_parameters</a> ( <span class="keyword">const</span> mat &amp;A0,<span class="keyword">const</span> mat &amp;B0,<span class="keyword">const</span> mat &amp;C0,<span class="keyword">const</span> mat &amp;D0,<span class="keyword">const</span> <a class="code" href="classchmat.html" title="Symmetric matrix stored in square root decomposition using upper cholesky.">chmat</a> &amp;Q0,<span class="keyword">const</span> <a class="code" href="classchmat.html" title="Symmetric matrix stored in square root decomposition using upper cholesky.">chmat</a> &amp;R0 ); 
    160 <a name="l00161"></a>00161                         <span class="keywordtype">void</span> set_statistics ( <span class="keyword">const</span> vec &amp;mu0, <span class="keyword">const</span> <a class="code" href="classchmat.html" title="Symmetric matrix stored in square root decomposition using upper cholesky.">chmat</a> &amp;P0 ) 
    161 <a name="l00162"></a>00162                         { 
    162 <a name="l00163"></a>00163                                 <a class="code" href="classbdm_1_1Kalman.html#383f329ff18bbe219254c8b3b916f40d" title="posterior density on $x_t$">est</a>.set_parameters ( mu0,P0 ); 
    163 <a name="l00164"></a>00164                         }; 
    164 <a name="l00165"></a>00165  
    165 <a name="l00166"></a>00166  
    166 <a name="l00180"></a>00180                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1KalmanCh.html#b41fe5540548100b08e1684c3be767b6" title="Here dt = [yt;ut] of appropriate dimensions.">bayes</a> ( <span class="keyword">const</span> vec &amp;dt ); 
    167 <a name="l00181"></a>00181         }; 
    168 <a name="l00182"></a>00182  
    169 <a name="l00188"></a><a class="code" href="classbdm_1_1EKFfull.html">00188</a>         <span class="keyword">class </span><a class="code" href="classbdm_1_1EKFfull.html" title="Extended Kalman Filter in full matrices.">EKFfull</a> : <span class="keyword">public</span> <a class="code" href="classbdm_1_1KalmanFull.html" title="Basic Kalman filter with full matrices (education purpose only)! Will be deleted...">KalmanFull</a>, <span class="keyword">public</span> <a class="code" href="classbdm_1_1BM.html" title="Bayesian Model of a system, i.e. all uncertainty is modeled by probabilities.">BM</a> 
    170 <a name="l00189"></a>00189         { 
    171 <a name="l00190"></a>00190                 <span class="keyword">protected</span>: 
    172 <a name="l00192"></a><a class="code" href="classbdm_1_1EKFfull.html#016d3ec108a430b1e70cf7d78bb963f4">00192</a>                         <a class="code" href="classbdm_1_1diffbifn.html" title="Class representing a differentiable function of two variables .">diffbifn</a>* <a class="code" href="classbdm_1_1EKFfull.html#016d3ec108a430b1e70cf7d78bb963f4" title="Internal Model f(x,u).">pfxu</a>; 
    173 <a name="l00194"></a><a class="code" href="classbdm_1_1EKFfull.html#f7cdf9cf74284630b4578a2cb8ba92c7">00194</a>                         <a class="code" href="classbdm_1_1diffbifn.html" title="Class representing a differentiable function of two variables .">diffbifn</a>* <a class="code" href="classbdm_1_1EKFfull.html#f7cdf9cf74284630b4578a2cb8ba92c7" title="Observation Model h(x,u).">phxu</a>; 
    174 <a name="l00195"></a>00195  
    175 <a name="l00196"></a>00196                         <a class="code" href="classbdm_1_1enorm.html">enorm&lt;fsqmat&gt;</a> E; 
    176 <a name="l00197"></a>00197                 <span class="keyword">public</span>: 
    177 <a name="l00199"></a>00199                         <a class="code" href="classbdm_1_1EKFfull.html#6939c345389abb8b2481457b4cfe1165" title="Default constructor.">EKFfull</a> ( ); 
    178 <a name="l00201"></a>00201                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1EKFfull.html#78748da361ba61fef162b0d8956d1743" title="Set nonlinear functions for mean values and covariance matrices.">set_parameters</a> ( <a class="code" href="classbdm_1_1diffbifn.html" title="Class representing a differentiable function of two variables .">diffbifn</a>* <a class="code" href="classbdm_1_1EKFfull.html#016d3ec108a430b1e70cf7d78bb963f4" title="Internal Model f(x,u).">pfxu</a>, <a class="code" href="classbdm_1_1diffbifn.html" title="Class representing a differentiable function of two variables .">diffbifn</a>* <a class="code" href="classbdm_1_1EKFfull.html#f7cdf9cf74284630b4578a2cb8ba92c7" title="Observation Model h(x,u).">phxu</a>, <span class="keyword">const</span> mat Q0, <span class="keyword">const</span> mat R0 ); 
    179 <a name="l00203"></a>00203                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1EKFfull.html#f149ae8e9ce14d9931a7bb2850736699" title="Here dt = [yt;ut] of appropriate dimensions.">bayes</a> ( <span class="keyword">const</span> vec &amp;dt ); 
    180 <a name="l00205"></a><a class="code" href="classbdm_1_1EKFfull.html#1949a9b1496a855cc7c24e619bc52365">00205</a>                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1EKFfull.html#1949a9b1496a855cc7c24e619bc52365" title="set estimates">set_statistics</a> ( vec mu0, mat P0 ) {<a class="code" href="classbdm_1_1KalmanFull.html#2defb75e58892615c5f95fd844f3a666" title="Mean value of the posterior density.">mu</a>=mu0;<a class="code" href="classbdm_1_1KalmanFull.html#acacd228e100c3e937de575ad2d7cd9c" title="Variance of the posterior density.">P</a>=P0;}; 
    181 <a name="l00207"></a><a class="code" href="classbdm_1_1EKFfull.html#7e9a69f36a0a0615c9abb806772ef36d">00207</a>                         <span class="keyword">const</span> <a class="code" href="classbdm_1_1epdf.html" title="Probability density function with numerical statistics, e.g. posterior density.">epdf</a>&amp; <a class="code" href="classbdm_1_1EKFfull.html#7e9a69f36a0a0615c9abb806772ef36d" title="dummy!">posterior</a>()<span class="keyword"> const</span>{<span class="keywordflow">return</span> E;}; 
    182 <a name="l00208"></a>00208                         <span class="keyword">const</span> <a class="code" href="classbdm_1_1enorm.html">enorm&lt;fsqmat&gt;</a>* _e()<span class="keyword"> const</span>{<span class="keywordflow">return</span> &amp;E;}; 
    183 <a name="l00209"></a>00209                         <span class="keyword">const</span> mat _R() {<span class="keywordflow">return</span> <a class="code" href="classbdm_1_1KalmanFull.html#acacd228e100c3e937de575ad2d7cd9c" title="Variance of the posterior density.">P</a>;} 
    184 <a name="l00210"></a>00210         }; 
    185 <a name="l00211"></a>00211  
    186 <a name="l00217"></a>00217         <span class="keyword">template</span>&lt;<span class="keyword">class</span> sq_T&gt; 
    187 <a name="l00218"></a><a class="code" href="classbdm_1_1EKF.html">00218</a>         <span class="keyword">class </span><a class="code" href="classbdm_1_1EKF.html" title="Extended Kalman Filter.">EKF</a> : <span class="keyword">public</span> <a class="code" href="classbdm_1_1Kalman.html" title="Kalman filter with covariance matrices in square root form.">Kalman</a>&lt;fsqmat&gt; 
    188 <a name="l00219"></a>00219         { 
    189 <a name="l00221"></a>00221                         <a class="code" href="classbdm_1_1diffbifn.html" title="Class representing a differentiable function of two variables .">diffbifn</a>* pfxu; 
    190 <a name="l00223"></a>00223                         <a class="code" href="classbdm_1_1diffbifn.html" title="Class representing a differentiable function of two variables .">diffbifn</a>* phxu; 
    191 <a name="l00224"></a>00224                 <span class="keyword">public</span>: 
    192 <a name="l00226"></a>00226                         <a class="code" href="classbdm_1_1EKF.html#d087a8bb408d26ac4f5c542746b81059" title="Default constructor.">EKF</a> ( <a class="code" href="classbdm_1_1RV.html" title="Class representing variables, most often random variables.">RV</a> rvx, <a class="code" href="classbdm_1_1RV.html" title="Class representing variables, most often random variables.">RV</a> <a class="code" href="classbdm_1_1Kalman.html#3fe475a1e920b20b63bb342c0e1571f7" title="Indetifier of output rv.">rvy</a>, <a class="code" href="classbdm_1_1RV.html" title="Class representing variables, most often random variables.">RV</a> <a class="code" href="classbdm_1_1Kalman.html#149e27424fd1a7cc1c998ea088618a94" title="Indetifier of exogeneous rv.">rvu</a> ); 
    193 <a name="l00228"></a><a class="code" href="classbdm_1_1EKF.html#fe9b2e227255ad32dc73df316b7318f4">00228</a>                         <a class="code" href="classbdm_1_1EKF.html" title="Extended Kalman Filter.">EKF&lt;sq_T&gt;</a>* <a class="code" href="classbdm_1_1EKF.html#fe9b2e227255ad32dc73df316b7318f4" title="copy constructor">_copy_</a>()<span class="keyword"> const </span>{ <span class="keywordflow">return</span> <span class="keyword">new</span> <a class="code" href="classbdm_1_1EKF.html" title="Extended Kalman Filter.">EKF&lt;sq_T&gt;</a> ( this ); } 
    194 <a name="l00230"></a>00230                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1EKF.html#00fec1a0a6a467eb83fb36c65eba7bcb" title="Set nonlinear functions for mean values and covariance matrices.">set_parameters</a> ( <a class="code" href="classbdm_1_1diffbifn.html" title="Class representing a differentiable function of two variables .">diffbifn</a>* pfxu, <a class="code" href="classbdm_1_1diffbifn.html" title="Class representing a differentiable function of two variables .">diffbifn</a>* phxu, <span class="keyword">const</span> sq_T Q0, <span class="keyword">const</span> sq_T R0 ); 
    195 <a name="l00232"></a>00232                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1EKF.html#3fb182ecc29b10ca1163cecbf3bcccfa" title="Here dt = [yt;ut] of appropriate dimensions.">bayes</a> ( <span class="keyword">const</span> vec &amp;dt ); 
    196 <a name="l00233"></a>00233         }; 
    197 <a name="l00234"></a>00234  
    198 <a name="l00241"></a><a class="code" href="classbdm_1_1EKFCh.html">00241</a>         <span class="keyword">class </span><a class="code" href="classbdm_1_1EKFCh.html" title="Extended Kalman Filter in Square root.">EKFCh</a> : <span class="keyword">public</span> <a class="code" href="classbdm_1_1KalmanCh.html" title="Kalman filter in square root form.">KalmanCh</a> 
    199 <a name="l00242"></a>00242         { 
    200 <a name="l00243"></a>00243                 <span class="keyword">protected</span>: 
    201 <a name="l00245"></a><a class="code" href="classbdm_1_1EKFCh.html#e1e895f994398a55bc425551fc275ba3">00245</a>                         <a class="code" href="classbdm_1_1diffbifn.html" title="Class representing a differentiable function of two variables .">diffbifn</a>* <a class="code" href="classbdm_1_1EKFCh.html#e1e895f994398a55bc425551fc275ba3" title="Internal Model f(x,u).">pfxu</a>; 
    202 <a name="l00247"></a><a class="code" href="classbdm_1_1EKFCh.html#6b34c69641826322467b704e8252f317">00247</a>                         <a class="code" href="classbdm_1_1diffbifn.html" title="Class representing a differentiable function of two variables .">diffbifn</a>* <a class="code" href="classbdm_1_1EKFCh.html#6b34c69641826322467b704e8252f317" title="Observation Model h(x,u).">phxu</a>; 
    203 <a name="l00248"></a>00248                 <span class="keyword">public</span>: 
    204 <a name="l00250"></a><a class="code" href="classbdm_1_1EKFCh.html#1d1d91400e3f177de9fe7962ea17adc4">00250</a>                         <a class="code" href="classbdm_1_1BM.html" title="Bayesian Model of a system, i.e. all uncertainty is modeled by probabilities.">BM</a>* <a class="code" href="classbdm_1_1EKFCh.html#1d1d91400e3f177de9fe7962ea17adc4" title="copy constructor duplicated - calls different set_parameters">_copy_</a>()<span class="keyword"> const</span> 
    205 <a name="l00251"></a>00251 <span class="keyword">                        </span>{ 
    206 <a name="l00252"></a>00252                                 <a class="code" href="classbdm_1_1EKFCh.html" title="Extended Kalman Filter in Square root.">EKFCh</a>* E=<span class="keyword">new</span> <a class="code" href="classbdm_1_1EKFCh.html" title="Extended Kalman Filter in Square root.">EKFCh</a>; 
    207 <a name="l00253"></a>00253                                 E-&gt;<a class="code" href="classbdm_1_1EKFCh.html#50f9fbffad721f35e5ccb75d0f6b842a" title="Set nonlinear functions for mean values and covariance matrices.">set_parameters</a> ( <a class="code" href="classbdm_1_1EKFCh.html#e1e895f994398a55bc425551fc275ba3" title="Internal Model f(x,u).">pfxu</a>,<a class="code" href="classbdm_1_1EKFCh.html#6b34c69641826322467b704e8252f317" title="Observation Model h(x,u).">phxu</a>,<a class="code" href="classbdm_1_1Kalman.html#70f8bf19e81b532c60fd3a7a152425ee" title="Matrix Q in square-root form.">Q</a>,<a class="code" href="classbdm_1_1Kalman.html#475b088287cdfbba4dc60a3d027728b7" title="Matrix R in square-root form.">R</a> ); 
    208 <a name="l00254"></a>00254                                 E-&gt;set_statistics ( <a class="code" href="classbdm_1_1Kalman.html#fa172078091e45561343fa513dd573b0" title="cache of est.mu">_mu</a>,<a class="code" href="classbdm_1_1Kalman.html#00c27b0bf324f0018497921ca23c71ed" title="cache of est.R">_P</a> ); 
    209 <a name="l00255"></a>00255                                 <span class="keywordflow">return</span> E; 
    210 <a name="l00256"></a>00256                         } 
    211 <a name="l00258"></a>00258                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1EKFCh.html#50f9fbffad721f35e5ccb75d0f6b842a" title="Set nonlinear functions for mean values and covariance matrices.">set_parameters</a> ( <a class="code" href="classbdm_1_1diffbifn.html" title="Class representing a differentiable function of two variables .">diffbifn</a>* <a class="code" href="classbdm_1_1EKFCh.html#e1e895f994398a55bc425551fc275ba3" title="Internal Model f(x,u).">pfxu</a>, <a class="code" href="classbdm_1_1diffbifn.html" title="Class representing a differentiable function of two variables .">diffbifn</a>* <a class="code" href="classbdm_1_1EKFCh.html#6b34c69641826322467b704e8252f317" title="Observation Model h(x,u).">phxu</a>, <span class="keyword">const</span> <a class="code" href="classchmat.html" title="Symmetric matrix stored in square root decomposition using upper cholesky.">chmat</a> Q0, <span class="keyword">const</span> <a class="code" href="classchmat.html" title="Symmetric matrix stored in square root decomposition using upper cholesky.">chmat</a> R0 ); 
    212 <a name="l00260"></a>00260                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1EKFCh.html#4c8609c37290b158f88a31dae4047225" title="Here dt = [yt;ut] of appropriate dimensions.">bayes</a> ( <span class="keyword">const</span> vec &amp;dt ); 
    213 <a name="l00261"></a>00261  
    214 <a name="l00262"></a>00262                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1EKFCh.html#3952e181ef0cf230c325ad3be1f002df" title="This method arrange instance properties according the data stored in the Setting...">from_setting</a>( <span class="keyword">const</span> Setting &amp;<span class="keyword">set</span> ); 
    215 <a name="l00263"></a>00263  
    216 <a name="l00264"></a>00264                         <span class="comment">// TODO dodelat void to_setting( Setting &amp;set ) const;</span> 
    217 <a name="l00265"></a>00265  
    218 <a name="l00266"></a>00266         }; 
     80<a name="l00032"></a>00032 <span class="keyword">template</span>&lt;<span class="keyword">class</span> sq_T&gt; 
     81<a name="l00033"></a><a class="code" href="classbdm_1_1StateSpace.html">00033</a> <span class="keyword">class </span><a class="code" href="classbdm_1_1StateSpace.html" title="Basic elements of linear state-space model.">StateSpace</a> 
     82<a name="l00034"></a>00034 { 
     83<a name="l00035"></a>00035         <span class="keyword">protected</span>: 
     84<a name="l00037"></a><a class="code" href="classbdm_1_1StateSpace.html#ac3120f1c9cd7c3a0ba9944e4a2381f21">00037</a>                 <span class="keywordtype">int</span> <a class="code" href="classbdm_1_1StateSpace.html#ac3120f1c9cd7c3a0ba9944e4a2381f21" title="cache of rv.count()">dimx</a>; 
     85<a name="l00039"></a><a class="code" href="classbdm_1_1StateSpace.html#a3b784d85ca911866225a79193ae1441f">00039</a>                 <span class="keywordtype">int</span> <a class="code" href="classbdm_1_1StateSpace.html#a3b784d85ca911866225a79193ae1441f" title="cache of rvy.count()">dimy</a>; 
     86<a name="l00041"></a><a class="code" href="classbdm_1_1StateSpace.html#a95bb59ffbfd34c55d03d4d7a2a9b4faf">00041</a>                 <span class="keywordtype">int</span> <a class="code" href="classbdm_1_1StateSpace.html#a95bb59ffbfd34c55d03d4d7a2a9b4faf" title="cache of rvu.count()">dimu</a>; 
     87<a name="l00043"></a><a class="code" href="classbdm_1_1StateSpace.html#ade7d828a8d06cbbd5ac45afeaf9f0c7b">00043</a>                 mat <a class="code" href="classbdm_1_1StateSpace.html#ade7d828a8d06cbbd5ac45afeaf9f0c7b" title="Matrix A.">A</a>; 
     88<a name="l00045"></a><a class="code" href="classbdm_1_1StateSpace.html#a0cdaa906550290b759a1584d02b3ca51">00045</a>                 mat <a class="code" href="classbdm_1_1StateSpace.html#a0cdaa906550290b759a1584d02b3ca51" title="Matrix B.">B</a>; 
     89<a name="l00047"></a><a class="code" href="classbdm_1_1StateSpace.html#ac7ec82d2200c956cff6dff559bd32ff9">00047</a>                 mat <a class="code" href="classbdm_1_1StateSpace.html#ac7ec82d2200c956cff6dff559bd32ff9" title="Matrix C.">C</a>; 
     90<a name="l00049"></a><a class="code" href="classbdm_1_1StateSpace.html#ad5769a41b34eb518716120cf04dbc23f">00049</a>                 mat <a class="code" href="classbdm_1_1StateSpace.html#ad5769a41b34eb518716120cf04dbc23f" title="Matrix D.">D</a>; 
     91<a name="l00051"></a><a class="code" href="classbdm_1_1StateSpace.html#a66248c83836424f1cd7c1b5b9a92cf1f">00051</a>                 sq_T <a class="code" href="classbdm_1_1StateSpace.html#a66248c83836424f1cd7c1b5b9a92cf1f" title="Matrix Q in square-root form.">Q</a>; 
     92<a name="l00053"></a><a class="code" href="classbdm_1_1StateSpace.html#a11dd3493d62ec9329860386adb3e6084">00053</a>                 sq_T <a class="code" href="classbdm_1_1StateSpace.html#a11dd3493d62ec9329860386adb3e6084" title="Matrix R in square-root form.">R</a>; 
     93<a name="l00054"></a>00054         <span class="keyword">public</span>: 
     94<a name="l00055"></a>00055                 <a class="code" href="classbdm_1_1StateSpace.html" title="Basic elements of linear state-space model.">StateSpace</a>() : <a class="code" href="classbdm_1_1StateSpace.html#ac3120f1c9cd7c3a0ba9944e4a2381f21" title="cache of rv.count()">dimx</a> (0), <a class="code" href="classbdm_1_1StateSpace.html#a3b784d85ca911866225a79193ae1441f" title="cache of rvy.count()">dimy</a> (0), <a class="code" href="classbdm_1_1StateSpace.html#a95bb59ffbfd34c55d03d4d7a2a9b4faf" title="cache of rvu.count()">dimu</a> (0), <a class="code" href="classbdm_1_1StateSpace.html#ade7d828a8d06cbbd5ac45afeaf9f0c7b" title="Matrix A.">A</a>(), <a class="code" href="classbdm_1_1StateSpace.html#a0cdaa906550290b759a1584d02b3ca51" title="Matrix B.">B</a>(), <a class="code" href="classbdm_1_1StateSpace.html#ac7ec82d2200c956cff6dff559bd32ff9" title="Matrix C.">C</a>(), <a class="code" href="classbdm_1_1StateSpace.html#ad5769a41b34eb518716120cf04dbc23f" title="Matrix D.">D</a>(), <a class="code" href="classbdm_1_1StateSpace.html#a66248c83836424f1cd7c1b5b9a92cf1f" title="Matrix Q in square-root form.">Q</a>(), <a class="code" href="classbdm_1_1StateSpace.html#a11dd3493d62ec9329860386adb3e6084" title="Matrix R in square-root form.">R</a>() {} 
     95<a name="l00056"></a>00056                 <span class="keywordtype">void</span> set_parameters (<span class="keyword">const</span> mat &amp;A0, <span class="keyword">const</span>  mat &amp;B0, <span class="keyword">const</span>  mat &amp;C0, <span class="keyword">const</span>  mat &amp;D0, <span class="keyword">const</span>  sq_T &amp;Q0, <span class="keyword">const</span> sq_T &amp;R0); 
     96<a name="l00057"></a>00057                 <span class="keywordtype">void</span> validate(); 
     97<a name="l00059"></a><a class="code" href="classbdm_1_1StateSpace.html#a02470085bbf3c41fe8e36544813eecbd">00059</a>                 <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1StateSpace.html#a02470085bbf3c41fe8e36544813eecbd" title="not virtual in this case">from_setting</a> (<span class="keyword">const</span> Setting &amp;<span class="keyword">set</span>) { 
     98<a name="l00060"></a>00060                         <a class="code" href="classbdm_1_1UI.html#acd1667e6fec99ec64dabcb3ca2ff922d">UI::get</a> (<a class="code" href="classbdm_1_1StateSpace.html#ade7d828a8d06cbbd5ac45afeaf9f0c7b" title="Matrix A.">A</a>, <span class="keyword">set</span>, <span class="stringliteral">&quot;A&quot;</span>, UI::compulsory); 
     99<a name="l00061"></a>00061                         <a class="code" href="classbdm_1_1UI.html#acd1667e6fec99ec64dabcb3ca2ff922d">UI::get</a> (<a class="code" href="classbdm_1_1StateSpace.html#a0cdaa906550290b759a1584d02b3ca51" title="Matrix B.">B</a>, <span class="keyword">set</span>, <span class="stringliteral">&quot;B&quot;</span>, UI::compulsory); 
     100<a name="l00062"></a>00062                         <a class="code" href="classbdm_1_1UI.html#acd1667e6fec99ec64dabcb3ca2ff922d">UI::get</a> (<a class="code" href="classbdm_1_1StateSpace.html#ac7ec82d2200c956cff6dff559bd32ff9" title="Matrix C.">C</a>, <span class="keyword">set</span>, <span class="stringliteral">&quot;C&quot;</span>, UI::compulsory); 
     101<a name="l00063"></a>00063                         <a class="code" href="classbdm_1_1UI.html#acd1667e6fec99ec64dabcb3ca2ff922d">UI::get</a> (<a class="code" href="classbdm_1_1StateSpace.html#ad5769a41b34eb518716120cf04dbc23f" title="Matrix D.">D</a>, <span class="keyword">set</span>, <span class="stringliteral">&quot;D&quot;</span>, UI::compulsory); 
     102<a name="l00064"></a>00064                         mat Qtm, Rtm; 
     103<a name="l00065"></a>00065                         <span class="keywordflow">if</span>(!<a class="code" href="classbdm_1_1UI.html#acd1667e6fec99ec64dabcb3ca2ff922d">UI::get</a>(Qtm, <span class="keyword">set</span>, <span class="stringliteral">&quot;Q&quot;</span>, UI::optional)){ 
     104<a name="l00066"></a>00066                                 vec dq; 
     105<a name="l00067"></a>00067                                 <a class="code" href="classbdm_1_1UI.html#acd1667e6fec99ec64dabcb3ca2ff922d">UI::get</a>(dq, <span class="keyword">set</span>, <span class="stringliteral">&quot;dQ&quot;</span>, UI::compulsory); 
     106<a name="l00068"></a>00068                                 Qtm=diag(dq); 
     107<a name="l00069"></a>00069                         } 
     108<a name="l00070"></a>00070                         <span class="keywordflow">if</span>(!<a class="code" href="classbdm_1_1UI.html#acd1667e6fec99ec64dabcb3ca2ff922d">UI::get</a>(Rtm, <span class="keyword">set</span>, <span class="stringliteral">&quot;R&quot;</span>, UI::optional)){ 
     109<a name="l00071"></a>00071                                 vec dr; 
     110<a name="l00072"></a>00072                                 <a class="code" href="classbdm_1_1UI.html#acd1667e6fec99ec64dabcb3ca2ff922d">UI::get</a>(dr, <span class="keyword">set</span>, <span class="stringliteral">&quot;dQ&quot;</span>, UI::compulsory); 
     111<a name="l00073"></a>00073                                 Rtm=diag(dr); 
     112<a name="l00074"></a>00074                         } 
     113<a name="l00075"></a>00075                         <a class="code" href="classbdm_1_1StateSpace.html#a11dd3493d62ec9329860386adb3e6084" title="Matrix R in square-root form.">R</a>=Rtm; <span class="comment">// automatic conversion</span> 
     114<a name="l00076"></a>00076                         <a class="code" href="classbdm_1_1StateSpace.html#a66248c83836424f1cd7c1b5b9a92cf1f" title="Matrix Q in square-root form.">Q</a>=Qtm;  
     115<a name="l00077"></a>00077                          
     116<a name="l00078"></a>00078                         validate(); 
     117<a name="l00079"></a>00079                 }                
     118<a name="l00081"></a><a class="code" href="classbdm_1_1StateSpace.html#ab1972e00d9b9dd22a0f983c7cb0b8b40">00081</a>                 <span class="keywordtype">int</span> <a class="code" href="classbdm_1_1StateSpace.html#ab1972e00d9b9dd22a0f983c7cb0b8b40" title="access function">_dimx</a>(){<span class="keywordflow">return</span> <a class="code" href="classbdm_1_1StateSpace.html#ac3120f1c9cd7c3a0ba9944e4a2381f21" title="cache of rv.count()">dimx</a>;} 
     119<a name="l00083"></a><a class="code" href="classbdm_1_1StateSpace.html#af3d83a4b39e05df9fb4246fd6ddc2a60">00083</a>                 <span class="keywordtype">int</span> <a class="code" href="classbdm_1_1StateSpace.html#af3d83a4b39e05df9fb4246fd6ddc2a60" title="access function">_dimy</a>(){<span class="keywordflow">return</span> <a class="code" href="classbdm_1_1StateSpace.html#a3b784d85ca911866225a79193ae1441f" title="cache of rvy.count()">dimy</a>;} 
     120<a name="l00085"></a><a class="code" href="classbdm_1_1StateSpace.html#aa238842025a0eaade26d5d79a0e9000e">00085</a>                 <span class="keywordtype">int</span> <a class="code" href="classbdm_1_1StateSpace.html#aa238842025a0eaade26d5d79a0e9000e" title="access function">_dimu</a>(){<span class="keywordflow">return</span> <a class="code" href="classbdm_1_1StateSpace.html#a95bb59ffbfd34c55d03d4d7a2a9b4faf" title="cache of rvu.count()">dimu</a>;} 
     121<a name="l00087"></a><a class="code" href="classbdm_1_1StateSpace.html#aa70f6c8ab37f955f408361150e13c47b">00087</a>                 mat <a class="code" href="classbdm_1_1StateSpace.html#aa70f6c8ab37f955f408361150e13c47b" title="access function">_A</a>(){<span class="keywordflow">return</span> <a class="code" href="classbdm_1_1StateSpace.html#ade7d828a8d06cbbd5ac45afeaf9f0c7b" title="Matrix A.">A</a>;} 
     122<a name="l00089"></a><a class="code" href="classbdm_1_1StateSpace.html#a4272982f976ea9d0ea7c9b7182ed7e3c">00089</a>                 mat <a class="code" href="classbdm_1_1StateSpace.html#a4272982f976ea9d0ea7c9b7182ed7e3c" title="access function">_B</a>(){<span class="keywordflow">return</span> <a class="code" href="classbdm_1_1StateSpace.html#a0cdaa906550290b759a1584d02b3ca51" title="Matrix B.">B</a>;} 
     123<a name="l00091"></a><a class="code" href="classbdm_1_1StateSpace.html#aec4c0923e2b5d0c3e5dfe119ffee511e">00091</a>                 mat <a class="code" href="classbdm_1_1StateSpace.html#aec4c0923e2b5d0c3e5dfe119ffee511e" title="access function">_C</a>(){<span class="keywordflow">return</span> <a class="code" href="classbdm_1_1StateSpace.html#ac7ec82d2200c956cff6dff559bd32ff9" title="Matrix C.">C</a>;} 
     124<a name="l00093"></a><a class="code" href="classbdm_1_1StateSpace.html#ae0757fcc5e0ebaf0bd95f522bf405f06">00093</a>                 mat <a class="code" href="classbdm_1_1StateSpace.html#ae0757fcc5e0ebaf0bd95f522bf405f06" title="access function">_D</a>(){<span class="keywordflow">return</span> <a class="code" href="classbdm_1_1StateSpace.html#ad5769a41b34eb518716120cf04dbc23f" title="Matrix D.">D</a>;} 
     125<a name="l00095"></a><a class="code" href="classbdm_1_1StateSpace.html#a4c908775f27db8d869b93078862a4934">00095</a>                 sq_T <a class="code" href="classbdm_1_1StateSpace.html#a4c908775f27db8d869b93078862a4934" title="access function">_Q</a>(){<span class="keywordflow">return</span> <a class="code" href="classbdm_1_1StateSpace.html#a66248c83836424f1cd7c1b5b9a92cf1f" title="Matrix Q in square-root form.">Q</a>;} 
     126<a name="l00097"></a><a class="code" href="classbdm_1_1StateSpace.html#a8c94418779eb70f6199fa3467c45f316">00097</a>                 sq_T <a class="code" href="classbdm_1_1StateSpace.html#a8c94418779eb70f6199fa3467c45f316" title="access function">_R</a>(){<span class="keywordflow">return</span> <a class="code" href="classbdm_1_1StateSpace.html#a11dd3493d62ec9329860386adb3e6084" title="Matrix R in square-root form.">R</a>;} 
     127<a name="l00098"></a>00098 }; 
     128<a name="l00099"></a>00099  
     129<a name="l00101"></a>00101 <span class="keyword">template</span>&lt;<span class="keyword">class</span> sq_T&gt; 
     130<a name="l00102"></a><a class="code" href="classbdm_1_1Kalman.html">00102</a> <span class="keyword">class </span><a class="code" href="classbdm_1_1Kalman.html" title="Common abstract base for Kalman filters.">Kalman</a>: <span class="keyword">public</span> <a class="code" href="classbdm_1_1BM.html" title="Bayesian Model of a system, i.e. all uncertainty is modeled by probabilities.">BM</a>, <span class="keyword">public</span> <a class="code" href="classbdm_1_1StateSpace.html" title="Basic elements of linear state-space model.">StateSpace</a>&lt;sq_T&gt; 
     131<a name="l00103"></a>00103 { 
     132<a name="l00104"></a>00104         <span class="keyword">protected</span>: 
     133<a name="l00106"></a><a class="code" href="classbdm_1_1Kalman.html#aaac28e226fe6cbff5a9ae38d8d025d7a">00106</a>                 <a class="code" href="classbdm_1_1RV.html" title="Class representing variables, most often random variables.">RV</a> <a class="code" href="classbdm_1_1Kalman.html#aaac28e226fe6cbff5a9ae38d8d025d7a" title="id of output">yrv</a>; 
     134<a name="l00108"></a><a class="code" href="classbdm_1_1Kalman.html#a44d4a8ab05d5311286e1da78b831633e">00108</a>                 <a class="code" href="classbdm_1_1RV.html" title="Class representing variables, most often random variables.">RV</a> <a class="code" href="classbdm_1_1Kalman.html#a44d4a8ab05d5311286e1da78b831633e" title="id of input">urv</a>; 
     135<a name="l00110"></a><a class="code" href="classbdm_1_1Kalman.html#abd69dfb802465f22dd84d73a180d5c92">00110</a>                 mat  <a class="code" href="classbdm_1_1Kalman.html#abd69dfb802465f22dd84d73a180d5c92" title="Kalman gain.">_K</a>; 
     136<a name="l00112"></a><a class="code" href="classbdm_1_1Kalman.html#ac83599f2541eb01de329f7b0bb35bf43">00112</a>                 <a class="code" href="classbdm_1_1shared__ptr.html" title="A naive implementation of roughly a subset of the std::tr1::shared_ptr spec.">shared_ptr&lt;enorm&lt;sq_T&gt;</a> &gt; <a class="code" href="classbdm_1_1Kalman.html#ac83599f2541eb01de329f7b0bb35bf43" title="posterior">est</a>; 
     137<a name="l00114"></a><a class="code" href="classbdm_1_1Kalman.html#aba555c394c429f6831c9bbabfa2c944c">00114</a>                 <a class="code" href="classbdm_1_1enorm.html" title="Gaussian density with positive definite (decomposed) covariance matrix.">enorm&lt;sq_T&gt;</a>  <a class="code" href="classbdm_1_1Kalman.html#aba555c394c429f6831c9bbabfa2c944c" title="marginal on data f(y|y)">fy</a>; 
     138<a name="l00115"></a>00115         <span class="keyword">public</span>: 
     139<a name="l00116"></a>00116                 <a class="code" href="classbdm_1_1Kalman.html" title="Common abstract base for Kalman filters.">Kalman</a>() : <a class="code" href="classbdm_1_1BM.html" title="Bayesian Model of a system, i.e. all uncertainty is modeled by probabilities.">BM</a>(), <a class="code" href="classbdm_1_1StateSpace.html" title="Basic elements of linear state-space model.">StateSpace</a>&lt;sq_T&gt;(), <a class="code" href="classbdm_1_1Kalman.html#aaac28e226fe6cbff5a9ae38d8d025d7a" title="id of output">yrv</a>(),<a class="code" href="classbdm_1_1Kalman.html#a44d4a8ab05d5311286e1da78b831633e" title="id of input">urv</a>(), <a class="code" href="classbdm_1_1Kalman.html#abd69dfb802465f22dd84d73a180d5c92" title="Kalman gain.">_K</a>(),  <a class="code" href="classbdm_1_1Kalman.html#ac83599f2541eb01de329f7b0bb35bf43" title="posterior">est</a>(new <a class="code" href="classbdm_1_1enorm.html" title="Gaussian density with positive definite (decomposed) covariance matrix.">enorm</a>&lt;sq_T&gt;){} 
     140<a name="l00117"></a>00117                 <span class="keywordtype">void</span> set_statistics (<span class="keyword">const</span> vec &amp;mu0, <span class="keyword">const</span> mat &amp;P0) {<a class="code" href="classbdm_1_1Kalman.html#ac83599f2541eb01de329f7b0bb35bf43" title="posterior">est</a>-&gt;set_parameters (mu0, P0); }; 
     141<a name="l00118"></a>00118                 <span class="keywordtype">void</span> set_statistics (<span class="keyword">const</span> vec &amp;mu0, <span class="keyword">const</span> sq_T &amp;P0) {<a class="code" href="classbdm_1_1Kalman.html#ac83599f2541eb01de329f7b0bb35bf43" title="posterior">est</a>-&gt;set_parameters (mu0, P0); }; 
     142<a name="l00120"></a><a class="code" href="classbdm_1_1Kalman.html#a8b0c3db41eb292edb20b826832c9b5fa">00120</a>                 <span class="keyword">const</span> <a class="code" href="classbdm_1_1enorm.html" title="Gaussian density with positive definite (decomposed) covariance matrix.">enorm&lt;sq_T&gt;</a>&amp; <a class="code" href="classbdm_1_1Kalman.html#a8b0c3db41eb292edb20b826832c9b5fa" title="posterior">posterior</a>()<span class="keyword"> const </span>{<span class="keywordflow">return</span> *<a class="code" href="classbdm_1_1Kalman.html#ac83599f2541eb01de329f7b0bb35bf43" title="posterior">est</a>.<a class="code" href="classbdm_1_1shared__ptr.html#a37ebcfb6750dd7b5630f1d2354c07a96">get</a>();} 
     143<a name="l00122"></a><a class="code" href="classbdm_1_1Kalman.html#a4da2fdd01e9b335b133def9814eb0620">00122</a>                 <a class="code" href="classbdm_1_1shared__ptr.html">shared_ptr&lt;epdf&gt;</a> <a class="code" href="classbdm_1_1Kalman.html#a4da2fdd01e9b335b133def9814eb0620" title="shared posterior">shared_posterior</a>() {<span class="keywordflow">return</span> <a class="code" href="classbdm_1_1Kalman.html#ac83599f2541eb01de329f7b0bb35bf43" title="posterior">est</a>;} 
     144<a name="l00124"></a><a class="code" href="classbdm_1_1Kalman.html#a7fe88fc3471cab1911707bcdb6b4690a">00124</a>                 <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1Kalman.html#a7fe88fc3471cab1911707bcdb6b4690a" title="load basic elements of Kalman from structure">from_setting</a> (<span class="keyword">const</span> Setting &amp;<span class="keyword">set</span>) { 
     145<a name="l00125"></a>00125                         <a class="code" href="classbdm_1_1Kalman.html#a7fe88fc3471cab1911707bcdb6b4690a" title="load basic elements of Kalman from structure">StateSpace&lt;sq_T&gt;::from_setting</a>(<span class="keyword">set</span>); 
     146<a name="l00126"></a>00126                                                  
     147<a name="l00127"></a>00127                         mat P0; vec mu0; 
     148<a name="l00128"></a>00128                         <a class="code" href="classbdm_1_1UI.html#acd1667e6fec99ec64dabcb3ca2ff922d">UI::get</a>(mu0, <span class="keyword">set</span>, <span class="stringliteral">&quot;mu0&quot;</span>, UI::optional); 
     149<a name="l00129"></a>00129                         <a class="code" href="classbdm_1_1UI.html#acd1667e6fec99ec64dabcb3ca2ff922d">UI::get</a>(P0, <span class="keyword">set</span>,  <span class="stringliteral">&quot;P0&quot;</span>, UI::optional); 
     150<a name="l00130"></a>00130                         set_statistics(mu0,P0); 
     151<a name="l00131"></a>00131                         <span class="comment">// Initial values</span> 
     152<a name="l00132"></a>00132                         <a class="code" href="classbdm_1_1UI.html#acd1667e6fec99ec64dabcb3ca2ff922d">UI::get</a> (<a class="code" href="classbdm_1_1Kalman.html#aaac28e226fe6cbff5a9ae38d8d025d7a" title="id of output">yrv</a>, <span class="keyword">set</span>, <span class="stringliteral">&quot;yrv&quot;</span>, UI::optional); 
     153<a name="l00133"></a>00133                         <a class="code" href="classbdm_1_1UI.html#acd1667e6fec99ec64dabcb3ca2ff922d">UI::get</a> (<a class="code" href="classbdm_1_1Kalman.html#a44d4a8ab05d5311286e1da78b831633e" title="id of input">urv</a>, <span class="keyword">set</span>, <span class="stringliteral">&quot;urv&quot;</span>, UI::optional); 
     154<a name="l00134"></a>00134                         set_drv(concat(<a class="code" href="classbdm_1_1Kalman.html#aaac28e226fe6cbff5a9ae38d8d025d7a" title="id of output">yrv</a>,<a class="code" href="classbdm_1_1Kalman.html#a44d4a8ab05d5311286e1da78b831633e" title="id of input">urv</a>)); 
     155<a name="l00135"></a>00135                          
     156<a name="l00136"></a>00136                         validate(); 
     157<a name="l00137"></a>00137                 } 
     158<a name="l00138"></a>00138                 <span class="keywordtype">void</span> validate() { 
     159<a name="l00139"></a>00139                         <a class="code" href="classbdm_1_1StateSpace.html" title="Basic elements of linear state-space model.">StateSpace&lt;sq_T&gt;::validate</a>(); 
     160<a name="l00140"></a>00140                         <a class="code" href="bdmerror_8h.html#a89a0f906b242b79c5d3d342291b2cab4" title="Throw std::runtime_exception if t is not true and NDEBUG is not defined.">bdm_assert_debug</a>(<a class="code" href="classbdm_1_1Kalman.html#ac83599f2541eb01de329f7b0bb35bf43" title="posterior">est</a>-&gt;dimension(), <span class="stringliteral">&quot;Statistics and model parameters mismatch&quot;</span>); 
     161<a name="l00141"></a>00141                 } 
     162<a name="l00142"></a>00142 }; 
     163<a name="l00147"></a><a class="code" href="classbdm_1_1KalmanFull.html">00147</a> <span class="keyword">class </span><a class="code" href="classbdm_1_1KalmanFull.html" title="Basic Kalman filter with full matrices.">KalmanFull</a> : <span class="keyword">public</span> <a class="code" href="classbdm_1_1Kalman.html" title="Common abstract base for Kalman filters.">Kalman</a>&lt;fsqmat&gt; 
     164<a name="l00148"></a>00148 { 
     165<a name="l00149"></a>00149         <span class="keyword">public</span>: 
     166<a name="l00151"></a><a class="code" href="classbdm_1_1KalmanFull.html#abdcc98c8b18c1cbdebdf218ae838fd11">00151</a>                 <a class="code" href="classbdm_1_1KalmanFull.html#abdcc98c8b18c1cbdebdf218ae838fd11" title="For EKFfull;.">KalmanFull</a>() :<a class="code" href="classbdm_1_1Kalman.html" title="Common abstract base for Kalman filters.">Kalman</a>&lt;<a class="code" href="classbdm_1_1fsqmat.html" title="Fake sqmat. This class maps sqmat operations to operations on full matrix.">fsqmat</a>&gt;(){}; 
     167<a name="l00153"></a>00153                 <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1KalmanFull.html#a081924bc97f453f674bb982b7951d053" title="Here dt = [yt;ut] of appropriate dimensions.">bayes</a> (<span class="keyword">const</span> vec &amp;dt); 
     168<a name="l00154"></a>00154 }; 
     169<a name="l00155"></a>00155 <a class="code" href="user__info_8h.html#a4f9de2f17e844047726487b99def99c6" title="Macro for registration of class into map of user-infos, registered class is scriptable...">UIREGISTER</a>(KalmanFull); 
     170<a name="l00156"></a>00156  
     171<a name="l00157"></a>00157  
     172<a name="l00165"></a><a class="code" href="classbdm_1_1KalmanCh.html">00165</a> <span class="keyword">class </span><a class="code" href="classbdm_1_1KalmanCh.html" title="Kalman filter in square root form.">KalmanCh</a> : <span class="keyword">public</span> <a class="code" href="classbdm_1_1Kalman.html" title="Common abstract base for Kalman filters.">Kalman</a>&lt;chmat&gt; 
     173<a name="l00166"></a>00166 { 
     174<a name="l00167"></a>00167         <span class="keyword">protected</span>: 
     175<a name="l00170"></a>00170                 mat preA; 
     176<a name="l00172"></a><a class="code" href="classbdm_1_1KalmanCh.html#abcbd68f51d4b57246e7784ca5900171f">00172</a>                 mat <a class="code" href="classbdm_1_1KalmanCh.html#abcbd68f51d4b57246e7784ca5900171f" title="post array (triangular matrix)">postA</a>; 
     177<a name="l00174"></a>00174         <span class="keyword">public</span>: 
     178<a name="l00176"></a><a class="code" href="classbdm_1_1KalmanCh.html#a24ce65bdaa538d4d5153d709a929b996">00176</a>                 <a class="code" href="classbdm_1_1BM.html" title="Bayesian Model of a system, i.e. all uncertainty is modeled by probabilities.">BM</a>* <a class="code" href="classbdm_1_1KalmanCh.html#a24ce65bdaa538d4d5153d709a929b996" title="copy constructor">_copy_</a>()<span class="keyword"> const </span>{ 
     179<a name="l00177"></a>00177                         <a class="code" href="classbdm_1_1KalmanCh.html" title="Kalman filter in square root form.">KalmanCh</a>* K = <span class="keyword">new</span> <a class="code" href="classbdm_1_1KalmanCh.html" title="Kalman filter in square root form.">KalmanCh</a>; 
     180<a name="l00178"></a>00178                         K-&gt;<a class="code" href="classbdm_1_1KalmanCh.html#a20a4d4c664e8ac8a3f1bb7b0d11c6d87" title="set parameters for adapt from Kalman">set_parameters</a> (<a class="code" href="classbdm_1_1StateSpace.html#ade7d828a8d06cbbd5ac45afeaf9f0c7b" title="Matrix A.">A</a>, <a class="code" href="classbdm_1_1StateSpace.html#a0cdaa906550290b759a1584d02b3ca51" title="Matrix B.">B</a>, <a class="code" href="classbdm_1_1StateSpace.html#ac7ec82d2200c956cff6dff559bd32ff9" title="Matrix C.">C</a>, <a class="code" href="classbdm_1_1StateSpace.html#ad5769a41b34eb518716120cf04dbc23f" title="Matrix D.">D</a>, <a class="code" href="classbdm_1_1StateSpace.html#a66248c83836424f1cd7c1b5b9a92cf1f" title="Matrix Q in square-root form.">Q</a>, <a class="code" href="classbdm_1_1StateSpace.html#a11dd3493d62ec9329860386adb3e6084" title="Matrix R in square-root form.">R</a>); 
     181<a name="l00179"></a>00179                         K-&gt;set_statistics (<a class="code" href="classbdm_1_1Kalman.html#ac83599f2541eb01de329f7b0bb35bf43" title="posterior">est</a>-&gt;_mu(), <a class="code" href="classbdm_1_1Kalman.html#ac83599f2541eb01de329f7b0bb35bf43" title="posterior">est</a>-&gt;_R()); 
     182<a name="l00180"></a>00180                         <span class="keywordflow">return</span> K; 
     183<a name="l00181"></a>00181                 } 
     184<a name="l00183"></a>00183                 <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1KalmanCh.html#a20a4d4c664e8ac8a3f1bb7b0d11c6d87" title="set parameters for adapt from Kalman">set_parameters</a> (<span class="keyword">const</span> mat &amp;A0, <span class="keyword">const</span> mat &amp;B0, <span class="keyword">const</span> mat &amp;C0, <span class="keyword">const</span> mat &amp;D0, <span class="keyword">const</span> <a class="code" href="classbdm_1_1chmat.html" title="Symmetric matrix stored in square root decomposition using upper cholesky.">chmat</a> &amp;Q0, <span class="keyword">const</span> <a class="code" href="classbdm_1_1chmat.html" title="Symmetric matrix stored in square root decomposition using upper cholesky.">chmat</a> &amp;R0); 
     185<a name="l00185"></a>00185                 <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1KalmanCh.html#ac983b1a2687312ab733d4c859cf83c1e" title="initialize internal parametetrs">initialize</a>(); 
     186<a name="l00186"></a>00186  
     187<a name="l00200"></a>00200                 <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1KalmanCh.html#ab41fe5540548100b08e1684c3be767b6" title="Here dt = [yt;ut] of appropriate dimensions.">bayes</a> (<span class="keyword">const</span> vec &amp;dt); 
     188<a name="l00201"></a>00201                  
     189<a name="l00202"></a><a class="code" href="classbdm_1_1KalmanCh.html#a13f68cef5b14c8753012ad3ed695689d">00202</a>                 <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1KalmanCh.html#a13f68cef5b14c8753012ad3ed695689d" title="load basic elements of Kalman from structure">from_setting</a>(<span class="keyword">const</span> Setting &amp;<span class="keyword">set</span>){ 
     190<a name="l00203"></a>00203                         <a class="code" href="classbdm_1_1KalmanCh.html#a13f68cef5b14c8753012ad3ed695689d" title="load basic elements of Kalman from structure">Kalman&lt;chmat&gt;::from_setting</a>(<span class="keyword">set</span>); 
     191<a name="l00204"></a>00204                         <a class="code" href="classbdm_1_1KalmanCh.html#ac983b1a2687312ab733d4c859cf83c1e" title="initialize internal parametetrs">initialize</a>(); 
     192<a name="l00205"></a>00205                 } 
     193<a name="l00206"></a>00206 }; 
     194<a name="l00207"></a>00207 <a class="code" href="user__info_8h.html#a4f9de2f17e844047726487b99def99c6" title="Macro for registration of class into map of user-infos, registered class is scriptable...">UIREGISTER</a>(KalmanCh); 
     195<a name="l00208"></a>00208  
     196<a name="l00214"></a><a class="code" href="classbdm_1_1EKFfull.html">00214</a> <span class="keyword">class </span><a class="code" href="classbdm_1_1EKFfull.html" title="Extended Kalman Filter in full matrices.">EKFfull</a> : <span class="keyword">public</span> <a class="code" href="classbdm_1_1KalmanFull.html" title="Basic Kalman filter with full matrices.">KalmanFull</a> 
     197<a name="l00215"></a>00215 { 
     198<a name="l00216"></a>00216         <span class="keyword">protected</span>: 
     199<a name="l00218"></a><a class="code" href="classbdm_1_1EKFfull.html#aee5bfb3f09dfa994596c5bc68306f7d6">00218</a>                 <a class="code" href="classbdm_1_1shared__ptr.html">shared_ptr&lt;diffbifn&gt;</a> <a class="code" href="classbdm_1_1EKFfull.html#aee5bfb3f09dfa994596c5bc68306f7d6" title="Internal Model f(x,u).">pfxu</a>; 
     200<a name="l00219"></a>00219  
     201<a name="l00221"></a><a class="code" href="classbdm_1_1EKFfull.html#a6432c675b1a9b83898b4ff19eab9b45c">00221</a>                 <a class="code" href="classbdm_1_1shared__ptr.html">shared_ptr&lt;diffbifn&gt;</a> <a class="code" href="classbdm_1_1EKFfull.html#a6432c675b1a9b83898b4ff19eab9b45c" title="Observation Model h(x,u).">phxu</a>; 
     202<a name="l00222"></a>00222  
     203<a name="l00223"></a>00223         <span class="keyword">public</span>: 
     204<a name="l00225"></a>00225                 <a class="code" href="classbdm_1_1EKFfull.html#a6939c345389abb8b2481457b4cfe1165" title="Default constructor.">EKFfull</a> (); 
     205<a name="l00226"></a>00226  
     206<a name="l00228"></a>00228                 <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1EKFfull.html#a8a68f95124a4b01f9ce23225f3c736a4" title="Set nonlinear functions for mean values and covariance matrices.">set_parameters</a> (<span class="keyword">const</span> <a class="code" href="classbdm_1_1shared__ptr.html">shared_ptr&lt;diffbifn&gt;</a> &amp;<a class="code" href="classbdm_1_1EKFfull.html#aee5bfb3f09dfa994596c5bc68306f7d6" title="Internal Model f(x,u).">pfxu</a>, <span class="keyword">const</span> <a class="code" href="classbdm_1_1shared__ptr.html">shared_ptr&lt;diffbifn&gt;</a> &amp;<a class="code" href="classbdm_1_1EKFfull.html#a6432c675b1a9b83898b4ff19eab9b45c" title="Observation Model h(x,u).">phxu</a>, <span class="keyword">const</span> mat Q0, <span class="keyword">const</span> mat R0); 
     207<a name="l00229"></a>00229  
     208<a name="l00231"></a>00231                 <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1EKFfull.html#af149ae8e9ce14d9931a7bb2850736699" title="Here dt = [yt;ut] of appropriate dimensions.">bayes</a> (<span class="keyword">const</span> vec &amp;dt); 
     209<a name="l00233"></a><a class="code" href="classbdm_1_1EKFfull.html#a44986d667c19bcf7708495a4a5afc841">00233</a>                 <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1EKFfull.html#a44986d667c19bcf7708495a4a5afc841" title="set estimates">set_statistics</a> (<span class="keyword">const</span> vec &amp;mu0, <span class="keyword">const</span> mat &amp;P0) { 
     210<a name="l00234"></a>00234                         <a class="code" href="classbdm_1_1Kalman.html#ac83599f2541eb01de329f7b0bb35bf43" title="posterior">est</a>-&gt;set_parameters (mu0, P0); 
     211<a name="l00235"></a>00235                 }; 
     212<a name="l00236"></a><a class="code" href="classbdm_1_1EKFfull.html#ad4f57cb8af64b06c530f528c32596d4d">00236</a>                 <span class="keyword">const</span> mat <a class="code" href="classbdm_1_1EKFfull.html#ad4f57cb8af64b06c530f528c32596d4d" title="access function">_R</a>() { 
     213<a name="l00237"></a>00237                         <span class="keywordflow">return</span> <a class="code" href="classbdm_1_1Kalman.html#ac83599f2541eb01de329f7b0bb35bf43" title="posterior">est</a>-&gt;_R().to_mat(); 
     214<a name="l00238"></a>00238                 } 
     215<a name="l00239"></a>00239 }; 
     216<a name="l00240"></a>00240 <a class="code" href="user__info_8h.html#a4f9de2f17e844047726487b99def99c6" title="Macro for registration of class into map of user-infos, registered class is scriptable...">UIREGISTER</a>(EKFfull); 
     217<a name="l00241"></a>00241  
     218<a name="l00242"></a>00242  
     219<a name="l00249"></a><a class="code" href="classbdm_1_1EKFCh.html">00249</a> <span class="keyword">class </span><a class="code" href="classbdm_1_1EKFCh.html" title="Extended Kalman Filter in Square root.">EKFCh</a> : <span class="keyword">public</span> <a class="code" href="classbdm_1_1KalmanCh.html" title="Kalman filter in square root form.">KalmanCh</a> 
     220<a name="l00250"></a>00250 { 
     221<a name="l00251"></a>00251         <span class="keyword">protected</span>: 
     222<a name="l00253"></a><a class="code" href="classbdm_1_1EKFCh.html#a5dc1964a6058057c9e17ea3c2f33bd2a">00253</a>                 <a class="code" href="classbdm_1_1shared__ptr.html">shared_ptr&lt;diffbifn&gt;</a> <a class="code" href="classbdm_1_1EKFCh.html#a5dc1964a6058057c9e17ea3c2f33bd2a" title="Internal Model f(x,u).">pfxu</a>; 
     223<a name="l00254"></a>00254  
     224<a name="l00256"></a><a class="code" href="classbdm_1_1EKFCh.html#a27c29351b2cc8248c011af506208e8d1">00256</a>                 <a class="code" href="classbdm_1_1shared__ptr.html">shared_ptr&lt;diffbifn&gt;</a> <a class="code" href="classbdm_1_1EKFCh.html#a27c29351b2cc8248c011af506208e8d1" title="Observation Model h(x,u).">phxu</a>; 
     225<a name="l00257"></a>00257         <span class="keyword">public</span>: 
     226<a name="l00259"></a><a class="code" href="classbdm_1_1EKFCh.html#a1d1d91400e3f177de9fe7962ea17adc4">00259</a>                 <a class="code" href="classbdm_1_1BM.html" title="Bayesian Model of a system, i.e. all uncertainty is modeled by probabilities.">BM</a>* <a class="code" href="classbdm_1_1EKFCh.html#a1d1d91400e3f177de9fe7962ea17adc4" title="copy constructor duplicated - calls different set_parameters">_copy_</a>()<span class="keyword"> const </span>{ 
     227<a name="l00260"></a>00260                         <a class="code" href="classbdm_1_1EKFCh.html" title="Extended Kalman Filter in Square root.">EKFCh</a>* E = <span class="keyword">new</span> <a class="code" href="classbdm_1_1EKFCh.html" title="Extended Kalman Filter in Square root.">EKFCh</a>; 
     228<a name="l00261"></a>00261                         E-&gt;<a class="code" href="classbdm_1_1EKFCh.html#acd1697a0b3ac2e17c0c56a90a4dbfad1" title="Set nonlinear functions for mean values and covariance matrices.">set_parameters</a> (<a class="code" href="classbdm_1_1EKFCh.html#a5dc1964a6058057c9e17ea3c2f33bd2a" title="Internal Model f(x,u).">pfxu</a>, <a class="code" href="classbdm_1_1EKFCh.html#a27c29351b2cc8248c011af506208e8d1" title="Observation Model h(x,u).">phxu</a>, <a class="code" href="classbdm_1_1StateSpace.html#a66248c83836424f1cd7c1b5b9a92cf1f" title="Matrix Q in square-root form.">Q</a>, <a class="code" href="classbdm_1_1StateSpace.html#a11dd3493d62ec9329860386adb3e6084" title="Matrix R in square-root form.">R</a>); 
     229<a name="l00262"></a>00262                         E-&gt;set_statistics (<a class="code" href="classbdm_1_1Kalman.html#ac83599f2541eb01de329f7b0bb35bf43" title="posterior">est</a>-&gt;_mu(), <a class="code" href="classbdm_1_1Kalman.html#ac83599f2541eb01de329f7b0bb35bf43" title="posterior">est</a>-&gt;_R()); 
     230<a name="l00263"></a>00263                         <span class="keywordflow">return</span> E; 
     231<a name="l00264"></a>00264                 } 
     232<a name="l00266"></a>00266                 <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1EKFCh.html#acd1697a0b3ac2e17c0c56a90a4dbfad1" title="Set nonlinear functions for mean values and covariance matrices.">set_parameters</a> (<span class="keyword">const</span> <a class="code" href="classbdm_1_1shared__ptr.html">shared_ptr&lt;diffbifn&gt;</a> &amp;<a class="code" href="classbdm_1_1EKFCh.html#a5dc1964a6058057c9e17ea3c2f33bd2a" title="Internal Model f(x,u).">pfxu</a>, <span class="keyword">const</span> <a class="code" href="classbdm_1_1shared__ptr.html">shared_ptr&lt;diffbifn&gt;</a> &amp;<a class="code" href="classbdm_1_1EKFCh.html#a27c29351b2cc8248c011af506208e8d1" title="Observation Model h(x,u).">phxu</a>, <span class="keyword">const</span> <a class="code" href="classbdm_1_1chmat.html" title="Symmetric matrix stored in square root decomposition using upper cholesky.">chmat</a> Q0, <span class="keyword">const</span> <a class="code" href="classbdm_1_1chmat.html" title="Symmetric matrix stored in square root decomposition using upper cholesky.">chmat</a> R0); 
    219233<a name="l00267"></a>00267  
    220 <a name="l00268"></a>00268         <a class="code" href="user__info_8h.html#4f9de2f17e844047726487b99def99c6" title="Macro for registration of class into map of user-infos, registered class is scriptable...">UIREGISTER</a>(EKFCh); 
    221 <a name="l00269"></a>00269  
     234<a name="l00269"></a>00269                 <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1EKFCh.html#a4c8609c37290b158f88a31dae4047225" title="Here dt = [yt;ut] of appropriate dimensions.">bayes</a> (<span class="keyword">const</span> vec &amp;dt); 
    222235<a name="l00270"></a>00270  
    223 <a name="l00275"></a><a class="code" href="classbdm_1_1KFcondQR.html">00275</a>         <span class="keyword">class </span><a class="code" href="classbdm_1_1KFcondQR.html" title="Kalman Filter with conditional diagonal matrices R and Q.">KFcondQR</a> : <span class="keyword">public</span> <a class="code" href="classbdm_1_1Kalman.html" title="Kalman filter with covariance matrices in square root form.">Kalman</a>&lt;ldmat&gt; 
    224 <a name="l00276"></a>00276         { 
    225 <a name="l00277"></a>00277 <span class="comment">//protected:</span> 
    226 <a name="l00278"></a>00278                 <span class="keyword">public</span>: 
    227 <a name="l00279"></a><a class="code" href="classbdm_1_1KFcondQR.html#31bc31087ee7ed6c0bfb92d626321b91">00279</a>                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1KFcondQR.html#31bc31087ee7ed6c0bfb92d626321b91" title="Substitute val for rvc.">condition</a> ( <span class="keyword">const</span> vec &amp;QR ) 
    228 <a name="l00280"></a>00280                         { 
    229 <a name="l00281"></a>00281                                 it_assert_debug ( QR.length() == ( <a class="code" href="classbdm_1_1Kalman.html#ba7699cdb3b1382a54d3e28b9b7517fa" title="cache of rv.count()">dimx</a>+<a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a> ),<span class="stringliteral">"KFcondRQ: conditioning by incompatible vector"</span> ); 
     236<a name="l00271"></a>00271                 <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1EKFCh.html#a3952e181ef0cf230c325ad3be1f002df" title="load basic elements of Kalman from structure">from_setting</a> (<span class="keyword">const</span> Setting &amp;<span class="keyword">set</span>); 
     237<a name="l00272"></a>00272  
     238<a name="l00273"></a>00273                 <span class="comment">// TODO dodelat void to_setting( Setting &amp;set ) const;</span> 
     239<a name="l00274"></a>00274  
     240<a name="l00275"></a>00275 }; 
     241<a name="l00276"></a>00276  
     242<a name="l00277"></a>00277 <a class="code" href="user__info_8h.html#a4f9de2f17e844047726487b99def99c6" title="Macro for registration of class into map of user-infos, registered class is scriptable...">UIREGISTER</a> (EKFCh); 
     243<a name="l00278"></a>00278 SHAREDPTR (EKFCh); 
     244<a name="l00279"></a>00279  
     245<a name="l00280"></a>00280  
    230246<a name="l00282"></a>00282  
    231 <a name="l00283"></a>00283                                 <a class="code" href="classbdm_1_1Kalman.html#70f8bf19e81b532c60fd3a7a152425ee" title="Matrix Q in square-root form.">Q</a>.<a class="code" href="classldmat.html#0884a613b94fde61bfc84288e73ce57f" title="Access functions.">setD</a> ( QR ( 0, <a class="code" href="classbdm_1_1Kalman.html#ba7699cdb3b1382a54d3e28b9b7517fa" title="cache of rv.count()">dimx</a>-1 ) ); 
    232 <a name="l00284"></a>00284                                 <a class="code" href="classbdm_1_1Kalman.html#475b088287cdfbba4dc60a3d027728b7" title="Matrix R in square-root form.">R</a>.<a class="code" href="classldmat.html#0884a613b94fde61bfc84288e73ce57f" title="Access functions.">setD</a> ( QR ( <a class="code" href="classbdm_1_1Kalman.html#ba7699cdb3b1382a54d3e28b9b7517fa" title="cache of rv.count()">dimx</a>, -1 ) ); 
    233 <a name="l00285"></a>00285                         }; 
    234 <a name="l00286"></a>00286         }; 
    235 <a name="l00287"></a>00287  
    236 <a name="l00292"></a><a class="code" href="classbdm_1_1KFcondR.html">00292</a>         <span class="keyword">class </span><a class="code" href="classbdm_1_1KFcondR.html" title="Kalman Filter with conditional diagonal matrices R and Q.">KFcondR</a> : <span class="keyword">public</span> <a class="code" href="classbdm_1_1Kalman.html" title="Kalman filter with covariance matrices in square root form.">Kalman</a>&lt;ldmat&gt; 
    237 <a name="l00293"></a>00293         { 
    238 <a name="l00294"></a>00294 <span class="comment">//protected:</span> 
    239 <a name="l00295"></a>00295                 <span class="keyword">public</span>: 
    240 <a name="l00297"></a><a class="code" href="classbdm_1_1KFcondR.html#f11639d79f10b1e7dad16a0d8233450d">00297</a>                         <a class="code" href="classbdm_1_1KFcondR.html#f11639d79f10b1e7dad16a0d8233450d" title="Default constructor.">KFcondR</a> ( ) : <a class="code" href="classbdm_1_1Kalman.html" title="Kalman filter with covariance matrices in square root form.">Kalman</a>&lt;<a class="code" href="classldmat.html" title="Matrix stored in LD form, (commonly known as UD).">ldmat</a>&gt; ( ) {}; 
    241 <a name="l00298"></a>00298  
    242 <a name="l00299"></a><a class="code" href="classbdm_1_1KFcondR.html#7d42a421acbdcf9b610a5682ee5fb9a8">00299</a>                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1KFcondR.html#7d42a421acbdcf9b610a5682ee5fb9a8" title="Substitute val for rvc.">condition</a> ( <span class="keyword">const</span> vec &amp;R0 ) 
    243 <a name="l00300"></a>00300                         { 
    244 <a name="l00301"></a>00301                                 it_assert_debug ( R0.length() == ( <a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a> ),<span class="stringliteral">"KFcondR: conditioning by incompatible vector"</span> ); 
    245 <a name="l00302"></a>00302  
    246 <a name="l00303"></a>00303                                 <a class="code" href="classbdm_1_1Kalman.html#475b088287cdfbba4dc60a3d027728b7" title="Matrix R in square-root form.">R</a>.<a class="code" href="classldmat.html#0884a613b94fde61bfc84288e73ce57f" title="Access functions.">setD</a> ( R0 ); 
    247 <a name="l00304"></a>00304                         }; 
    248 <a name="l00305"></a>00305  
    249 <a name="l00306"></a>00306         }; 
    250 <a name="l00307"></a>00307  
     247<a name="l00290"></a><a class="code" href="classbdm_1_1MultiModel.html">00290</a> <span class="keyword">class </span><a class="code" href="classbdm_1_1MultiModel.html" title="(Switching) Multiple Model The model runs several models in parallel and evaluates...">MultiModel</a>: <span class="keyword">public</span> <a class="code" href="classbdm_1_1BM.html" title="Bayesian Model of a system, i.e. all uncertainty is modeled by probabilities.">BM</a> 
     248<a name="l00291"></a>00291 { 
     249<a name="l00292"></a>00292         <span class="keyword">protected</span>: 
     250<a name="l00294"></a><a class="code" href="classbdm_1_1MultiModel.html#a33de5d07ee774070632de8963b5d4c93">00294</a>                 Array&lt;EKFCh*&gt; <a class="code" href="classbdm_1_1MultiModel.html#a33de5d07ee774070632de8963b5d4c93" title="List of models between which we switch.">Models</a>; 
     251<a name="l00296"></a><a class="code" href="classbdm_1_1MultiModel.html#aef85ea61575bffa8beac8040869ee47a">00296</a>                 vec <a class="code" href="classbdm_1_1MultiModel.html#aef85ea61575bffa8beac8040869ee47a" title="vector of model weights">w</a>; 
     252<a name="l00298"></a><a class="code" href="classbdm_1_1MultiModel.html#a7b4012fc2208ce4ddd5c0d1fe69d7634">00298</a>                 vec <a class="code" href="classbdm_1_1MultiModel.html#a7b4012fc2208ce4ddd5c0d1fe69d7634" title="cache of model lls">_lls</a>; 
     253<a name="l00300"></a><a class="code" href="classbdm_1_1MultiModel.html#a9b56bcde4664bd53f8995d7ee7ed415c">00300</a>                 <span class="keywordtype">int</span> <a class="code" href="classbdm_1_1MultiModel.html#a9b56bcde4664bd53f8995d7ee7ed415c" title="type of switching policy [1=maximum,2=...]">policy</a>; 
     254<a name="l00302"></a><a class="code" href="classbdm_1_1MultiModel.html#ad665551d045b1a1055eeb9185558ff0b">00302</a>                 <a class="code" href="classbdm_1_1enorm.html">enorm&lt;chmat&gt;</a> <a class="code" href="classbdm_1_1MultiModel.html#ad665551d045b1a1055eeb9185558ff0b" title="internal statistics">est</a>; 
     255<a name="l00303"></a>00303         <span class="keyword">public</span>: 
     256<a name="l00304"></a>00304                 <span class="keywordtype">void</span> set_parameters (Array&lt;EKFCh*&gt; A, <span class="keywordtype">int</span> pol0 = 1) { 
     257<a name="l00305"></a>00305                         <a class="code" href="classbdm_1_1MultiModel.html#a33de5d07ee774070632de8963b5d4c93" title="List of models between which we switch.">Models</a> = A;<span class="comment">//TODO: test if evalll is set</span> 
     258<a name="l00306"></a>00306                         <a class="code" href="classbdm_1_1MultiModel.html#aef85ea61575bffa8beac8040869ee47a" title="vector of model weights">w</a>.set_length (A.length()); 
     259<a name="l00307"></a>00307                         <a class="code" href="classbdm_1_1MultiModel.html#a7b4012fc2208ce4ddd5c0d1fe69d7634" title="cache of model lls">_lls</a>.set_length (A.length()); 
     260<a name="l00308"></a>00308                         <a class="code" href="classbdm_1_1MultiModel.html#a9b56bcde4664bd53f8995d7ee7ed415c" title="type of switching policy [1=maximum,2=...]">policy</a> = pol0; 
    251261<a name="l00309"></a>00309  
    252 <a name="l00310"></a>00310         <span class="keyword">template</span>&lt;<span class="keyword">class</span> sq_T&gt; 
    253 <a name="l00311"></a><a class="code" href="classbdm_1_1Kalman.html#8b22c45cffa949d70b8e5ac92ed5ce25">00311</a>         <a class="code" href="classbdm_1_1Kalman.html#025a0196cbcc2e6adb13311f9d3d52b4" title="Default constructor.">Kalman&lt;sq_T&gt;::Kalman</a> ( <span class="keyword">const</span> <a class="code" href="classbdm_1_1Kalman.html" title="Kalman filter with covariance matrices in square root form.">Kalman&lt;sq_T&gt;</a> &amp;K0 ) : <a class="code" href="classbdm_1_1BM.html" title="Bayesian Model of a system, i.e. all uncertainty is modeled by probabilities.">BM</a> ( ),rvy ( K0.rvy ),rvu ( K0.rvu ), 
    254 <a name="l00312"></a>00312                         dimx ( K0.dimx ), dimy ( K0.dimy ),dimu ( K0.dimu ), 
    255 <a name="l00313"></a>00313                         A ( K0.A ), B ( K0.B ), C ( K0.C ), D ( K0.D ), 
    256 <a name="l00314"></a>00314                         Q ( K0.Q ), R ( K0.R ), 
    257 <a name="l00315"></a>00315                         est ( K0.est ), fy ( K0.fy ), _yp ( fy._mu() ),_Ry ( fy._R() ), _mu ( est._mu() ), _P ( est._R() ) 
    258 <a name="l00316"></a>00316         { 
    259 <a name="l00317"></a>00317  
    260 <a name="l00318"></a>00318 <span class="comment">// copy values in pointers</span> 
    261 <a name="l00319"></a>00319 <span class="comment">//      _mu = K0._mu;</span> 
    262 <a name="l00320"></a>00320 <span class="comment">//      _P = K0._P;</span> 
    263 <a name="l00321"></a>00321 <span class="comment">//      _yp = K0._yp;</span> 
    264 <a name="l00322"></a>00322 <span class="comment">//      _Ry = K0._Ry;</span> 
    265 <a name="l00323"></a>00323  
    266 <a name="l00324"></a>00324         } 
    267 <a name="l00325"></a>00325  
    268 <a name="l00326"></a>00326         <span class="keyword">template</span>&lt;<span class="keyword">class</span> sq_T&gt; 
    269 <a name="l00327"></a><a class="code" href="classbdm_1_1Kalman.html#025a0196cbcc2e6adb13311f9d3d52b4">00327</a>         <a class="code" href="classbdm_1_1Kalman.html#025a0196cbcc2e6adb13311f9d3d52b4" title="Default constructor.">Kalman&lt;sq_T&gt;::Kalman</a> ( ) : <a class="code" href="classbdm_1_1BM.html" title="Bayesian Model of a system, i.e. all uncertainty is modeled by probabilities.">BM</a> (), est ( ), fy (),  _yp ( fy._mu() ), _Ry ( fy._R() ), _mu ( est._mu() ), _P ( est._R() ) 
    270 <a name="l00328"></a>00328         { 
    271 <a name="l00329"></a>00329         }; 
    272 <a name="l00330"></a>00330  
    273 <a name="l00331"></a>00331         <span class="keyword">template</span>&lt;<span class="keyword">class</span> sq_T&gt; 
    274 <a name="l00332"></a><a class="code" href="classbdm_1_1Kalman.html#3c7fb87fb6b87d08deb6a5a7862da957">00332</a>         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1Kalman.html#3c7fb87fb6b87d08deb6a5a7862da957" title="Set parameters with check of relevance.">Kalman&lt;sq_T&gt;::set_parameters</a> ( <span class="keyword">const</span> mat &amp;A0,<span class="keyword">const</span>  mat &amp;B0, <span class="keyword">const</span> mat &amp;C0, <span class="keyword">const</span> mat &amp;D0, <span class="keyword">const</span> sq_T &amp;Q0, <span class="keyword">const</span> sq_T &amp;R0 ) 
    275 <a name="l00333"></a>00333         { 
    276 <a name="l00334"></a>00334                 <a class="code" href="classbdm_1_1Kalman.html#ba7699cdb3b1382a54d3e28b9b7517fa" title="cache of rv.count()">dimx</a> = A0.rows(); 
    277 <a name="l00335"></a>00335                 <a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a> = C0.rows(); 
    278 <a name="l00336"></a>00336                 <a class="code" href="classbdm_1_1Kalman.html#c5136ef617f6ac0e426bea222755d92b" title="cache of rvu.count()">dimu</a> = B0.cols(); 
    279 <a name="l00337"></a>00337  
    280 <a name="l00338"></a>00338                 it_assert_debug ( A0.cols() ==<a class="code" href="classbdm_1_1Kalman.html#ba7699cdb3b1382a54d3e28b9b7517fa" title="cache of rv.count()">dimx</a>, <span class="stringliteral">"Kalman: A is not square"</span> ); 
    281 <a name="l00339"></a>00339                 it_assert_debug ( B0.rows() ==<a class="code" href="classbdm_1_1Kalman.html#ba7699cdb3b1382a54d3e28b9b7517fa" title="cache of rv.count()">dimx</a>, <span class="stringliteral">"Kalman: B is not compatible"</span> ); 
    282 <a name="l00340"></a>00340                 it_assert_debug ( C0.cols() ==<a class="code" href="classbdm_1_1Kalman.html#ba7699cdb3b1382a54d3e28b9b7517fa" title="cache of rv.count()">dimx</a>, <span class="stringliteral">"Kalman: C is not square"</span> ); 
    283 <a name="l00341"></a>00341                 it_assert_debug ( ( D0.rows() ==<a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a> ) || ( D0.cols() ==<a class="code" href="classbdm_1_1Kalman.html#c5136ef617f6ac0e426bea222755d92b" title="cache of rvu.count()">dimu</a> ), <span class="stringliteral">"Kalman: D is not compatible"</span> ); 
    284 <a name="l00342"></a>00342                 it_assert_debug ( ( R0.cols() ==<a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a> ) || ( R0.rows() ==<a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a> ), <span class="stringliteral">"Kalman: R is not compatible"</span> ); 
    285 <a name="l00343"></a>00343                 it_assert_debug ( ( Q0.cols() ==<a class="code" href="classbdm_1_1Kalman.html#ba7699cdb3b1382a54d3e28b9b7517fa" title="cache of rv.count()">dimx</a> ) || ( Q0.rows() ==<a class="code" href="classbdm_1_1Kalman.html#ba7699cdb3b1382a54d3e28b9b7517fa" title="cache of rv.count()">dimx</a> ), <span class="stringliteral">"Kalman: Q is not compatible"</span> ); 
    286 <a name="l00344"></a>00344  
    287 <a name="l00345"></a>00345                 <a class="code" href="classbdm_1_1Kalman.html#0a2072e2090c10fac74ad30a023a4ace" title="Matrix A.">A</a> = A0; 
    288 <a name="l00346"></a>00346                 <a class="code" href="classbdm_1_1Kalman.html#5977b2c81857948a35105f0e7840203c" title="Matrix B.">B</a> = B0; 
    289 <a name="l00347"></a>00347                 <a class="code" href="classbdm_1_1Kalman.html#818eba63a23972786a4579ad30294177" title="Matrix C.">C</a> = C0; 
    290 <a name="l00348"></a>00348                 <a class="code" href="classbdm_1_1Kalman.html#7b56ac423d0654b5755e4f852a870456" title="Matrix D.">D</a> = D0; 
    291 <a name="l00349"></a>00349                 <a class="code" href="classbdm_1_1Kalman.html#475b088287cdfbba4dc60a3d027728b7" title="Matrix R in square-root form.">R</a> = R0; 
    292 <a name="l00350"></a>00350                 <a class="code" href="classbdm_1_1Kalman.html#70f8bf19e81b532c60fd3a7a152425ee" title="Matrix Q in square-root form.">Q</a> = Q0; 
    293 <a name="l00351"></a>00351         } 
     262<a name="l00310"></a>00310                         <a class="code" href="classbdm_1_1MultiModel.html#ad665551d045b1a1055eeb9185558ff0b" title="internal statistics">est</a>.<a class="code" href="classbdm_1_1epdf.html#af423e28448dbb69ef4905295ec8de8ff" title="Name its rv.">set_rv</a> (<a class="code" href="classbdm_1_1RV.html" title="Class representing variables, most often random variables.">RV</a> (<span class="stringliteral">&quot;MM&quot;</span>, A (0)-&gt;<a class="code" href="classbdm_1_1MultiModel.html#a2af3f8dc10dfdae0ddc8160a9f36aaee" title="posterior density">posterior</a>().dimension(), 0)); 
     263<a name="l00311"></a>00311                         <a class="code" href="classbdm_1_1MultiModel.html#ad665551d045b1a1055eeb9185558ff0b" title="internal statistics">est</a>.set_parameters (A (0)-&gt;<a class="code" href="classbdm_1_1MultiModel.html#a2af3f8dc10dfdae0ddc8160a9f36aaee" title="posterior density">posterior</a>().mean(), A (0)-&gt;<a class="code" href="classbdm_1_1MultiModel.html#a2af3f8dc10dfdae0ddc8160a9f36aaee" title="posterior density">posterior</a>()._R()); 
     264<a name="l00312"></a>00312                 } 
     265<a name="l00313"></a><a class="code" href="classbdm_1_1MultiModel.html#aa915deeddb0e94c337d02ebc0abe535e">00313</a>                 <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1MultiModel.html#aa915deeddb0e94c337d02ebc0abe535e" title="Incremental Bayes rule.">bayes</a> (<span class="keyword">const</span> vec &amp;dt) { 
     266<a name="l00314"></a>00314                         <span class="keywordtype">int</span> n = <a class="code" href="classbdm_1_1MultiModel.html#a33de5d07ee774070632de8963b5d4c93" title="List of models between which we switch.">Models</a>.length(); 
     267<a name="l00315"></a>00315                         <span class="keywordtype">int</span> i; 
     268<a name="l00316"></a>00316                         <span class="keywordflow">for</span> (i = 0; i &lt; n; i++) { 
     269<a name="l00317"></a>00317                                 <a class="code" href="classbdm_1_1MultiModel.html#a33de5d07ee774070632de8963b5d4c93" title="List of models between which we switch.">Models</a> (i)-&gt;bayes (dt); 
     270<a name="l00318"></a>00318                                 <a class="code" href="classbdm_1_1MultiModel.html#a7b4012fc2208ce4ddd5c0d1fe69d7634" title="cache of model lls">_lls</a> (i) = <a class="code" href="classbdm_1_1MultiModel.html#a33de5d07ee774070632de8963b5d4c93" title="List of models between which we switch.">Models</a> (i)-&gt;_ll(); 
     271<a name="l00319"></a>00319                         } 
     272<a name="l00320"></a>00320                         <span class="keywordtype">double</span> mlls = max (<a class="code" href="classbdm_1_1MultiModel.html#a7b4012fc2208ce4ddd5c0d1fe69d7634" title="cache of model lls">_lls</a>); 
     273<a name="l00321"></a>00321                         <a class="code" href="classbdm_1_1MultiModel.html#aef85ea61575bffa8beac8040869ee47a" title="vector of model weights">w</a> = exp (<a class="code" href="classbdm_1_1MultiModel.html#a7b4012fc2208ce4ddd5c0d1fe69d7634" title="cache of model lls">_lls</a> - mlls); 
     274<a name="l00322"></a>00322                         <a class="code" href="classbdm_1_1MultiModel.html#aef85ea61575bffa8beac8040869ee47a" title="vector of model weights">w</a> /= sum (<a class="code" href="classbdm_1_1MultiModel.html#aef85ea61575bffa8beac8040869ee47a" title="vector of model weights">w</a>);   <span class="comment">//normalization</span> 
     275<a name="l00323"></a>00323                         <span class="comment">//set statistics</span> 
     276<a name="l00324"></a>00324                         <span class="keywordflow">switch</span> (<a class="code" href="classbdm_1_1MultiModel.html#a9b56bcde4664bd53f8995d7ee7ed415c" title="type of switching policy [1=maximum,2=...]">policy</a>) { 
     277<a name="l00325"></a>00325                                 <span class="keywordflow">case</span> 1: { 
     278<a name="l00326"></a>00326                                         <span class="keywordtype">int</span> mi = max_index (<a class="code" href="classbdm_1_1MultiModel.html#aef85ea61575bffa8beac8040869ee47a" title="vector of model weights">w</a>); 
     279<a name="l00327"></a>00327                                         <span class="keyword">const</span> <a class="code" href="classbdm_1_1enorm.html">enorm&lt;chmat&gt;</a> &amp;st = <a class="code" href="classbdm_1_1MultiModel.html#a33de5d07ee774070632de8963b5d4c93" title="List of models between which we switch.">Models</a> (mi)-&gt;posterior() ; 
     280<a name="l00328"></a>00328                                         <a class="code" href="classbdm_1_1MultiModel.html#ad665551d045b1a1055eeb9185558ff0b" title="internal statistics">est</a>.set_parameters (st.<a class="code" href="classbdm_1_1enorm.html#ab2fa2915c35366392fe9bb022ca1a600" title="return expected value">mean</a>(), st._R()); 
     281<a name="l00329"></a>00329                                 } 
     282<a name="l00330"></a>00330                                 <span class="keywordflow">break</span>; 
     283<a name="l00331"></a>00331                                 <span class="keywordflow">default</span>: 
     284<a name="l00332"></a>00332                                         <a class="code" href="bdmerror_8h.html#a7c43f3a72afe68ab0c85663a1bb3521a" title="Unconditionally throw std::runtime_error.">bdm_error</a> (<span class="stringliteral">&quot;unknown policy&quot;</span>); 
     285<a name="l00333"></a>00333                         } 
     286<a name="l00334"></a>00334                         <span class="comment">// copy result to all models</span> 
     287<a name="l00335"></a>00335                         <span class="keywordflow">for</span> (i = 0; i &lt; n; i++) { 
     288<a name="l00336"></a>00336                                 <a class="code" href="classbdm_1_1MultiModel.html#a33de5d07ee774070632de8963b5d4c93" title="List of models between which we switch.">Models</a> (i)-&gt;set_statistics (<a class="code" href="classbdm_1_1MultiModel.html#ad665551d045b1a1055eeb9185558ff0b" title="internal statistics">est</a>.<a class="code" href="classbdm_1_1enorm.html#ab2fa2915c35366392fe9bb022ca1a600" title="return expected value">mean</a>(), <a class="code" href="classbdm_1_1MultiModel.html#ad665551d045b1a1055eeb9185558ff0b" title="internal statistics">est</a>._R()); 
     289<a name="l00337"></a>00337                         } 
     290<a name="l00338"></a>00338                 } 
     291<a name="l00340"></a><a class="code" href="classbdm_1_1MultiModel.html#a2af3f8dc10dfdae0ddc8160a9f36aaee">00340</a>                 <span class="keyword">const</span> <a class="code" href="classbdm_1_1enorm.html">enorm&lt;chmat&gt;</a>&amp; <a class="code" href="classbdm_1_1MultiModel.html#a2af3f8dc10dfdae0ddc8160a9f36aaee" title="posterior density">posterior</a>()<span class="keyword"> const </span>{ 
     292<a name="l00341"></a>00341                         <span class="keywordflow">return</span> <a class="code" href="classbdm_1_1MultiModel.html#ad665551d045b1a1055eeb9185558ff0b" title="internal statistics">est</a>; 
     293<a name="l00342"></a>00342                 } 
     294<a name="l00343"></a>00343  
     295<a name="l00344"></a>00344                 <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1MultiModel.html#a7bd320fa2540883749b3f83cf2261878" title="This method arrange instance properties according the data stored in the Setting...">from_setting</a> (<span class="keyword">const</span> Setting &amp;<span class="keyword">set</span>); 
     296<a name="l00345"></a>00345  
     297<a name="l00346"></a>00346                 <span class="comment">// TODO dodelat void to_setting( Setting &amp;set ) const;</span> 
     298<a name="l00347"></a>00347  
     299<a name="l00348"></a>00348 }; 
     300<a name="l00349"></a>00349  
     301<a name="l00350"></a>00350 <a class="code" href="user__info_8h.html#a4f9de2f17e844047726487b99def99c6" title="Macro for registration of class into map of user-infos, registered class is scriptable...">UIREGISTER</a> (MultiModel); 
     302<a name="l00351"></a>00351 SHAREDPTR (MultiModel); 
    294303<a name="l00352"></a>00352  
    295 <a name="l00353"></a>00353         <span class="keyword">template</span>&lt;<span class="keyword">class</span> sq_T&gt; 
    296 <a name="l00354"></a><a class="code" href="classbdm_1_1Kalman.html#4a39330c14eff8d13179e868a1d1aa8c">00354</a>         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1Kalman.html#4a39330c14eff8d13179e868a1d1aa8c" title="Here dt = [yt;ut] of appropriate dimensions.">Kalman&lt;sq_T&gt;::bayes</a> ( <span class="keyword">const</span> vec &amp;dt ) 
    297 <a name="l00355"></a>00355         { 
    298 <a name="l00356"></a>00356                 it_assert_debug ( dt.length() == ( <a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a>+<a class="code" href="classbdm_1_1Kalman.html#c5136ef617f6ac0e426bea222755d92b" title="cache of rvu.count()">dimu</a> ),<span class="stringliteral">"KalmanFull::bayes wrong size of dt"</span> ); 
    299 <a name="l00357"></a>00357  
    300 <a name="l00358"></a>00358                 sq_T iRy ( <a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a> ); 
    301 <a name="l00359"></a>00359                 vec u = dt.get ( <a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a>,<a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a>+<a class="code" href="classbdm_1_1Kalman.html#c5136ef617f6ac0e426bea222755d92b" title="cache of rvu.count()">dimu</a>-1 ); 
    302 <a name="l00360"></a>00360                 vec y = dt.get ( 0,<a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a>-1 ); 
    303 <a name="l00361"></a>00361                 <span class="comment">//Time update</span> 
    304 <a name="l00362"></a>00362                 <a class="code" href="classbdm_1_1Kalman.html#fa172078091e45561343fa513dd573b0" title="cache of est.mu">_mu</a> = <a class="code" href="classbdm_1_1Kalman.html#0a2072e2090c10fac74ad30a023a4ace" title="Matrix A.">A</a>* <a class="code" href="classbdm_1_1Kalman.html#fa172078091e45561343fa513dd573b0" title="cache of est.mu">_mu</a> + <a class="code" href="classbdm_1_1Kalman.html#5977b2c81857948a35105f0e7840203c" title="Matrix B.">B</a>*u; 
    305 <a name="l00363"></a>00363                 <span class="comment">//P  = A*P*A.transpose() + Q; in sq_T</span> 
    306 <a name="l00364"></a>00364                 <a class="code" href="classbdm_1_1Kalman.html#00c27b0bf324f0018497921ca23c71ed" title="cache of est.R">_P</a>.mult_sym ( <a class="code" href="classbdm_1_1Kalman.html#0a2072e2090c10fac74ad30a023a4ace" title="Matrix A.">A</a> ); 
    307 <a name="l00365"></a>00365                 <a class="code" href="classbdm_1_1Kalman.html#00c27b0bf324f0018497921ca23c71ed" title="cache of est.R">_P</a>  +=<a class="code" href="classbdm_1_1Kalman.html#70f8bf19e81b532c60fd3a7a152425ee" title="Matrix Q in square-root form.">Q</a>; 
    308 <a name="l00366"></a>00366  
    309 <a name="l00367"></a>00367                 <span class="comment">//Data update</span> 
    310 <a name="l00368"></a>00368                 <span class="comment">//_Ry = C*P*C.transpose() + R; in sq_T</span> 
    311 <a name="l00369"></a>00369                 <a class="code" href="classbdm_1_1Kalman.html#00c27b0bf324f0018497921ca23c71ed" title="cache of est.R">_P</a>.mult_sym ( <a class="code" href="classbdm_1_1Kalman.html#818eba63a23972786a4579ad30294177" title="Matrix C.">C</a>, <a class="code" href="classbdm_1_1Kalman.html#2dd268f2d7fbe6382cb8825a1114192a" title="cache of fy.R">_Ry</a> ); 
    312 <a name="l00370"></a>00370                 <a class="code" href="classbdm_1_1Kalman.html#2dd268f2d7fbe6382cb8825a1114192a" title="cache of fy.R">_Ry</a>  +=<a class="code" href="classbdm_1_1Kalman.html#475b088287cdfbba4dc60a3d027728b7" title="Matrix R in square-root form.">R</a>; 
    313 <a name="l00371"></a>00371  
    314 <a name="l00372"></a>00372                 mat Pfull = <a class="code" href="classbdm_1_1Kalman.html#00c27b0bf324f0018497921ca23c71ed" title="cache of est.R">_P</a>.to_mat(); 
    315 <a name="l00373"></a>00373  
    316 <a name="l00374"></a>00374                 <a class="code" href="classbdm_1_1Kalman.html#2dd268f2d7fbe6382cb8825a1114192a" title="cache of fy.R">_Ry</a>.inv ( iRy ); <span class="comment">// result is in _iRy;</span> 
    317 <a name="l00375"></a>00375                 <a class="code" href="classbdm_1_1Kalman.html#bd69dfb802465f22dd84d73a180d5c92" title="placeholder for Kalman gain">_K</a> = Pfull*<a class="code" href="classbdm_1_1Kalman.html#818eba63a23972786a4579ad30294177" title="Matrix C.">C</a>.transpose() * ( iRy.to_mat() ); 
    318 <a name="l00376"></a>00376  
    319 <a name="l00377"></a>00377                 sq_T pom ( ( <span class="keywordtype">int</span> ) Pfull.rows() ); 
    320 <a name="l00378"></a>00378                 iRy.mult_sym_t ( <a class="code" href="classbdm_1_1Kalman.html#818eba63a23972786a4579ad30294177" title="Matrix C.">C</a>*Pfull,pom ); 
    321 <a name="l00379"></a>00379                 ( <a class="code" href="classbdm_1_1Kalman.html#00c27b0bf324f0018497921ca23c71ed" title="cache of est.R">_P</a> ) -= pom; <span class="comment">// P = P -PC'iRy*CP;</span> 
    322 <a name="l00380"></a>00380                 ( <a class="code" href="classbdm_1_1Kalman.html#c249d45258c8578b13858ad3e7b729b1" title="cache of fy.mu">_yp</a> ) = <a class="code" href="classbdm_1_1Kalman.html#818eba63a23972786a4579ad30294177" title="Matrix C.">C</a>* <a class="code" href="classbdm_1_1Kalman.html#fa172078091e45561343fa513dd573b0" title="cache of est.mu">_mu</a>  +<a class="code" href="classbdm_1_1Kalman.html#7b56ac423d0654b5755e4f852a870456" title="Matrix D.">D</a>*u; <span class="comment">//y prediction</span> 
    323 <a name="l00381"></a>00381                 ( <a class="code" href="classbdm_1_1Kalman.html#fa172078091e45561343fa513dd573b0" title="cache of est.mu">_mu</a> ) += <a class="code" href="classbdm_1_1Kalman.html#bd69dfb802465f22dd84d73a180d5c92" title="placeholder for Kalman gain">_K</a>* ( y- <a class="code" href="classbdm_1_1Kalman.html#c249d45258c8578b13858ad3e7b729b1" title="cache of fy.mu">_yp</a> ); 
    324 <a name="l00382"></a>00382  
    325 <a name="l00383"></a>00383  
    326 <a name="l00384"></a>00384                 <span class="keywordflow">if</span> ( <a class="code" href="classbdm_1_1BM.html#faff0ad12556fe7dc0e2807d4fd938ee" title="If true, the filter will compute likelihood of the data record and store it in ll...">evalll</a>==<span class="keyword">true</span> )   <span class="comment">//likelihood of observation y</span> 
    327 <a name="l00385"></a>00385                 { 
    328 <a name="l00386"></a>00386                         <a class="code" href="classbdm_1_1BM.html#4064b6559d962633e4372b12f4cd204a" title="Logarithm of marginalized data likelihood.">ll</a>=<a class="code" href="classbdm_1_1Kalman.html#ba555c394c429f6831c9bbabfa2c944c" title="preditive density on $y_t$">fy</a>.evallog ( y ); 
    329 <a name="l00387"></a>00387                 } 
    330 <a name="l00388"></a>00388  
    331 <a name="l00389"></a>00389 <span class="comment">//cout &lt;&lt; "y: " &lt;&lt; y-(*_yp) &lt;&lt;" R: " &lt;&lt; _Ry-&gt;to_mat() &lt;&lt; " iR: " &lt;&lt; _iRy-&gt;to_mat() &lt;&lt; " ll: " &lt;&lt; ll &lt;&lt;endl;</span> 
    332 <a name="l00390"></a>00390  
    333 <a name="l00391"></a>00391         }; 
    334 <a name="l00392"></a>00392  
    335 <a name="l00400"></a><a class="code" href="classbdm_1_1MultiModel.html">00400</a>         <span class="keyword">class </span><a class="code" href="classbdm_1_1MultiModel.html" title="(Switching) Multiple Model The model runs several models in parallel and evaluates...">MultiModel</a>: <span class="keyword">public</span> <a class="code" href="classbdm_1_1BM.html" title="Bayesian Model of a system, i.e. all uncertainty is modeled by probabilities.">BM</a> 
    336 <a name="l00401"></a>00401         { 
    337 <a name="l00402"></a>00402                 <span class="keyword">protected</span>: 
    338 <a name="l00404"></a><a class="code" href="classbdm_1_1MultiModel.html#33de5d07ee774070632de8963b5d4c93">00404</a>                         Array&lt;EKFCh*&gt; <a class="code" href="classbdm_1_1MultiModel.html#33de5d07ee774070632de8963b5d4c93" title="List of models between which we switch.">Models</a>; 
    339 <a name="l00406"></a><a class="code" href="classbdm_1_1MultiModel.html#ef85ea61575bffa8beac8040869ee47a">00406</a>                         vec <a class="code" href="classbdm_1_1MultiModel.html#ef85ea61575bffa8beac8040869ee47a" title="vector of model weights">w</a>; 
    340 <a name="l00408"></a><a class="code" href="classbdm_1_1MultiModel.html#7b4012fc2208ce4ddd5c0d1fe69d7634">00408</a>                         vec <a class="code" href="classbdm_1_1MultiModel.html#7b4012fc2208ce4ddd5c0d1fe69d7634" title="cache of model lls">_lls</a>; 
    341 <a name="l00410"></a><a class="code" href="classbdm_1_1MultiModel.html#9b56bcde4664bd53f8995d7ee7ed415c">00410</a>                         <span class="keywordtype">int</span> <a class="code" href="classbdm_1_1MultiModel.html#9b56bcde4664bd53f8995d7ee7ed415c" title="type of switching policy [1=maximum,2=...]">policy</a>; 
    342 <a name="l00412"></a><a class="code" href="classbdm_1_1MultiModel.html#d665551d045b1a1055eeb9185558ff0b">00412</a>                         <a class="code" href="classbdm_1_1enorm.html">enorm&lt;chmat&gt;</a> <a class="code" href="classbdm_1_1MultiModel.html#d665551d045b1a1055eeb9185558ff0b" title="internal statistics">est</a>; 
    343 <a name="l00413"></a>00413                 <span class="keyword">public</span>: 
    344 <a name="l00414"></a>00414                         <span class="keywordtype">void</span> set_parameters ( Array&lt;EKFCh*&gt; A, <span class="keywordtype">int</span> pol0=1 ) 
    345 <a name="l00415"></a>00415                         { 
    346 <a name="l00416"></a>00416                                 <a class="code" href="classbdm_1_1MultiModel.html#33de5d07ee774070632de8963b5d4c93" title="List of models between which we switch.">Models</a>=A;<span class="comment">//TODO: test if evalll is set</span> 
    347 <a name="l00417"></a>00417                                 <a class="code" href="classbdm_1_1MultiModel.html#ef85ea61575bffa8beac8040869ee47a" title="vector of model weights">w</a>.set_length ( A.length() ); 
    348 <a name="l00418"></a>00418                                 <a class="code" href="classbdm_1_1MultiModel.html#7b4012fc2208ce4ddd5c0d1fe69d7634" title="cache of model lls">_lls</a>.set_length ( A.length() ); 
    349 <a name="l00419"></a>00419                                 <a class="code" href="classbdm_1_1MultiModel.html#9b56bcde4664bd53f8995d7ee7ed415c" title="type of switching policy [1=maximum,2=...]">policy</a>=pol0; 
    350 <a name="l00420"></a>00420                                  
    351 <a name="l00421"></a>00421                                 <a class="code" href="classbdm_1_1MultiModel.html#d665551d045b1a1055eeb9185558ff0b" title="internal statistics">est</a>.<a class="code" href="classbdm_1_1epdf.html#f423e28448dbb69ef4905295ec8de8ff" title="Name its rv.">set_rv</a>(<a class="code" href="classbdm_1_1RV.html" title="Class representing variables, most often random variables.">RV</a>(<span class="stringliteral">"MM"</span>,A(0)-&gt;posterior().dimension(),0)); 
    352 <a name="l00422"></a>00422                                 <a class="code" href="classbdm_1_1MultiModel.html#d665551d045b1a1055eeb9185558ff0b" title="internal statistics">est</a>.set_parameters(A(0)-&gt;_e()-&gt;mean(), A(0)-&gt;_e()-&gt;_R()); 
    353 <a name="l00423"></a>00423                         } 
    354 <a name="l00424"></a><a class="code" href="classbdm_1_1MultiModel.html#a915deeddb0e94c337d02ebc0abe535e">00424</a>                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1MultiModel.html#a915deeddb0e94c337d02ebc0abe535e" title="Incremental Bayes rule.">bayes</a> ( <span class="keyword">const</span> vec &amp;dt ) 
    355 <a name="l00425"></a>00425                         { 
    356 <a name="l00426"></a>00426                                 <span class="keywordtype">int</span> n = <a class="code" href="classbdm_1_1MultiModel.html#33de5d07ee774070632de8963b5d4c93" title="List of models between which we switch.">Models</a>.length(); 
    357 <a name="l00427"></a>00427                                 <span class="keywordtype">int</span> i; 
    358 <a name="l00428"></a>00428                                 <span class="keywordflow">for</span> ( i=0;i&lt;n;i++ ) 
    359 <a name="l00429"></a>00429                                 { 
    360 <a name="l00430"></a>00430                                         <a class="code" href="classbdm_1_1MultiModel.html#33de5d07ee774070632de8963b5d4c93" title="List of models between which we switch.">Models</a> ( i )-&gt;bayes ( dt ); 
    361 <a name="l00431"></a>00431                                         <a class="code" href="classbdm_1_1MultiModel.html#7b4012fc2208ce4ddd5c0d1fe69d7634" title="cache of model lls">_lls</a> ( i ) = <a class="code" href="classbdm_1_1MultiModel.html#33de5d07ee774070632de8963b5d4c93" title="List of models between which we switch.">Models</a> ( i )-&gt;_ll(); 
    362 <a name="l00432"></a>00432                                 } 
    363 <a name="l00433"></a>00433                                 <span class="keywordtype">double</span> mlls=max ( <a class="code" href="classbdm_1_1MultiModel.html#7b4012fc2208ce4ddd5c0d1fe69d7634" title="cache of model lls">_lls</a> ); 
    364 <a name="l00434"></a>00434                                 <a class="code" href="classbdm_1_1MultiModel.html#ef85ea61575bffa8beac8040869ee47a" title="vector of model weights">w</a>=exp ( <a class="code" href="classbdm_1_1MultiModel.html#7b4012fc2208ce4ddd5c0d1fe69d7634" title="cache of model lls">_lls</a>-mlls ); 
    365 <a name="l00435"></a>00435                                 <a class="code" href="classbdm_1_1MultiModel.html#ef85ea61575bffa8beac8040869ee47a" title="vector of model weights">w</a>/=sum ( <a class="code" href="classbdm_1_1MultiModel.html#ef85ea61575bffa8beac8040869ee47a" title="vector of model weights">w</a> ); <span class="comment">//normalization</span> 
    366 <a name="l00436"></a>00436                                 <span class="comment">//set statistics</span> 
    367 <a name="l00437"></a>00437                                 <span class="keywordflow">switch</span> ( <a class="code" href="classbdm_1_1MultiModel.html#9b56bcde4664bd53f8995d7ee7ed415c" title="type of switching policy [1=maximum,2=...]">policy</a> ) 
    368 <a name="l00438"></a>00438                                 { 
    369 <a name="l00439"></a>00439                                         <span class="keywordflow">case</span> 1: 
    370 <a name="l00440"></a>00440                                         { 
    371 <a name="l00441"></a>00441                                                 <span class="keywordtype">int</span> mi=max_index ( <a class="code" href="classbdm_1_1MultiModel.html#ef85ea61575bffa8beac8040869ee47a" title="vector of model weights">w</a> ); 
    372 <a name="l00442"></a>00442                                                 <span class="keyword">const</span> <a class="code" href="classbdm_1_1enorm.html">enorm&lt;chmat&gt;</a>* st=(<a class="code" href="classbdm_1_1MultiModel.html#33de5d07ee774070632de8963b5d4c93" title="List of models between which we switch.">Models</a>(mi)-&gt;_e()); 
    373 <a name="l00443"></a>00443                                                 <a class="code" href="classbdm_1_1MultiModel.html#d665551d045b1a1055eeb9185558ff0b" title="internal statistics">est</a>.set_parameters(st-&gt;<a class="code" href="classbdm_1_1enorm.html#b2fa2915c35366392fe9bb022ca1a600" title="return expected value">mean</a>(), st-&gt;_R()); 
    374 <a name="l00444"></a>00444                                         } 
    375 <a name="l00445"></a>00445                                         <span class="keywordflow">break</span>; 
    376 <a name="l00446"></a>00446                                         <span class="keywordflow">default</span>: it_error ( <span class="stringliteral">"unknown policy"</span> ); 
    377 <a name="l00447"></a>00447                                 } 
    378 <a name="l00448"></a>00448                                 <span class="comment">// copy result to all models</span> 
    379 <a name="l00449"></a>00449                                 <span class="keywordflow">for</span> ( i=0;i&lt;n;i++ ) 
    380 <a name="l00450"></a>00450                                 { 
    381 <a name="l00451"></a>00451                                                 <a class="code" href="classbdm_1_1MultiModel.html#33de5d07ee774070632de8963b5d4c93" title="List of models between which we switch.">Models</a> ( i )-&gt;set_statistics ( <a class="code" href="classbdm_1_1MultiModel.html#d665551d045b1a1055eeb9185558ff0b" title="internal statistics">est</a>.<a class="code" href="classbdm_1_1enorm.html#b2fa2915c35366392fe9bb022ca1a600" title="return expected value">mean</a>(),<a class="code" href="classbdm_1_1MultiModel.html#d665551d045b1a1055eeb9185558ff0b" title="internal statistics">est</a>._R()); 
    382 <a name="l00452"></a>00452                                 } 
    383 <a name="l00453"></a>00453                         } 
    384 <a name="l00454"></a>00454                         <span class="comment">//all posterior densities are equal =&gt; return the first one</span> 
    385 <a name="l00455"></a>00455                         <span class="keyword">const</span> <a class="code" href="classbdm_1_1enorm.html">enorm&lt;chmat&gt;</a>* _e()<span class="keyword"> const </span>{<span class="keywordflow">return</span> &amp;<a class="code" href="classbdm_1_1MultiModel.html#d665551d045b1a1055eeb9185558ff0b" title="internal statistics">est</a>;} 
    386 <a name="l00456"></a>00456                                 <span class="comment">//all posterior densities are equal =&gt; return the first one</span> 
    387 <a name="l00457"></a>00457                         <span class="keyword">const</span> enorm&lt;chmat&gt;&amp; posterior()<span class="keyword"> const </span>{<span class="keywordflow">return</span> <a class="code" href="classbdm_1_1MultiModel.html#d665551d045b1a1055eeb9185558ff0b" title="internal statistics">est</a>;} 
    388 <a name="l00458"></a>00458  
    389 <a name="l00459"></a>00459                         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1MultiModel.html#7bd320fa2540883749b3f83cf2261878" title="This method arrange instance properties according the data stored in the Setting...">from_setting</a>( <span class="keyword">const</span> Setting &amp;<span class="keyword">set</span> ); 
    390 <a name="l00460"></a>00460  
    391 <a name="l00461"></a>00461                         <span class="comment">// TODO dodelat void to_setting( Setting &amp;set ) const;</span> 
    392 <a name="l00462"></a>00462  
    393 <a name="l00463"></a>00463         }; 
    394 <a name="l00464"></a>00464  
    395 <a name="l00465"></a>00465         <a class="code" href="user__info_8h.html#4f9de2f17e844047726487b99def99c6" title="Macro for registration of class into map of user-infos, registered class is scriptable...">UIREGISTER</a>(MultiModel); 
    396 <a name="l00466"></a>00466  
    397 <a name="l00467"></a>00467  
    398 <a name="l00468"></a>00468  
    399 <a name="l00469"></a>00469 <span class="comment">//TODO why not const pointer??</span> 
    400 <a name="l00470"></a>00470  
    401 <a name="l00471"></a>00471         <span class="keyword">template</span>&lt;<span class="keyword">class</span> sq_T&gt; 
    402 <a name="l00472"></a><a class="code" href="classbdm_1_1EKF.html#d087a8bb408d26ac4f5c542746b81059">00472</a>         <a class="code" href="classbdm_1_1EKF.html#d087a8bb408d26ac4f5c542746b81059" title="Default constructor.">EKF&lt;sq_T&gt;::EKF</a> ( <a class="code" href="classbdm_1_1RV.html" title="Class representing variables, most often random variables.">RV</a> rvx0, <a class="code" href="classbdm_1_1RV.html" title="Class representing variables, most often random variables.">RV</a> rvy0, <a class="code" href="classbdm_1_1RV.html" title="Class representing variables, most often random variables.">RV</a> rvu0 ) : <a class="code" href="classbdm_1_1Kalman.html" title="Kalman filter with covariance matrices in square root form.">Kalman</a>&lt;sq_T&gt; ( rvx0,rvy0,rvu0 ) {} 
    403 <a name="l00473"></a>00473  
    404 <a name="l00474"></a>00474         <span class="keyword">template</span>&lt;<span class="keyword">class</span> sq_T&gt; 
    405 <a name="l00475"></a><a class="code" href="classbdm_1_1EKF.html#00fec1a0a6a467eb83fb36c65eba7bcb">00475</a>         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1EKF.html#00fec1a0a6a467eb83fb36c65eba7bcb" title="Set nonlinear functions for mean values and covariance matrices.">EKF&lt;sq_T&gt;::set_parameters</a> ( <a class="code" href="classbdm_1_1diffbifn.html" title="Class representing a differentiable function of two variables .">diffbifn</a>* pfxu0,  <a class="code" href="classbdm_1_1diffbifn.html" title="Class representing a differentiable function of two variables .">diffbifn</a>* phxu0,<span class="keyword">const</span> sq_T Q0,<span class="keyword">const</span> sq_T R0 ) 
    406 <a name="l00476"></a>00476         { 
    407 <a name="l00477"></a>00477                 pfxu = pfxu0; 
    408 <a name="l00478"></a>00478                 phxu = phxu0; 
    409 <a name="l00479"></a>00479  
    410 <a name="l00480"></a>00480                 <span class="comment">//initialize matrices A C, later, these will be only updated!</span> 
    411 <a name="l00481"></a>00481                 pfxu-&gt;<a class="code" href="classbdm_1_1diffbifn.html#651184f808a35f236dbfea21aca1b6ac" title="Evaluates  and writes result into A .">dfdx_cond</a> ( <a class="code" href="classbdm_1_1Kalman.html#fa172078091e45561343fa513dd573b0" title="cache of est.mu">_mu</a>,zeros ( <a class="code" href="classbdm_1_1Kalman.html#c5136ef617f6ac0e426bea222755d92b" title="cache of rvu.count()">dimu</a> ),<a class="code" href="classbdm_1_1Kalman.html#0a2072e2090c10fac74ad30a023a4ace" title="Matrix A.">A</a>,<span class="keyword">true</span> ); 
    412 <a name="l00482"></a>00482 <span class="comment">//      pfxu-&gt;dfdu_cond ( *_mu,zeros ( dimu ),B,true );</span> 
    413 <a name="l00483"></a>00483                 <a class="code" href="classbdm_1_1Kalman.html#5977b2c81857948a35105f0e7840203c" title="Matrix B.">B</a>.clear(); 
    414 <a name="l00484"></a>00484                 phxu-&gt;<a class="code" href="classbdm_1_1diffbifn.html#651184f808a35f236dbfea21aca1b6ac" title="Evaluates  and writes result into A .">dfdx_cond</a> ( <a class="code" href="classbdm_1_1Kalman.html#fa172078091e45561343fa513dd573b0" title="cache of est.mu">_mu</a>,zeros ( <a class="code" href="classbdm_1_1Kalman.html#c5136ef617f6ac0e426bea222755d92b" title="cache of rvu.count()">dimu</a> ),<a class="code" href="classbdm_1_1Kalman.html#818eba63a23972786a4579ad30294177" title="Matrix C.">C</a>,<span class="keyword">true</span> ); 
    415 <a name="l00485"></a>00485 <span class="comment">//      phxu-&gt;dfdu_cond ( *_mu,zeros ( dimu ),D,true );</span> 
    416 <a name="l00486"></a>00486                 <a class="code" href="classbdm_1_1Kalman.html#7b56ac423d0654b5755e4f852a870456" title="Matrix D.">D</a>.clear(); 
    417 <a name="l00487"></a>00487  
    418 <a name="l00488"></a>00488                 <a class="code" href="classbdm_1_1Kalman.html#475b088287cdfbba4dc60a3d027728b7" title="Matrix R in square-root form.">R</a> = R0; 
    419 <a name="l00489"></a>00489                 <a class="code" href="classbdm_1_1Kalman.html#70f8bf19e81b532c60fd3a7a152425ee" title="Matrix Q in square-root form.">Q</a> = Q0; 
    420 <a name="l00490"></a>00490         } 
    421 <a name="l00491"></a>00491  
    422 <a name="l00492"></a>00492         <span class="keyword">template</span>&lt;<span class="keyword">class</span> sq_T&gt; 
    423 <a name="l00493"></a><a class="code" href="classbdm_1_1EKF.html#3fb182ecc29b10ca1163cecbf3bcccfa">00493</a>         <span class="keywordtype">void</span> <a class="code" href="classbdm_1_1EKF.html#3fb182ecc29b10ca1163cecbf3bcccfa" title="Here dt = [yt;ut] of appropriate dimensions.">EKF&lt;sq_T&gt;::bayes</a> ( <span class="keyword">const</span> vec &amp;dt ) 
    424 <a name="l00494"></a>00494         { 
    425 <a name="l00495"></a>00495                 it_assert_debug ( dt.length() == ( <a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a>+<a class="code" href="classbdm_1_1Kalman.html#c5136ef617f6ac0e426bea222755d92b" title="cache of rvu.count()">dimu</a> ),<span class="stringliteral">"KalmanFull::bayes wrong size of dt"</span> ); 
    426 <a name="l00496"></a>00496  
    427 <a name="l00497"></a>00497                 sq_T iRy ( <a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a>,<a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a> ); 
    428 <a name="l00498"></a>00498                 vec u = dt.get ( <a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a>,<a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a>+<a class="code" href="classbdm_1_1Kalman.html#c5136ef617f6ac0e426bea222755d92b" title="cache of rvu.count()">dimu</a>-1 ); 
    429 <a name="l00499"></a>00499                 vec y = dt.get ( 0,<a class="code" href="classbdm_1_1Kalman.html#d2c36ba01760bf207b985bf321b7817f" title="cache of rvy.count()">dimy</a>-1 ); 
    430 <a name="l00500"></a>00500                 <span class="comment">//Time update</span> 
    431 <a name="l00501"></a>00501                 <a class="code" href="classbdm_1_1Kalman.html#fa172078091e45561343fa513dd573b0" title="cache of est.mu">_mu</a> = pfxu-&gt;<a class="code" href="classbdm_1_1diffbifn.html#188f31066bd72e1bf0ddacd1eb0e6af3" title="Evaluates  (VS: Do we really need common eval? ).">eval</a> ( <a class="code" href="classbdm_1_1Kalman.html#fa172078091e45561343fa513dd573b0" title="cache of est.mu">_mu</a>, u ); 
    432 <a name="l00502"></a>00502                 pfxu-&gt;<a class="code" href="classbdm_1_1diffbifn.html#651184f808a35f236dbfea21aca1b6ac" title="Evaluates  and writes result into A .">dfdx_cond</a> ( <a class="code" href="classbdm_1_1Kalman.html#fa172078091e45561343fa513dd573b0" title="cache of est.mu">_mu</a>,u,<a class="code" href="classbdm_1_1Kalman.html#0a2072e2090c10fac74ad30a023a4ace" title="Matrix A.">A</a>,<span class="keyword">false</span> ); <span class="comment">//update A by a derivative of fx</span> 
    433 <a name="l00503"></a>00503  
    434 <a name="l00504"></a>00504                 <span class="comment">//P  = A*P*A.transpose() + Q; in sq_T</span> 
    435 <a name="l00505"></a>00505                 <a class="code" href="classbdm_1_1Kalman.html#00c27b0bf324f0018497921ca23c71ed" title="cache of est.R">_P</a>.<a class="code" href="classfsqmat.html#5530d2756b5d991de755e6121c9a452e" title="Inplace symmetric multiplication by a SQUARE matrix , i.e. .">mult_sym</a> ( <a class="code" href="classbdm_1_1Kalman.html#0a2072e2090c10fac74ad30a023a4ace" title="Matrix A.">A</a> ); 
    436 <a name="l00506"></a>00506                 <a class="code" href="classbdm_1_1Kalman.html#00c27b0bf324f0018497921ca23c71ed" title="cache of est.R">_P</a> +=<a class="code" href="classbdm_1_1Kalman.html#70f8bf19e81b532c60fd3a7a152425ee" title="Matrix Q in square-root form.">Q</a>; 
    437 <a name="l00507"></a>00507  
    438 <a name="l00508"></a>00508                 <span class="comment">//Data update</span> 
    439 <a name="l00509"></a>00509                 phxu-&gt;<a class="code" href="classbdm_1_1diffbifn.html#651184f808a35f236dbfea21aca1b6ac" title="Evaluates  and writes result into A .">dfdx_cond</a> ( <a class="code" href="classbdm_1_1Kalman.html#fa172078091e45561343fa513dd573b0" title="cache of est.mu">_mu</a>,u,<a class="code" href="classbdm_1_1Kalman.html#818eba63a23972786a4579ad30294177" title="Matrix C.">C</a>,<span class="keyword">false</span> ); <span class="comment">//update C by a derivative hx</span> 
    440 <a name="l00510"></a>00510                 <span class="comment">//_Ry = C*P*C.transpose() + R; in sq_T</span> 
    441 <a name="l00511"></a>00511                 <a class="code" href="classbdm_1_1Kalman.html#00c27b0bf324f0018497921ca23c71ed" title="cache of est.R">_P</a>.<a class="code" href="classfsqmat.html#5530d2756b5d991de755e6121c9a452e" title="Inplace symmetric multiplication by a SQUARE matrix , i.e. .">mult_sym</a> ( <a class="code" href="classbdm_1_1Kalman.html#818eba63a23972786a4579ad30294177" title="Matrix C.">C</a>, <a class="code" href="classbdm_1_1Kalman.html#2dd268f2d7fbe6382cb8825a1114192a" title="cache of fy.R">_Ry</a> ); 
    442 <a name="l00512"></a>00512                 ( <a class="code" href="classbdm_1_1Kalman.html#2dd268f2d7fbe6382cb8825a1114192a" title="cache of fy.R">_Ry</a> ) +=<a class="code" href="classbdm_1_1Kalman.html#475b088287cdfbba4dc60a3d027728b7" title="Matrix R in square-root form.">R</a>; 
    443 <a name="l00513"></a>00513  
    444 <a name="l00514"></a>00514                 mat Pfull = <a class="code" href="classbdm_1_1Kalman.html#00c27b0bf324f0018497921ca23c71ed" title="cache of est.R">_P</a>.<a class="code" href="classfsqmat.html#f54fc955e8e3b43d15afa92124bc24b3" title="Conversion to full matrix.">to_mat</a>(); 
    445 <a name="l00515"></a>00515  
    446 <a name="l00516"></a>00516                 <a class="code" href="classbdm_1_1Kalman.html#2dd268f2d7fbe6382cb8825a1114192a" title="cache of fy.R">_Ry</a>.<a class="code" href="classfsqmat.html#7c9a5af752cf0d1a4ada283ce7efbe54" title="Matrix inversion preserving the chosen form.">inv</a> ( iRy ); <span class="comment">// result is in _iRy;</span> 
    447 <a name="l00517"></a>00517                 <a class="code" href="classbdm_1_1Kalman.html#bd69dfb802465f22dd84d73a180d5c92" title="placeholder for Kalman gain">_K</a> = Pfull*<a class="code" href="classbdm_1_1Kalman.html#818eba63a23972786a4579ad30294177" title="Matrix C.">C</a>.transpose() * ( iRy.to_mat() ); 
    448 <a name="l00518"></a>00518  
    449 <a name="l00519"></a>00519                 sq_T pom ( ( <span class="keywordtype">int</span> ) Pfull.rows() ); 
    450 <a name="l00520"></a>00520                 iRy.mult_sym_t ( <a class="code" href="classbdm_1_1Kalman.html#818eba63a23972786a4579ad30294177" title="Matrix C.">C</a>*Pfull,pom ); 
    451 <a name="l00521"></a>00521                 ( <a class="code" href="classbdm_1_1Kalman.html#00c27b0bf324f0018497921ca23c71ed" title="cache of est.R">_P</a> ) -= pom; <span class="comment">// P = P -PC'iRy*CP;</span> 
    452 <a name="l00522"></a>00522                 <a class="code" href="classbdm_1_1Kalman.html#c249d45258c8578b13858ad3e7b729b1" title="cache of fy.mu">_yp</a> = phxu-&gt;<a class="code" href="classbdm_1_1diffbifn.html#188f31066bd72e1bf0ddacd1eb0e6af3" title="Evaluates  (VS: Do we really need common eval? ).">eval</a> ( <a class="code" href="classbdm_1_1Kalman.html#fa172078091e45561343fa513dd573b0" title="cache of est.mu">_mu</a>,u ); <span class="comment">//y prediction</span> 
    453 <a name="l00523"></a>00523                 ( <a class="code" href="classbdm_1_1Kalman.html#fa172078091e45561343fa513dd573b0" title="cache of est.mu">_mu</a> ) += <a class="code" href="classbdm_1_1Kalman.html#bd69dfb802465f22dd84d73a180d5c92" title="placeholder for Kalman gain">_K</a>* ( y-<a class="code" href="classbdm_1_1Kalman.html#c249d45258c8578b13858ad3e7b729b1" title="cache of fy.mu">_yp</a> ); 
    454 <a name="l00524"></a>00524  
    455 <a name="l00525"></a>00525                 <span class="keywordflow">if</span> ( <a class="code" href="classbdm_1_1BM.html#faff0ad12556fe7dc0e2807d4fd938ee" title="If true, the filter will compute likelihood of the data record and store it in ll...">evalll</a>==<span class="keyword">true</span> ) {<a class="code" href="classbdm_1_1BM.html#4064b6559d962633e4372b12f4cd204a" title="Logarithm of marginalized data likelihood.">ll</a>+=<a class="code" href="classbdm_1_1Kalman.html#ba555c394c429f6831c9bbabfa2c944c" title="preditive density on $y_t$">fy</a>.<a class="code" href="classbdm_1_1eEF.html#a36d06ecdd6f4c79dc122510eaccc692" title="Evaluate normalized log-probability.">evallog</a> ( y );} 
    456 <a name="l00526"></a>00526         }; 
    457 <a name="l00527"></a>00527  
    458 <a name="l00528"></a>00528  
    459 <a name="l00529"></a>00529 } 
    460 <a name="l00530"></a>00530 <span class="preprocessor">#endif // KF_H</span> 
    461 <a name="l00531"></a>00531 <span class="preprocessor"></span> 
    462 <a name="l00532"></a>00532  
     304<a name="l00354"></a>00354  
     305<a name="l00361"></a>00361 <span class="keyword">template</span>&lt;<span class="keyword">class</span> sq_T&gt; 
     306<a name="l00362"></a>00362 shared_ptr&lt;StateSpace&lt;fsqmat&gt; &gt; to_state_space(<span class="keyword">const</span> mlnorm&lt;sq_T &gt; &amp;ml, ivec &amp;theta_in_A, ivec &amp;theta_in_C){ 
     307<a name="l00363"></a>00363         <span class="comment">//get ids of yrv</span> 
     308<a name="l00364"></a>00364                          
     309<a name="l00365"></a>00365                         ivec yids= unique(ml._rv()._ids()); <span class="comment">//yrv is now stored in _yrv</span> 
     310<a name="l00366"></a>00366                         ivec dids= unique(ml._rvc()._ids()); <span class="comment">//yrv is now stored in _yrv</span> 
     311<a name="l00367"></a>00367                         ivec uids=unique_complement(dids, yids); 
     312<a name="l00368"></a>00368          
     313<a name="l00369"></a>00369                         RV yrv_uni = RV(yids,zeros_i(yids.length())); 
     314<a name="l00370"></a>00370                         RV urv_uni = RV(uids,zeros_i(yids.length())); 
     315<a name="l00371"></a>00371                         <span class="comment">//We can do only 1d now... :(</span> 
     316<a name="l00372"></a>00372                         <a class="code" href="bdmerror_8h.html#a89a0f906b242b79c5d3d342291b2cab4" title="Throw std::runtime_exception if t is not true and NDEBUG is not defined.">bdm_assert_debug</a>(yrv_uni._dsize()==urv_uni._dsize()==1, <span class="stringliteral">&quot;Only for SISO so far...&quot;</span> ); 
     317<a name="l00373"></a>00373                                          
     318<a name="l00374"></a>00374                         RV xrv; <span class="comment">//empty</span> 
     319<a name="l00375"></a>00375                         RV Crv; <span class="comment">//empty</span> 
     320<a name="l00376"></a>00376                         <span class="keywordtype">int</span> td=ml._rvc().mintd(); 
     321<a name="l00377"></a>00377                         <span class="keywordflow">for</span> (<span class="keywordtype">int</span> t=-1;t&gt;=td;t--){ 
     322<a name="l00378"></a>00378                                 xrv.add(yrv_uni); 
     323<a name="l00379"></a>00379                                 Crv.add(urv_uni); 
     324<a name="l00380"></a>00380                         } 
     325<a name="l00381"></a>00381                          
     326<a name="l00382"></a>00382                         <span class="keywordtype">int</span> dimx = xrv._dsize(); 
     327<a name="l00383"></a>00383                          
     328<a name="l00384"></a>00384                         theta_in_A = ml._rv().dataind(xrv); 
     329<a name="l00385"></a>00385                         theta_in_C = ml._rvc().dataind(xrv); 
     330<a name="l00386"></a>00386                         <span class="comment">// some chcek of corretness</span> 
     331<a name="l00387"></a>00387                          
     332<a name="l00388"></a>00388                         vec A1row = zeros(xrv._dsize()); 
     333<a name="l00389"></a>00389                         vec C1row = zeros(xrv._dsize()); 
     334<a name="l00390"></a>00390                         vec theta = ml._A().get_row(0); <span class="comment">// this </span> 
     335<a name="l00391"></a>00391                         set_subvector( A1row, theta_in_A, theta); 
     336<a name="l00392"></a>00392                         set_subvector( C1row, theta_in_C, theta); 
     337<a name="l00393"></a>00393  
     338<a name="l00394"></a>00394                         StateSpace&lt;fsqmat&gt; stsp=<span class="keyword">new</span> StateSpace&lt;fsqmat&gt;(); 
     339<a name="l00395"></a>00395                         mat A=zeros(dimx,dimx); 
     340<a name="l00396"></a>00396                         A.set_row(0,A1row); 
     341<a name="l00397"></a>00397                         <span class="keywordflow">for</span> (<span class="keywordtype">int</span> j=1; j&lt;dimx; j++){A(j,j-1)=1.0;} <span class="comment">// off diagonal</span> 
     342<a name="l00398"></a>00398                         mat B=zeros(dimx,1); 
     343<a name="l00399"></a>00399                         B(0) = 1.0; 
     344<a name="l00400"></a>00400                         mat C=zeros(1,dimx); 
     345<a name="l00401"></a>00401                         C.set_row(0,C1row); 
     346<a name="l00402"></a>00402                         stsp.set_parameters(A,B,C,zeros(1,1), zeros(dimx,dimx), ml._R()); 
     347<a name="l00403"></a>00403                         <span class="keywordflow">return</span> stsp; 
     348<a name="l00404"></a>00404 } 
     349<a name="l00405"></a>00405  
     350<a name="l00407"></a>00407  
     351<a name="l00408"></a>00408 <span class="keyword">template</span>&lt;<span class="keyword">class</span> sq_T&gt; 
     352<a name="l00409"></a>00409 <span class="keywordtype">void</span> StateSpace&lt;sq_T&gt;::set_parameters (<span class="keyword">const</span> mat &amp;A0, <span class="keyword">const</span>  mat &amp;B0, <span class="keyword">const</span>  mat &amp;C0, <span class="keyword">const</span>  mat &amp;D0, <span class="keyword">const</span>  sq_T &amp;Q0, <span class="keyword">const</span> sq_T &amp;R0) 
     353<a name="l00410"></a>00410 { 
     354<a name="l00411"></a>00411         dimx = A0.rows(); 
     355<a name="l00412"></a>00412         dimu = B0.cols(); 
     356<a name="l00413"></a>00413         dimy = C0.rows(); 
     357<a name="l00414"></a>00414  
     358<a name="l00415"></a>00415         A = A0; 
     359<a name="l00416"></a>00416         B = B0; 
     360<a name="l00417"></a>00417         C = C0; 
     361<a name="l00418"></a>00418         D = D0; 
     362<a name="l00419"></a>00419         R = R0; 
     363<a name="l00420"></a>00420         Q = Q0; 
     364<a name="l00421"></a>00421         <a class="code" href="classbdm_1_1root.html#a1c314bd6d6dacb8ba78ea5eb88fd9516" title="This method TODO.">validate</a>(); 
     365<a name="l00422"></a>00422 } 
     366<a name="l00423"></a>00423  
     367<a name="l00424"></a>00424 <span class="keyword">template</span>&lt;<span class="keyword">class</span> sq_T&gt; 
     368<a name="l00425"></a>00425 <span class="keywordtype">void</span> StateSpace&lt;sq_T&gt;::validate(){ 
     369<a name="l00426"></a>00426         <a class="code" href="bdmerror_8h.html#a89a0f906b242b79c5d3d342291b2cab4" title="Throw std::runtime_exception if t is not true and NDEBUG is not defined.">bdm_assert_debug</a> (A.cols() == dimx, <span class="stringliteral">&quot;KalmanFull: A is not square&quot;</span>); 
     370<a name="l00427"></a>00427         <a class="code" href="bdmerror_8h.html#a89a0f906b242b79c5d3d342291b2cab4" title="Throw std::runtime_exception if t is not true and NDEBUG is not defined.">bdm_assert_debug</a> (B.rows() == dimx, <span class="stringliteral">&quot;KalmanFull: B is not compatible&quot;</span>); 
     371<a name="l00428"></a>00428         <a class="code" href="bdmerror_8h.html#a89a0f906b242b79c5d3d342291b2cab4" title="Throw std::runtime_exception if t is not true and NDEBUG is not defined.">bdm_assert_debug</a> (C.cols() == dimx, <span class="stringliteral">&quot;KalmanFull: C is not square&quot;</span>); 
     372<a name="l00429"></a>00429         <a class="code" href="bdmerror_8h.html#a89a0f906b242b79c5d3d342291b2cab4" title="Throw std::runtime_exception if t is not true and NDEBUG is not defined.">bdm_assert_debug</a> ( (D.rows() == dimy) || (D.cols() == dimu), <span class="stringliteral">&quot;KalmanFull: D is not compatible&quot;</span>); 
     373<a name="l00430"></a>00430         <a class="code" href="bdmerror_8h.html#a89a0f906b242b79c5d3d342291b2cab4" title="Throw std::runtime_exception if t is not true and NDEBUG is not defined.">bdm_assert_debug</a> ( (Q.cols() == dimx) || (Q.rows() == dimx), <span class="stringliteral">&quot;KalmanFull: Q is not compatible&quot;</span>); 
     374<a name="l00431"></a>00431         <a class="code" href="bdmerror_8h.html#a89a0f906b242b79c5d3d342291b2cab4" title="Throw std::runtime_exception if t is not true and NDEBUG is not defined.">bdm_assert_debug</a> ( (R.cols() == dimy) || (R.rows() == dimy), <span class="stringliteral">&quot;KalmanFull: R is not compatible&quot;</span>); 
     375<a name="l00432"></a>00432 } 
     376<a name="l00433"></a>00433  
     377<a name="l00434"></a>00434 } 
     378<a name="l00435"></a>00435 <span class="preprocessor">#endif // KF_H</span> 
     379<a name="l00436"></a>00436 <span class="preprocessor"></span> 
     380<a name="l00437"></a>00437  
    463381</pre></div></div> 
    464 <hr size="1"><address style="text-align: right;"><small>Generated on Wed Aug 5 00:06:48 2009 for mixpp by&nbsp; 
     382<hr size="1"/><address style="text-align: right;"><small>Generated on Sun Aug 30 22:10:49 2009 for mixpp by&nbsp; 
    465383<a href="http://www.doxygen.org/index.html"> 
    466 <img src="doxygen.png" alt="doxygen" align="middle" border="0"></a> 1.5.9 </small></address> 
     384<img class="footer" src="doxygen.png" alt="doxygen"/></a> 1.6.1 </small></address> 
    467385</body> 
    468386</html>