/usr/include/x86_64-linux-gnu/visp3/core/vpLinearKalmanFilterInstantiation.h is in libvisp-core-dev 3.0.0-4.
This file is owned by root:root, with mode 0o644.
The actual contents of the file can be viewed below.
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 | /****************************************************************************
*
* This file is part of the ViSP software.
* Copyright (C) 2005 - 2015 by Inria. All rights reserved.
*
* This software is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* ("GPL") version 2 as published by the Free Software Foundation.
* See the file LICENSE.txt at the root directory of this source
* distribution for additional information about the GNU GPL.
*
* For using ViSP with software that can not be combined with the GNU
* GPL, please contact Inria about acquiring a ViSP Professional
* Edition License.
*
* See http://visp.inria.fr for more information.
*
* This software was developed at:
* Inria Rennes - Bretagne Atlantique
* Campus Universitaire de Beaulieu
* 35042 Rennes Cedex
* France
*
* If you have questions regarding the use of this file, please contact
* Inria at visp@inria.fr
*
* This file is provided AS IS with NO WARRANTY OF ANY KIND, INCLUDING THE
* WARRANTY OF DESIGN, MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
*
* Description:
* Kalman filtering.
*
* Authors:
* Eric Marchand
* Fabien Spindler
*
*****************************************************************************/
#ifndef vpLinearKalmanFilterInstantiation_h
#define vpLinearKalmanFilterInstantiation_h
#include <visp3/core/vpKalmanFilter.h>
#include <math.h>
/*!
\file vpLinearKalmanFilterInstantiation.h
\brief Implementation of some specific linear Kalman filters.
*/
/*!
\class vpLinearKalmanFilterInstantiation
\ingroup group_core_kalman
\brief This class provides an implementation of some specific linear Kalman filters.
*/
class VISP_EXPORT vpLinearKalmanFilterInstantiation : public vpKalmanFilter
{
public:
/*!
Selector used to set the Kalman filter state model.
*/
typedef enum {
/*! Consider the state as a constant velocity model with white
noise. Measures available are the succesive positions of the
target. To know more about this state model, see
initStateConstVel_MeasurePos(). */
stateConstVel_MeasurePos,
/*! Consider the state as a constant velocity model with colored noise
measurements as acceleration terms. Measured available are the
velocities of the target. To know more about this state model,
see initStateConstVelWithColoredNoise_MeasureVel(). */
stateConstVelWithColoredNoise_MeasureVel,
/*! Consider the state as a constant acceleration model with colored noise
measurements as acceleration terms. Measured available are the
velocities of the target. To know more about this state model,
see initStateConstAccWithColoredNoise_MeasureVel(). */
stateConstAccWithColoredNoise_MeasureVel,
/*! Used to indicate that the state model is not initialized. */
unknown
} vpStateModel;
/*!
Default linear Kalman filter.
By default the state model is unknown and set to
vpLinearKalmanFilterInstantiation::unknown.
*/
vpLinearKalmanFilterInstantiation() : model(unknown)
{
};
/*! Destructor that does nothng. */
virtual ~vpLinearKalmanFilterInstantiation() {};
/*!
Return the current state model.
*/
inline vpStateModel getStateModel() {
return model;
}
void filter(vpColVector &z);
/*! @name Generic linear filter initializer */
//@{
inline void setStateModel(vpStateModel model);
void initFilter(unsigned int nsignal, vpColVector &sigma_state,
vpColVector &sigma_measure, double rho, double dt);
//@}
/*! @name Linear filter initializer with constant velocity models */
//@{
void initStateConstVel_MeasurePos(unsigned int nsignal,
vpColVector &sigma_state,
vpColVector &sigma_measure,
double dt);
void initStateConstVelWithColoredNoise_MeasureVel(unsigned int nsignal,
vpColVector &sigma_state,
vpColVector &sigma_measure,
double rho);
//@}
/*! @name Linear filter initializer with constant acceleration models */
//@{
void initStateConstAccWithColoredNoise_MeasureVel(unsigned int nsignal,
vpColVector &sigma_state,
vpColVector &sigma_measure,
double rho,
double dt);
//@}
protected:
vpStateModel model;
} ;
/*!
Set the Kalman state model. Depending on the state model, we set
the state vector size and the measure vector size.
The example below shows how to use this method and then to get the
size of the state and measure vectors.
\code
#include <visp3/core/vpLinearKalmanFilterInstantiation.h>
int main()
{
vpLinearKalmanFilterInstantiation kalman;
kalman.setStateModel(vpLinearKalmanFilterInstantiation::stateConstVelWithColoredNoise_MeasureVel);
std::cout << "State vector size: " << kalman.getStateSize() << std::endl; // Value is 2
std::cout << "Measure vector size: " << kalman.getMeasureSize() << std::endl; // Value is 1
}
\endcode
*/
void vpLinearKalmanFilterInstantiation::setStateModel(vpStateModel mdl) {
this->model = mdl;
switch(model) {
case stateConstVel_MeasurePos:
case stateConstVelWithColoredNoise_MeasureVel:
size_state = 2;
size_measure = 1;
break;
case stateConstAccWithColoredNoise_MeasureVel:
size_state = 3;
size_measure = 1;
break;
case unknown:
size_state = 0;
size_measure = 0;
break;
}
}
#endif
|