#include <stdio.h> #include <math.h>

double ATAN2(double x, double y) { double tmp; if (y == 0) { if (x > 0) { tmp = 0; } else { if (x < 0) { tmp = M_PI; } else { tmp = 1 / 0; } } } else { if (y > 0) { tmp = (M_PI / 2) - atan(x / y); } else { tmp = -(M_PI / 2) - atan(x / y); } } return tmp; }

double round(double val, int places) { val = val * pow(10, places); val = round(val); val = val / pow(10, places); return val; }

void CalculateAZ() { double DTOR, RTOD, A, B, F, RSAT, ESHEIGHT, ESLAT, ESLONG, SATLAT, SATLONG, XS, YS, ZS, EE, BETA, RHO; double TXS, TYS, TZS, DIST, AZ, XS2, YS2, ZS2, TXS2, TYS2, TZS2, DIST2, RANGE; DTOR = M_PI / 180; RTOD = 180 / M_PI; A = 6378.3880; B = 6356.9120; F = 1 / 297; RSAT = pow((6028.82 * ((24 * 60) - 4)), 2 / 3); printf("Enter ESHEIGHT: "); scanf("%lf", &ESHEIGHT); printf("Enter ESLAT: "); scanf("%lf", &ESLAT); printf("Enter ESLONG: "); scanf("%lf", &ESLONG); printf("Enter SATLAT: "); scanf("%lf", &SATLAT); printf("Enter SATLONG: "); scanf("%lf", &SATLONG); XS = RSAT * cos(DTOR * SATLAT) * cos(DTOR * SATLONG); XS2 = RSAT * cos(-SATLAT * DTOR) * cos(SATLONG * DTOR); YS = RSAT * cos(DTOR * SATLAT) * sin(DTOR * SATLONG); YS2 = RSAT * cos(-SATLAT * DTOR) * sin(SATLONG * DTOR); ZS = RSAT * sin(DTOR * SATLAT); ZS2 = -RSAT * sin(DTOR * SATLAT); EE = 2 * F - pow(F, 2); BETA = atan((1 - EE) * tan(ESLAT * DTOR)); RHO = A * (1 - F) / sqrt(1 - (2 - F) * F * cos(ESLAT * DTOR) * cos(ESLAT * DTOR)); TXS = (XS * cos(ESLONG * DTOR) + YS * sin(ESLONG * DTOR) - RHO * cos(BETA)) * sin(ESLAT * DTOR) - (ZS - RHO * sin(BETA)) * cos(ESLAT * DTOR); TXS2 = (XS2 * cos(ESLONG * DTOR) + YS2 * sin(ESLONG * DTOR) - RHO * cos(BETA)) * sin(ESLAT * DTOR) - (ZS2 - RHO * sin(BETA)) * cos(ESLAT * DTOR); TYS = -XS * sin(ESLONG * DTOR) + YS * cos(ESLONG * DTOR); TYS2 = -XS2 * sin(ESLONG * DTOR) + YS2 * cos(ESLONG * DTOR); TZS = (XS * cos(ESLONG * DTOR) + YS * sin(ESLONG * DTOR) - RHO * cos(BETA)) * cos(ESLAT * DTOR) + (ZS - RHO * sin(BETA)) * sin(ESLAT * DTOR) - (ESHEIGHT / 1000); TZS2 = (XS2 * cos(ESLONG * DTOR) + YS2 * sin(ESLONG * DTOR) - RHO * cos(BETA)) * cos(ESLAT * DTOR) + (ZS2 - RHO * sin(BETA)) * sin(ESLAT * DTOR) - (ESHEIGHT / 1000); DIST = sqrt(TXS * TXS + TYS * TYS + TZS * TZS); DIST2 = sqrt(TXS2 * TXS2 + TYS2 * TYS2 + TZS2 * TZS2); AZ = 180 - RTOD * ATAN2(TXS, TYS); double EL = asin(TZS / DIST) * RTOD; RANGE = fmax(DIST, DIST2); printf("AZ: %.3lf\n", round(AZ, 3)); printf("EL: %.3lf\n", round(EL, 3)); printf("RANGE: %.3lf\n", round(RANGE, 3)); }

int main() { CalculateAZ(); return 0;

function CalculateAZ var DTOR RTOD A B F RSAT ESHEIGHT ESLAT ESLONG SATLAT SATLONG XS YS ZS EE BETA RHO; var TXS TYS TZS DIST AZ XS2 YS2 ZS2 TXS2 TYS2 TZS2 DIST2 RANGE; DTOR = MathPI 180; RTOD =

原文地址: https://www.cveoy.top/t/topic/iEHI 著作权归作者所有。请勿转载和采集!

免费AI点我,无需注册和登录