|
GCOP
1.0
|
#include <unscentedcorrector.h>


Public Types | |
| typedef Matrix< double, _nx, 1 > | Vectornd |
| typedef Matrix< double, _nu, 1 > | Vectorcd |
| typedef Matrix< double, _np, 1 > | Vectormd |
| typedef Matrix< double, _nx, _nx > | Matrixnd |
| typedef Matrix< double, _nx, _nu > | Matrixncd |
| typedef Matrix< double, _nx, _nz > | Matrixnrd |
| typedef Matrix< double, _nu, _nx > | Matrixcnd |
| typedef Matrix< double, _nu, _nu > | Matrixcd |
| typedef Matrix< double, _np, _np > | Matrixmd |
| typedef Matrix< double, _nx, _np > | Matrixnmd |
| typedef Matrix< double, _np, _nx > | Matrixmnd |
| typedef Matrix< double, _nz, 1 > | Vectorrd |
| typedef Matrix< double, _nz, _nz > | Matrixrd |
| typedef Matrix< double, _nz, _nx > | Matrixrnd |
| typedef Matrix< double, _nz, _nu > | Matrixrcd |
| typedef Matrix< double, _nz, _np > | Matrixrmd |
Public Member Functions | |
| UnscentedCorrector (System< T, _nx, _nu, _np > &sys, Sensor< T, _nx, _nu, _np, Tz, _nz > &sensor) | |
| virtual | ~UnscentedCorrector () |
| virtual bool | Correct (T &xb, double t, const T &xa, const Vectorcd &u, const Tz &z, const Vectormd *p=0, bool cov=true) |
Protected Attributes | |
| vector< Tz > | Zs |
| measurement sigma points | |
| Matrixrd | Pzz |
| internally used covariances | |
| Matrixnrd | Pxz |
| internally used covariances | |
| typedef Matrix<double, _nu, _nu> gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Matrixcd |
Reimplemented from gcop::Corrector< T, _nx, _nu, _np, Tz, _nz >.
| typedef Matrix<double, _nu, _nx> gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Matrixcnd |
Reimplemented from gcop::Corrector< T, _nx, _nu, _np, Tz, _nz >.
| typedef Matrix<double, _np, _np> gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Matrixmd |
Reimplemented from gcop::Corrector< T, _nx, _nu, _np, Tz, _nz >.
| typedef Matrix<double, _np, _nx> gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Matrixmnd |
Reimplemented from gcop::Corrector< T, _nx, _nu, _np, Tz, _nz >.
| typedef Matrix<double, _nx, _nu> gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Matrixncd |
Reimplemented from gcop::Corrector< T, _nx, _nu, _np, Tz, _nz >.
| typedef Matrix<double, _nx, _nx> gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Matrixnd |
Reimplemented from gcop::Corrector< T, _nx, _nu, _np, Tz, _nz >.
| typedef Matrix<double, _nx, _np> gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Matrixnmd |
Reimplemented from gcop::Corrector< T, _nx, _nu, _np, Tz, _nz >.
| typedef Matrix<double, _nx, _nz> gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Matrixnrd |
| typedef Matrix<double, _nz, _nu> gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Matrixrcd |
| typedef Matrix<double, _nz, _nz> gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Matrixrd |
| typedef Matrix<double, _nz, _np> gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Matrixrmd |
| typedef Matrix<double, _nz, _nx> gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Matrixrnd |
| typedef Matrix<double, _nu, 1> gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Vectorcd |
Reimplemented from gcop::Corrector< T, _nx, _nu, _np, Tz, _nz >.
| typedef Matrix<double, _np, 1> gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Vectormd |
Reimplemented from gcop::Corrector< T, _nx, _nu, _np, Tz, _nz >.
| typedef Matrix<double, _nx, 1> gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Vectornd |
Reimplemented from gcop::Corrector< T, _nx, _nu, _np, Tz, _nz >.
| typedef Matrix<double, _nz, 1> gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Vectorrd |
| gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::UnscentedCorrector | ( | System< T, _nx, _nu, _np > & | sys, |
| Sensor< T, _nx, _nu, _np, Tz, _nz > & | sensor | ||
| ) |
| gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::~UnscentedCorrector | ( | ) | [virtual] |
| bool gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Correct | ( | T & | xb, |
| double | t, | ||
| const T & | xa, | ||
| const Vectorcd & | u, | ||
| const Tz & | z, | ||
| const Vectormd * | p = 0, |
||
| bool | cov = true |
||
| ) | [virtual] |
Correction step.
| xb | new belief state |
| t | time |
| xa | previous belief state |
| u | control inputs |
| z | measurement |
| p | parameters (optional) |
| cov | whether to update the covariance as well (true by default) |
Implements gcop::Corrector< T, _nx, _nu, _np, Tz, _nz >.
Matrixnrd gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Pxz [protected] |
internally used covariances
Referenced by gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::UnscentedCorrector().
Matrixrd gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Pzz [protected] |
internally used covariances
Referenced by gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::UnscentedCorrector().
vector<Tz> gcop::UnscentedCorrector< T, _nx, _nu, _np, Tz, _nz >::Zs [protected] |
measurement sigma points
1.7.6.1