Get corners of robot as coordinates in world space
currentPose ((float, float, float)) – current pose of robot in world space (x, y, yaw)
points of all four corners (pt1, pt2, pt3, pt4)
((float,float),(float,float),(float,float),(float,float))
get_robot_coordinate