Get transformationmatrix from laser to cluster
x_cls (float) – x coordinate of cluster in laser space
y_cls (float) – y coordinate of cluster in laser space
transformationmatrix laser->cluster
numpy.array(4,4)
get_T_robot_laser
get_T_of_3Dpoint