wgs-84高精度空间直角坐标转为CGCS2000坐标程序开发

WGS-84空间直角坐标坐标转CGCS2000空间直角坐标// 修改后的坐标转换核心方法private Vectordouble TransformCoordinates(Vectordouble source,FrameParams frameParams,double obsEpoch,double targetEpoch,VelocityModel velocityModel){// 1. 计算时间差年double deltaYears targetEpoch - obsEpoch;// 2. 计算速度Vectordouble velocity;if (velocityModel.ModelType VelocityType.Euler){velocity CalculateEulerVelocity(source, velocityModel.EulerValues);}else if (velocityModel.ModelType VelocityType.Linear){velocity FindGridVelocity(source);}else // VelocityType.Custom{velocity velocityModel.CustomValues;}// 3. 历元转换得到目标历元时刻的坐标仍在原框架下Vectordouble coordAtTargetEpoch source velocity * deltaYears;// 4. 将框架转换参数归算到目标历元FrameParams frameParamsAtTarget ComputeFrameParamsAtEpoch(frameParams, targetEpoch);// 5. 框架转换从原框架目标历元转换到目标框架目标历元Vectordouble result ApplyFrameTransform(coordAtTargetEpoch, frameParamsAtTarget);return result;}// 修复框架参数归算方法private FrameParams ComputeFrameParamsAtEpoch(FrameParams p, double targetEpoch){double deltaYears targetEpoch - p.ReferenceEpoch;return new FrameParams{Tx p.Tx p.Tx_rate * deltaYears,Ty p.Ty p.Ty_rate * deltaYears,Tz p.Tz p.Tz_rate * deltaYears,Rx (p.Rx p.Rx_rate * deltaYears) * m,Ry (p.Ry p.Ry_rate * deltaYears) * m,Rz (p.Rz p.Rz_rate * deltaYears) * m,D p.D p.D_rate * deltaYears,// 保留原始速率值后续不再使用Tx_rate p.Tx_rate,Ty_rate p.Ty_rate,Tz_rate p.Tz_rate,Rx_rate p.Rx_rate,Ry_rate p.Ry_rate,Rz_rate p.Rz_rate,D_rate p.D_rate,ReferenceEpoch targetEpoch};}private Vectordouble ApplyFrameTransform(Vectordouble source, FrameParams p){// 实现公式(4)的变换矩阵var S Matrixdouble.Build.DenseIdentity(3) * (1 p.D * 1e-9); // ppb转换为无量纲var R Matrixdouble.Build.DenseOfArray(new double[,] {{ 0, -p.Rz, p.Ry },{ p.Rz, 0, -p.Rx },{ -p.Ry, p.Rx, 0 }});var T Vectordouble.Build.Dense(new[] {p.Tx * 0.001, // mm → mp.Ty * 0.001,p.Tz * 0.001});return (S R) * source T;}