Browse Source

add plc offset to rotated xy

yct 4 years ago
parent
commit
033f2523b0
1 changed files with 3 additions and 0 deletions
  1. 3 0
      velodyne_lidar/ground_region.cpp

+ 3 - 0
velodyne_lidar/ground_region.cpp

@@ -704,6 +704,9 @@ void Ground_region::thread_measure_func()
                 // 添加plc偏移
                 m_car_wheel_information.car_center_x += m_region.plc_offsetx();
                 m_car_wheel_information.car_center_y += m_region.plc_offsety();
+                
+                m_car_wheel_information.uniform_car_x += m_region.plc_offsetx();
+                m_car_wheel_information.uniform_car_y += m_region.plc_offsety();
 
                 Common_data::Car_wheel_information_stamped t_wheel_info_stamped;
                 t_wheel_info_stamped.wheel_data = m_car_wheel_information;