提交角度修改

TrackingRos.cpp

@@ -270,7 +270,7 @@ void TrackingRos::ThreadTrackingProcess()
                         //SDK_LOG(SDK_INFO, "lat = %.10f, lon = %.10f", obj.Lat, obj.Long);
                     }
                 }
-                //修正rot_y值
+                //修正rot_y值,变为角度
                 to360(obj.rot_y, m_lidar_x_angle);
 
                 jsk_recognition_msgs::BoundingBox box = {};
@@ -283,7 +283,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, Eigen::Vector3d(0, 0, 1));
+                Eigen::AngleAxisd V3(obj.rot_y/180*3.14159265, Eigen::Vector3d(0, 0, 1));
                 Eigen::Quaterniond R_quat(V3);
                 box.pose.orientation.x = R_quat.x();
                 box.pose.orientation.y = R_quat.y();