gtsamPose3 pclPointTogtsamPose3PointTypePose thisPoint return gtsamPose3gtsamRot3RzRyRxdoublethisPointroll doublethisPointpitch doublethisPointyaw gtsamPoint3doublethisPointx

This function takes a point of type PointTypePose from the Point Cloud Library (PCL) and converts it into a Pose3 object from the GTSAM library.

The input thisPoint contains information about the position and orientation of a point in 3D space. The x, y, and z fields represent the coordinates of the point, while the roll, pitch, and yaw fields represent the rotation around the x, y, and z axes respectively.

The function first creates a Rot3 object using the RzRyRx constructor, which takes three angles in radians as inputs and returns a rotation matrix. The double conversion is necessary because the RzRyRx constructor expects double arguments.

The Pose3 object is then created using the rotation matrix and the point coordinates, which are converted to double. The resulting Pose3 object represents the same point in 3D space as the original PointTypePose