ros——欧拉角和四元数互转

四元数转欧拉角

void odometryCallback_(const nav_msgs::Odometry::ConstPtr msg) {
   
    
    
    geometry_msgs::Pose2D pose2d;
    pose2d.x = msg->pose.pose.position.x;
    pose2d.y =</