三角测量计算三维坐标的代码