21 sensor_msgs::Imu::Ptr imuMsgPtrCopy = boost::make_shared<sensor_msgs::Imu>(*imuMsgPtr);
22 imuMsgPtrCopy->angular_velocity.x = imuMsgPtr->angular_velocity.x * M_PI / 180.0;
23 imuMsgPtrCopy->angular_velocity.y = imuMsgPtr->angular_velocity.y * M_PI / 180.0;
24 imuMsgPtrCopy->angular_velocity.z = imuMsgPtr->angular_velocity.z * M_PI / 180.0;
virtual void imuCallback(const sensor_msgs::Imu::ConstPtr &imuPtr)
HolisticFusionRos(const std::shared_ptr< ros::NodeHandle > &privateNodePtr)
bool areYawAndPositionInited() const
bool areRollAndPitchInited() const
bool initHeadingAndPositionAsIdentity()
void pretendFirstMeasurementReceived()
void imuCallback(const sensor_msgs::Imu::ConstPtr &imuPtr) override
ImuIntegrator(std::shared_ptr< ros::NodeHandle > privateNodePtr)