Lines Matching refs:pecef
162 static void convert_Lla_to_Ecef(const LocLla& plla, LocEcef& pecef) in convert_Lla_to_Ecef() argument
167 pecef.X = (r + plla.alt) * cos(plla.lat) * cos(plla.lon); in convert_Lla_to_Ecef()
168 pecef.Y = (r + plla.alt) * cos(plla.lat) * sin(plla.lon); in convert_Lla_to_Ecef()
169 pecef.Z = (r * OMES + plla.alt) * sin(plla.lat); in convert_Lla_to_Ecef()
219 static void convert_Ecef_to_Lla(const LocEcef& pecef, LocLla& plla) in convert_Ecef_to_Lla() argument
233 p = sqrt(pecef.X * pecef.X + pecef.Y * pecef.Y); in convert_Ecef_to_Lla()
234 r = sqrt(p * p + pecef.Z * pecef.Z); in convert_Ecef_to_Lla()
243 Mu = atan2(pecef.Z * (Ecef1Mf + EcefE2 * EcefA / r), p); in convert_Ecef_to_Lla()
245 if (pecef.Z > 0.0) { in convert_Ecef_to_Lla()
253 Phi = atan2(pecef.Z * Ecef1Mf + EcefE2 * EcefA * Smu * Smu * Smu, in convert_Ecef_to_Lla()
257 plla.alt = p * cos(Phi) + pecef.Z * Sphi - EcefA * EcefA/N; in convert_Ecef_to_Lla()
260 plla.lon = atan2(pecef.Y, pecef.X); in convert_Ecef_to_Lla()