|
@@ -413,7 +413,10 @@ Error_manager Ground_region::get_current_wheel_information(Common_data::Car_whee
|
|
|
if( m_detect_update_time > command_time )
|
|
|
{
|
|
|
*p_car_wheel_information = m_car_wheel_information;
|
|
|
- return Error_code::SUCCESS;
|
|
|
+ if(m_car_wheel_information.correctness)
|
|
|
+ return Error_code::SUCCESS;
|
|
|
+ else
|
|
|
+ return Error_manager(Error_code::VELODYNE_REGION_CERES_SOLVE_ERROR, Error_level::MINOR_ERROR, " Ground_region detect error");
|
|
|
}
|
|
|
else
|
|
|
{
|
|
@@ -434,7 +437,10 @@ Error_manager Ground_region::get_last_wheel_information(Common_data::Car_wheel_i
|
|
|
if( m_detect_update_time > command_time - std::chrono::milliseconds(GROUND_REGION_DETECT_CYCLE_MS))
|
|
|
{
|
|
|
*p_car_wheel_information = m_car_wheel_information;
|
|
|
- return Error_code::SUCCESS;
|
|
|
+ if(m_car_wheel_information.correctness)
|
|
|
+ return Error_code::SUCCESS;
|
|
|
+ else
|
|
|
+ return Error_manager(Error_code::VELODYNE_REGION_CERES_SOLVE_ERROR, Error_level::MINOR_ERROR, " Ground_region detect error ");
|
|
|
}
|
|
|
else
|
|
|
{
|