29 #ifndef HECTOR_POSE_ESTIMATION_HEIGHT_H 30 #define HECTOR_POSE_ESTIMATION_HEIGHT_H 63 virtual void onReset();
64 double resetElevation(
const State &state, boost::function<
double()> altitude_func);
74 Height(
const std::string& name =
"height");
77 void setElevation(
double elevation) { getModel()->setElevation(elevation); }
80 virtual void onReset();
86 #endif // HECTOR_POSE_ESTIMATION_HEIGHT_H
void setElevation(double elevation)
virtual SystemStatus getStatusFlags()
virtual void getStateJacobian(MeasurementMatrix &C, const State &state, bool init)
virtual void getExpectedValue(MeasurementVector &y_pred, const State &state)
void update(const std::string &key, const XmlRpc::XmlRpcValue &v)
virtual bool prepareUpdate(State &state, const MeasurementUpdate &update)
virtual void getMeasurementNoise(NoiseVariance &R, const State &, bool init)
unsigned int SystemStatus
bool elevation_initialized_
double getElevation() const
void setElevation(double elevation)
double getElevation() const
virtual bool init(PoseEstimation &estimator, Measurement &measurement, State &state)