四元素转方向余弦矩阵C的完整代码如下: #include"ros/ros.h" #include"std_msgs/String.h" #include<pcl/common/transforms.h> #include"nav_msgs/Odometry.h" #