Commit 864dadc7 authored by oscar's avatar oscar

修改rot_y为弧度

parent 7ab381f2
......@@ -244,7 +244,7 @@ void TrackingRos::ThreadTrackingProcess()
box.pose.position.x = obj.x;
box.pose.position.y = obj.y;
box.pose.position.z = obj.z;
Eigen::AngleAxisd V3(obj.rot_y/180*3.1415926, Eigen::Vector3d(0, 0, 1));
Eigen::AngleAxisd V3(obj.rot_y, Eigen::Vector3d(0, 0, 1));
Eigen::Quaterniond R_quat(V3);
box.pose.orientation.x = R_quat.x();
box.pose.orientation.y = R_quat.y();
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment