|
@@ -166,6 +166,7 @@ void GetLidarObj(std::vector<BBOX3D> &results,iv::lidar::objectarray & lidarobjv
|
|
yaw += M_PI / 2;
|
|
yaw += M_PI / 2;
|
|
yaw = std::atan2(sinf(yaw),cosf(yaw));
|
|
yaw = std::atan2(sinf(yaw),cosf(yaw));
|
|
yaw = -yaw;
|
|
yaw = -yaw;
|
|
|
|
+ yaw = yaw + M_PI /2;
|
|
lidarobj.set_tyaw(yaw);
|
|
lidarobj.set_tyaw(yaw);
|
|
iv::lidar::PointXYZ centroid;
|
|
iv::lidar::PointXYZ centroid;
|
|
iv::lidar::PointXYZ * _centroid;
|
|
iv::lidar::PointXYZ * _centroid;
|