34 template class Measurement_<RateModel>;
49 ROS_ERROR(
"Could not find bias substate '%s' during initialization of rate measurement '%s'.",
use_bias_.c_str(), measurement.
getName().c_str());
62 R(0,0) = R(1,1) = R(2,2) = pow(
stddev_, 2);
80 state.
rate()->cols(C).setIdentity();
boost::shared_ptr< SubState_< SubVectorDimension, SubCovarianceDimension > > getSubState(const Model *model) const
ConstVectorSegment getVector() const
virtual const std::string & getName() const
virtual bool init(PoseEstimation &estimator, Measurement &measurement, State &state)
virtual ConstRateType getRate() const
virtual void getExpectedValue(MeasurementVector &y_pred, const State &state)
SubState_< 3 >::Ptr bias_
Block< MatrixType, MatrixType::RowsAtCompileTime, CovarianceDimension > cols(MatrixType &matrix)
ParameterList & add(const std::string &key, T &value, const T &default_value)
ParameterList & parameters()
virtual void getStateJacobian(MeasurementMatrix &C, const State &state, bool init)
virtual const boost::shared_ptr< RateStateType > & rate() const
virtual void getMeasurementNoise(NoiseVariance &R, const State &, bool init)