定位坐标转换

代码说明：

在面对水下定位的时候，会涉及到不同坐标系的相互转换，其中就涉及到基阵坐标的偏移角，为了将应答器坐标转换到船心坐标，所以要用坐标转换的相关内容。