Browse Source

add angle and wheel width avg value

yct 3 years ago
parent
commit
91efb5c48b
1 changed files with 4 additions and 0 deletions
  1. 4 0
      测量节点/velodyne_lidar/ground_region.cpp

+ 4 - 0
测量节点/velodyne_lidar/ground_region.cpp

@@ -1007,6 +1007,10 @@ void Ground_region::thread_measure_func()
                 ec = Measure_filter::get_instance_references().get_filtered_wheel_information(m_region.region_id(), t_wheel_info_stamped.wheel_data);
                 if (ec == SUCCESS)
                 {
+                    // 20221208 added by yct, use avg car angle and width data.
+                    m_car_wheel_information.car_angle = t_wheel_info_stamped.wheel_data.car_angle;
+                    m_car_wheel_information.car_wheel_width = t_wheel_info_stamped.wheel_data.car_wheel_width;
+
                     m_car_wheel_information.car_wheel_base = t_wheel_info_stamped.wheel_data.car_wheel_base;
                     m_car_wheel_information.car_front_theta = t_wheel_info_stamped.wheel_data.car_front_theta;
                     // 临时添加,滤波后前轮超界