任意两不同坐标系的相互转换

 注意： 应该用施工坐标系向测量坐标系旋转的夹角为a。这个公式的用在机器人的本身坐标系同机器人传感器坐标系之间的互相转换。尤其是激光雷达传感器同机器人之间相互转化。