OpenDriveLab / OpenLane-V2

[NeurIPS 2023 Track Datasets and Benchmarks] OpenLane-V2: The First Perception and Reasoning Benchmark for Road Driving
https://proceedings.neurips.cc/paper_files/paper/2023/hash/3c0a4c8c236144f1b99b7e1531debe9c-Abstract-Datasets_and_Benchmarks.html
Apache License 2.0
557 stars 66 forks source link

Pose Heading may not be correct #31

Closed javierpastorfernandez closed 1 year ago

javierpastorfernandez commented 1 year ago

Good night,

I am trying to accumulate the 3D lanemarking detections using the information provided by the pose in the following manner: points_global = np.dot(current_pose, points_lidar). where current_pose=np.array(frame.pose.transform).reshape(4,4)

Points_lidar are already in vehicle frame as stated in the documentation, so I just use the pose to transform from vehicle frame to world/global frame.

When I visualize the accumulated point cloud, detections of different frames accumulate at an angle, and they do not overlap correctly. Moreover, when I plot the position of the car together with the heading/yaw, it does not align with the trajectory of the car.

I am working on segment segment-6935841224766931310_2770_310_2790_310, but I seen this in other segments. I am doing something wrong????

Screenshot from 2023-04-26 00-34-00 Screenshot from 2023-04-26 00-32-38

Thank you, I look forward to hearing from you. Javier Pastor Fernández