Commit 4d534793 authored by oscar's avatar oscar

提交更新

parent f5bfbd62
This diff is collapsed.
...@@ -516,7 +516,15 @@ if __name__ == '__main__': ...@@ -516,7 +516,15 @@ if __name__ == '__main__':
angle = car_yaw_cal(79.89299572540227,bbox[2]) angle = car_yaw_cal(79.89299572540227,bbox[2])
mapInfoExport = get_map_data(exportCenterBL[0],exportCenterBL[1],angle) mapInfoExport = get_map_data(exportCenterBL[0],exportCenterBL[1],angle)
print("call get ex data isInMap = ",mapInfoExport) print("call get ex data isInMap = ",mapInfoExport)
if mapInfo[0] != 1 or mapInfoExport[0] != 1: if mapInfoExport[0] != 1:
continue;
laneAngle = mapInfoExport[10];
detaAngel = laneAngle - angle;
while detaAngel > 180:
detaAngel -= 360
while detaAngel < -180:
detaAngel +=- 360
if( abs(detaAngel) > 30)
continue; continue;
flag = in_hull(xyz,bbox[1]) flag = in_hull(xyz,bbox[1])
pickcloud = xyz[flag] pickcloud = xyz[flag]
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment