56 sensor_pose_.pose.position.z = baro->getModel()->getAltitude(
Baro::Update(altimeter->pressure, altimeter->qnh)) - baro->getElevation();
PoseEstimation * pose_estimation_
QuadrotorPoseEstimationNode(const SystemPtr &system=SystemPtr(), const StatePtr &state=StatePtr())
Subscriber subscribe(const std::string &topic, uint32_t queue_size, void(T::*fp)(M), T *obj, const TransportHints &transport_hints=TransportHints())
MeasurementPtr getMeasurement(const std::string &name) const
ros::Subscriber baro_subscriber_
virtual ros::NodeHandle & getNodeHandle()
ros::Publisher sensor_pose_publisher_
const MeasurementPtr & addMeasurement(const MeasurementPtr &measurement, const std::string &name=std::string())
traits::Update< BaroModel >::type Update
ros::Subscriber height_subscriber_
geometry_msgs::PoseStamped sensor_pose_
virtual ~QuadrotorPoseEstimationNode()
void baroCallback(const hector_uav_msgs::AltimeterConstPtr &altimeter)