Stepan Salov edited section_addcontentsline_toc_section_x__.tex  almost 8 years ago

Commit id: 77fdeb8c93d9cecef375cdf037b90c0faa608f90

deletions | additions      

       

\addcontentsline{toc}{section}{Алгоритм Калмана}  Идея Калмана состоит в том, чтобы получить наилучшее приближение к истинной координате $x(t+1)$,мы должны выбрать золотую середину между показанием $z(t+1)$ неточного сенсора и $x^{opt}_{t}+a\cdot t+2.1$ — нашим предсказанием того, что мы ожидали от него увидеть. Показанию сенсора мы дадим вес $K$, а на предсказанное значение останется вес $(1-K)$\cite{doe:website}:  \begin{equation}\label{xopt}  xOpt(t+1)=K_{t+1}\cdot x^{opt}_{t+1}=K_{t+1}\cdot  z(t+1)+(1-K_{t+1})\cdot (xOpt(t)+a\cdot (x^{opt}_{t}+a\cdot  t+2.1) \end{equation}  где $K_{t+1}$ - коэффициент Калмана, зависящий от шага итерации. \\  Мы должны выбрать $K_{t+1}$ таким, чтобы получившееся оптимальное значение координаты $xOpt(t+1)$ $x^{opt}_{t+1}$  было бы наиболее близкое к истиной координате $x(t+1)$. В общем случае, чтобы найти точное значение коэффициента Калмана $K_{t+1}$ , нужно просто минимизировать ошибку:  \begin{equation}\label{et}  e(t+1)=x(t+1)-xOpt(t+1) e(t+1)=x(t+1)-x^{opt}_{t+1}  \end{equation}  Подставляем в уравнение (\ref{xopt}) выражение (\ref{et}) и упрощаем:  $$  e(t+1)=x(t+1)–K_{t+1}\cdot z(t+1)-(1-K_{t+1})\cdot (xOpt(t)+a\cdot (x^{opt}_{t}+a\cdot  t+2.1)=\\=x(t+1)-K_{t+1}\cdot (x(t+1)+N_{t+1})-(1-K_{t+1})\cdot (xOpt(t)+a\cdot (x^{opt}_{t}+a\cdot  t+2.1)=\\=x(t+1)\cdot (1-K_{t+1})-K_{t+1}\cdot (x(t+1)+N_{t+1})-(1-K_{t+1})\cdot (xOpt(t)+a\cdot (x^{opt}_{t}+a\cdot  t+2.1)=\\=(1-K_{t+1})\cdot (x(t+1)–xOpt(t)–a\cdot (x(t+1)–x^{opt}_{t}–a\cdot  t–2.1)–K_{t+1}\cdot N_{t+1}=\\=(1-K_{t+1})\cdot (x(t)+a\cdot t+2.1+E_{t}–xOpt(t)–a\cdot t+2.1+E_{t}–x^{opt}_{t}–a\cdot  t–2.1)–K_{t+1}\cdot N_{t+1}=\\=(1-K_{t+1})\cdot (x(t)–xOpt(t)+E_{t})–K_{t+1}\cdot (x(t)–x^{opt}_{t}+E_{t})–K_{t+1}\cdot  N_{t+1}=\\=(1-K_{t+1})\cdot (e(t)+E_{t})–K_{t+1}\cdot N_{t+1}$$ Таким образом, получаем:  $$  e(t+1)=(1-K_{t+1})\cdot (e(t)+E_{t})–K_{t+1}\cdot N_{t+1}