站心地平直角坐标系与站心地平极坐标系的转换c++实现

对于站心地平直角坐标系 (X, Y, Z)，其转换到站心地平极坐标系 (ρ, λ, h) 的过程如下：

1. 计算 ρ = sqrt(X^2 + Y^2)，即该点到站心的水平距离。
2. 计算 λ = atan2(Y,X)，其中 atan2 是一个库函数，其返回值为[-π, π]。
3. 计算 h = Z - R，其中 R 为地球半径。

若需将站心地平极坐标系 (ρ, λ, h) 转换回站心地平直角坐标系 (X, Y, Z)，过程如下：

1. 计算 cos(λ) = cos(atan2(Y, X))，sin(λ) = sin(atan2(Y,X))。
2. 计算 X = (ρ + R) * cos(λ)，Y = (ρ + R) * sin(λ)，Z = h + R，其中 R 为地球半径。

以上就是站心地平直角坐标系与站心地平极坐标系的转换过程。