ros|TF工具获取IMU数据

合集 - ros学习(6)

1.3.6 ros拾遗|rostopic相关2024-03-062.ros|关于rosinfo不能输出中文2024-03-06

3.ros|TF工具获取IMU数据2024-03-08

4.ros|实现IMU航向锁定2024-03-085.ros|自定义消息类型2024-03-096.ros|导航系统原理2024-03-10

收起

void IMUCallback(sensor_msgs::Imu msg){
    if(msg.orientation_covariance[0]<0)//若协方差矩阵第一个值为-1，表示数据不存在
           return; 
    //用TF工具将四元数转化为欧拉角
    tf::Quaternion quaternion(
    msg.orientation.x,
    msg.orientation.y,
    msg.orientation.z,
    msg.orientation.w,
    );
    double roll,pitch,yaw;
    tf::Matrix3x3(quaternion).getRPY(roll,pitch,yaw);
    /*弧度转为角度
    roll=roll*180/M_PI;
    */
}