Skip to content

Pose Heading may not be correct #64

Description

@javierpastorfernandez

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

Activity

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Metadata

Metadata

Assignees

No one assigned

    Labels

    No labels
    No labels

    Type

    No type

    Projects

    No projects

      Milestone

      No milestone

      Relationships

      None yet

      Development

      No branches or pull requests

      Issue actions