Skip to content

Pose Heading may not be correct #64

@javierpastorfernandez

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

Metadata

Metadata

Assignees

No one assigned

    Labels

    No labels
    No labels

    Type

    No type
    No fields configured for issues without a type.

    Projects

    No projects

    Milestone

    No milestone

    Relationships

    None yet

    Development

    No branches or pull requests

    Issue actions