Transforms a point in robot space to world space
currentPose ((float, float, float)) – current pose of robot in world space (x, y, yaw)
x (float) – x coordinate in robot space
y (float) – y coordinate in robot space
point in world space
(float, float)
get_T_world_cluster
get_laser_coordinate