|
@@ -288,6 +288,12 @@ Error_manager Locater::measure_height(pcl::PointCloud<pcl::PointXYZ>::Ptr cloud_
|
|
|
pcl::getMinMax3D(*cloud_car,min_point,max_point);
|
|
|
//限制车高的范围,检验结果
|
|
|
height=max_point.z;
|
|
|
+ if(height>=1900 || height<=1000)
|
|
|
+ {
|
|
|
+ char description[255]={0};
|
|
|
+ sprintf(description,"height is out of range, retry :%.2f",height);
|
|
|
+ return Error_manager(LOCATER_MEASURE_HEIGHT_OUT_RANGE,NORMAL,description);
|
|
|
+ }
|
|
|
|
|
|
return SUCCESS;
|
|
|
}
|