Lines Matching refs:pecef
171 static void convert_Lla_to_Ecef(const LocLla& plla, LocEcef& pecef) in convert_Lla_to_Ecef() argument
176 pecef.X = (r + plla.alt) * cos(plla.lat) * cos(plla.lon); in convert_Lla_to_Ecef()
177 pecef.Y = (r + plla.alt) * cos(plla.lat) * sin(plla.lon); in convert_Lla_to_Ecef()
178 pecef.Z = (r * OMES + plla.alt) * sin(plla.lat); in convert_Lla_to_Ecef()
228 static void convert_Ecef_to_Lla(const LocEcef& pecef, LocLla& plla) in convert_Ecef_to_Lla() argument
242 p = sqrt(pecef.X * pecef.X + pecef.Y * pecef.Y); in convert_Ecef_to_Lla()
243 r = sqrt(p * p + pecef.Z * pecef.Z); in convert_Ecef_to_Lla()
252 Mu = atan2(pecef.Z * (Ecef1Mf + EcefE2 * EcefA / r), p); in convert_Ecef_to_Lla()
254 if (pecef.Z > 0.0) { in convert_Ecef_to_Lla()
262 Phi = atan2(pecef.Z * Ecef1Mf + EcefE2 * EcefA * Smu * Smu * Smu, in convert_Ecef_to_Lla()
266 plla.alt = p * cos(Phi) + pecef.Z * Sphi - EcefA * EcefA/N; in convert_Ecef_to_Lla()
269 plla.lon = atan2(pecef.Y, pecef.X); in convert_Ecef_to_Lla()