geodeticframes.cpp

1 gps基本算法

		dpsi += (-0.001671 + 0.000008*T) * ::sin(arg) - 0.000001 * ::cos(arg);
		deps += 0.000014 * ::cos(arg) - 0.000001 * ::sin(arg);
		// line 35 of Table 5.2, period = 5.64 days
		arg = l+2*f+2*d+2*o;
		dpsi -= 0.000768 * ::sin(arg) + 0.000004 * ::cos(arg);
		deps += 0.000325 * ::cos(arg) + 0.000002 * ::sin(arg);
		// line 36 of Table 5.2, period = 1095.18 days
		arg = -2*l+2*f;
		dpsi -= 0.001102 * ::sin(arg) - 0.000001 * ::cos(arg);
		deps += 0.000010 * ::cos(arg);
/*
		// line 37 of Table 5.2, period = 13.17 days
		arg = lp+2*f+2*o;
		dpsi += (+0.000757 - 0.000002*T) * ::sin(arg) - 0.000001 * ::cos(arg);
		deps += (-0.000326 - 0.000002*T) * ::cos(arg);
		// line 38 of Table 5.2, period = 7.09 days
		arg = 2*f+2*d+o;
		dpsi += (-0.000664 - 0.000001*T) * ::sin(arg) + 0.000002 * ::cos(arg);
		deps += (+0.000335 - 0.000001*T) * ::cos(arg) + 0.000001 * ::sin(arg);
		// line 39 of Table 5.2, period = 14.19 days
		arg = -lp+2*f+2*o;
		dpsi += (-0.000714 + 0.000002*T) * ::sin(arg) + 0.000001 * ::cos(arg);
		deps += (+0.000307 + 0.000002*T) * ::cos(arg);
		// line 40 of Table 5.2, period = 14.80 days
		arg = 2*d+o;
		dpsi += (-0.000631 - 0.000001*T) * ::sin(arg);
		deps += 0.000327 * ::cos(arg);
		// line 41 of Table 5.2, period = 23.86 days
		arg = l+2*f-2*d+o;
		dpsi += (+0.000580 + 0.000001*T) * ::sin(arg);
		deps -= 0.000307 * ::cos(arg);
		// line 42 of Table 5.2, period = 12.81 days
		arg = 2*l+2*f-2*d+2*o;
		dpsi += 0.000643 * ::sin(arg) - 0.000001 * ::cos(arg);
		deps -= 0.000277 * ::cos(arg);
		// line 43 of Table 5.2, period = -199.84 days
		arg = -2*l+2*d+o;
		dpsi += (-0.000579 - 0.000001*T) * ::sin(arg) - 0.000001 * ::cos(arg);
		deps += 0.000304 * ::cos(arg);
		// line 44 of Table 5.2, period = 6.85 days
		arg = 2*l+2*f+o;
		dpsi -= 0.000533 * ::sin(arg) + 0.000002 * ::cos(arg);
		deps += 0.000269 * ::cos(arg) + 0.000001 * ::sin(arg);
		// line 45 of Table 5.2, period = 346.60 days
		arg = -lp+2*f-2*d+o;
		dpsi += (-0.000477 - 0.000001*T) * ::sin(arg);
		deps += (+0.000271 - 0.000001*T) * ::cos(arg);
		// line 46 of Table 5.2, period = -14.73 days
		arg = -2*d+o;
		dpsi += (-0.000493 - 0.000001*T) * ::sin(arg) - 0.000002 * ::cos(arg);
		deps += 0.000272 * ::cos(arg) - 0.000001 * ::sin(arg);
		// line 47 of Table 5.2, period = 34.85 days
		arg = -l-lp+2*d;
		dpsi += 0.000735 * ::sin(arg) - 0.000001 * ::cos(arg);
		deps -= 0.000005 * ::cos(arg);
		// line 48 of Table 5.2, period = 212.32 days
		arg = 2*l-2*d+o;
		dpsi += 0.000405 * ::sin(arg) + 0.000001 * ::cos(arg);
		deps -= 0.000220 * ::cos(arg);
		// line 49 of Table 5.2, period = 9.61 days
		arg = l+2*d;
		dpsi += 0.000657 * ::sin(arg) - 0.000002 * ::cos(arg);
		deps -= 0.000020 * ::cos(arg);
		// line 50 of Table 5.2, period = 119.61 days
		arg = lp+2*f-2*d+o;
		dpsi += 0.000361 * ::sin(arg) + 0.000001 * ::cos(arg);
		deps -= 0.000194 * ::cos(arg);
		// line 51 of Table 5.2, period = 29.80 days
		arg = l-lp;
		dpsi += 0.000471 * ::sin(arg) - 0.000001 * ::cos(arg);
		deps -= 0.000004 * ::cos(arg);
		// line 52 of Table 5.2, period = 1615.76 days
		arg = -2*l+2*f+2*o;
		dpsi -= 0.000311 * ::sin(arg);
		deps += 0.000131 * ::cos(arg);
		// line 53 of Table 5.2, period = 5.49 days
		arg = 3*l+2*f+2*o;
		dpsi -= 0.000289 * ::sin(arg) + 0.000002 * ::cos(arg);
		deps += 0.000124 * ::cos(arg) + 0.000001 * ::sin(arg);
		// line 54 of Table 5.2, period = 15.39 days
		arg = -lp+2*d;
		dpsi += 0.000435 * ::sin(arg) - 0.000001 * ::cos(arg);
		deps -= 0.000009 * ::cos(arg);
		// line 55 of Table 5.2, period = 9.37 days
		arg = l-lp+2*f+2*o;
		dpsi -= 0.000287 * ::sin(arg) + 0.000001 * ::cos(arg);
		deps += 0.000123 * ::cos(arg);
		// line 56 of Table 5.2, period = 9.81 days
		arg = -l-lp+2*f+2*d+2*o;
		dpsi -= 0.000282 * ::sin(arg) + 0.000001 * ::cos(arg);
		deps += 0.000122 * ::cos(arg);
		// line 57 of Table 5.2, period = 29.53 days
		arg = d;
		dpsi -= 0.000422 * ::sin(arg) + 0.000001 * ::cos(arg);
		deps += 0.000003 * ::cos(arg);
		// line 58 of Table 5.2, period = 26.88 days
		arg = -l+2*f;
		dpsi -= 0.000404 * ::sin(arg) + 0.000001 * ::cos(arg);
		deps += 0.000004 * ::cos(arg);
		// line 59 of Table 5.2, period = 7.24 days
		arg = -lp+2*f+2*d+2*o;
		dpsi -= 0.000264 * ::sin(arg) + 0.000001 * ::cos(arg);
		deps += 0.000114 * ::cos(arg);
		// line 60 of Table 5.2, period = -13.75 days
		arg = -2*l+o;
		dpsi -= 0.000228 * ::sin(arg) - 0.000001 * ::cos(arg);
		deps += 0.000126 * ::cos(arg);
		// line 61 of Table 5.2, period = 8.91 days
		arg = l+lp+2*f+2*o;
		dpsi += 0.000246 * ::sin(arg) - 0.000001 * ::cos(arg);
		deps -= 0.000106 * ::cos(arg);
		// line 62 of Table 5.2, period = 13.81 days
		arg = 2*l+o;
		dpsi += 0.000218 * ::sin(arg);
		deps -= 0.000114 * ::cos(arg);
		// line 63 of Table 5.2, period = 3232.87 days
		arg = -l+lp+d;
		dpsi += 0.000327 * ::sin(arg);
		deps -= 0.000001 * ::cos(arg);
		// line 64 of Table 5.2, period = 25.62 days
		arg = l+lp;
		dpsi -= 0.000338 * ::sin(arg);
		deps += 0.000004 * ::cos(arg);
		// line 65 of Table 5.2, period = 9.11 days
		arg = l+2*f;
		dpsi += 0.000334 * ::sin(arg) - 0.000001 * ::cos(arg);
		deps -= 0.000011 * ::cos(arg);
		// line 66 of Table 5.2, period = -32.61 days
		arg = -l+2*f-2*d+o;
		dpsi -= 0.000199 * ::sin(arg) - 0.000001 * ::cos(arg);
		deps += 0.000107 * ::cos(arg);
		// line 67 of Table 5.2, period = 27.78 days
		arg = l+2*o;
		dpsi -= 0.000197 * ::sin(arg);
		deps += 0.000085 * ::cos(arg);
		// line 68 of Table 5.2, period = -411.78 days
		arg = -l+d;
		dpsi += 0.000405 * ::sin(arg) - 0.000035 * ::cos(arg);
		deps -= 0.000055 * ::cos(arg) - 0.000014 * ::sin(arg);
		// line 69 of Table 5.2, period = 9.34 days
		arg = 2*f+d+2*o;
		dpsi += 0.000165 * ::sin(arg);
		deps -= 0.000072 * ::cos(arg);
		// line 70 of Table 5.2, period = 5.80 days
		arg = -l+2*f+4*d+2*o;
		dpsi -= 0.000151 * ::sin(arg) + 0.000001 * ::cos(arg);
		deps += 0.000066 * ::cos(arg);
		// line 71 of Table 5.2, period = 6786.31 days
		arg = -2*lp+2*f-2*d+o;
		dpsi -= 0.000130 * ::sin(arg);
		deps += 0.000069 * ::cos(arg);
		// line 72 of Table 5.2, period = 6164.17 days
		arg = -l+lp+d+o;
		dpsi += 0.000132 * ::sin(arg);
		deps -= 0.000068 * ::cos(arg);
		// line 73 of Table 5.2, period = 5.64 days
		arg = l+2*f+2*d+o;
		dpsi -= 0.000133 * ::sin(arg) + 0.000001 * ::cos(arg);
		deps += 0.000066 * ::cos(arg);
		// line 74 of Table 5.2, period = 14.63 days
		arg = -2*l+2*f+2*d+2*o;
		dpsi += 0.000139 * ::sin(arg);
		deps -= 0.000060 * ::cos(arg);
		// line 75 of Table 5.2, period = -27.33 days
		arg = -l+2*o;
		dpsi += 0.000139 * ::sin(arg);
		deps -= 0.000060 * ::cos(arg);
		// line 76 of Table 5.2, period = 22.47 days
		arg = l+lp+2*f-2*d+2*o;
		dpsi += 0.000128 * ::sin(arg);
		deps -= 0.000055 * ::cos(arg);
		// line 77 of Table 5.2, period = 7.35 days
		arg = -2*l+2*f+4*d+2*o;
		dpsi -= 0.000121 * ::sin(arg);
		deps += 0.000052 * ::cos(arg);
		// line 78 of Table 5.2, period = 9.06 days
		arg = -l+4*f+2*o;
		dpsi += 0.000115 * ::sin(arg);
		deps -= 0.000049 * ::cos(arg);
		// line 79 of Table 5.2, period = 12.79 days
		arg = 2*l+2*f-2*d+o;
		dpsi += 0.000101 * ::sin(arg);
		deps -= 0.000054 * ::cos(arg);
		// line 80 of Table 5.2, period = 4.68 days
		arg = 2*l+2*f+2*d+2*o;
		dpsi -= 0.000108 * ::sin(arg) + 0.000001 * ::cos(arg);
		deps += 0.000047 * ::cos(arg);
		// line 81 of Table 5.2, period = 9.63 days
		arg = l+2*d+o;
		dpsi -= 0.000095 * ::sin(arg);
		deps += 0.000049 * ::cos(arg);
		// line 82 of Table 5.2, period = 9.18 days
		arg = 3*l;
		dpsi += 0.000157 * ::sin(arg) - 0.000001 * ::cos(arg);
		deps -= 0.000005 * ::cos(arg);
		// line 83 of Table 5.2, period = 8.75 days
		arg = 3*l+2*f-2*d+2*o;
		dpsi += 0.000094 * ::sin(arg);
		deps -= 0.000040 * ::cos(arg);
		// line 84 of Table 5.2, period = 12.66 days
		arg = 4*f-2*d+2*o;
		dpsi += 0.000091 * ::sin(arg);
		deps -= 0.000039 * ::cos(arg);
		// line 85 of Table 5.2, period = -169.00 days
		arg = -2*f+2*d+o;
		dpsi += 0.000087 * ::sin(arg);
		deps -= 0.000044 * ::cos(arg);
		// line 86 of Table 5.2, period = 13.14 days
		arg = lp+2*f+o;
		dpsi += 0.000081 * ::sin(arg);
		deps -= 0.000042 * ::cos(arg);
		// line 87 of Table 5.2, period = 187.66 days
		arg = 2*f-2*d+3*o;
		dpsi += 0.000123 * ::sin(arg);
		deps -= 0.000020 * ::cos(arg);
		// line 88 of Table 5.2, period = 10.08 days
		arg = -l+4*d;
		dpsi += 0.000133 * ::sin(arg);
		deps -= 0.000004 * ::cos(arg);
		// line 89 of Table 5.2, period = -943.23 days
		arg = 2*l-2*f+o;
		dpsi += 0.000071 * ::sin(arg);
		deps -= 0.000038 * ::cos(arg);
		// line 90 of Table 5.2, period = -15.91 days
		arg = 2*l-4*d;
		dpsi -= 0.000128 * ::sin(arg);
		deps += 0.000001 * ::cos(arg);
		// line 91 of Table 5.2, period = 35.03 days
		arg = -l-lp+2*d+o;
		dpsi += 0.000075 * ::sin(arg);
		deps -= 0.000039 * ::cos(arg);
		// line 92 of Table 5.2, period = -131.67 days
		arg = -2*l-lp+2*d;
		dpsi -= 0.000115 * ::sin(arg);
		deps += 0.000001 * ::cos(arg);
		// line 93 of Table 5.2, period = 14.16 days
		arg = -lp+2*f+o;
		dpsi -= 0.000066 * ::sin(arg);
		deps += 0.000035 * ::cos(arg);
		// line 94 of Table 5.2, period = -388.27 days
		arg = -l+d+o;
		dpsi += 0.000101 * ::sin(arg) - 0.000003 * ::cos(arg);
		deps -= 0.000049 * ::cos(arg) - 0.000001 * ::sin(arg);
		// line 95 of Table 5.2, period = -13.58 days
		arg = -2*f+o;
		dpsi -= 0.000068 * ::sin(arg);
		deps += 0.000036 * ::cos(arg);
		// line 96 of Table 5.2, period = 409.23 days
		arg = lp+2*o;
		dpsi += 0.000069 * ::sin(arg) - 0.000001 * ::cos(arg);
		deps -= 0.000033 * ::cos(arg);
		// line 97 of Table 5.2, period = 25.42 days
		arg = 2*f-d+2*o;
		dpsi -= 0.000074 * ::sin(arg);
		deps += 0.000031 * ::cos(arg);
		// line 98 of Table 5.2, period = 4.79 days
		arg = 2*f+4*d+2*o;
		dpsi -= 0.000069 * ::sin(arg);
		deps += 0.000029 * ::cos(arg);
		// line 99 of Table 5.2, period = -34.67 days
		arg = l+lp-2*d+o;
		dpsi -= 0.000061 * ::sin(arg);
		deps += 0.000032 * ::cos(arg);
		// line 100 of Table 5.2, period = 29.26 days
		arg = -l+lp+2*d;
		dpsi -= 0.000094 * ::sin(arg);
		// line 101 of Table 5.2, period = 5.73 days
		arg = l-lp+2*f+2*d+2*o;
		dpsi -= 0.000059 * ::sin(arg);
		deps += 0.000025 * ::cos(arg);
		// line 102 of Table 5.2, period = 29.93 days
		arg = l-lp+o;
		dpsi += 0.000051 * ::sin(arg);
		deps -= 0.000027 * ::cos(arg);
		// line 103 of Table 5.2, period = -329.79 days
		arg = lp-2*f+2*d;
		dpsi -= 0.000090 * ::sin(arg);
		deps += 0.000003 * ::cos(arg);
		// line 104 of Table 5.2, period = 5.49 days
		arg = 3*l+2*f+o;
		dpsi -= 0.000050 * ::sin(arg);
		deps += 0.000025 * ::cos(arg);
		// line 105 of Table 5.2, period = 9.31 days
		arg = -l+lp+2*f+2*d+2*o;
		dpsi += 0.000056 * ::sin(arg);
		deps -= 0.000024 * ::cos(arg);
		// line 106 of Table 5.2, period = 6.96 days
		arg = lp+2*f+2*d+2*o;
		dpsi += 0.000054 * ::sin(arg);
		deps -= 0.000022 * ::cos(arg);
		// line 107 of Table 5.2, period = -9.60 days
		arg = -l-2*d+o;
		dpsi -= 0.000050 * ::sin(arg);
		deps += 0.000027 * ::cos(arg);
		// line 108 of Table 5.2, period = 66079.30 days
		arg = -l+lp+d+2*o;
		dpsi -= 0.000052 * ::sin(arg);
		deps += 0.000023 * ::cos(arg);
		// line 109 of Table 5.2, period = 7.23 days
		arg = -lp+2*f+2*d+o;
		dpsi -= 0.000044 * ::sin(arg);
		deps += 0.000024 * ::cos(arg);
		// line 110 of Table 5.2, period = -38.74 days
		arg = l+2*f-4*d+o;
		dpsi -= 0.000047 * ::sin(arg);
		deps += 0.000024 * ::cos(arg);
		// line 111 of Table 5.2, period = -23.77 days
		arg = -l-2*f+2*d;
		dpsi += 0.000077 * ::sin(arg);
		// line 112 of Table 5.2, period = 9.80 days
		arg = -l-lp+2*f+2*d+o;
		dpsi -= 0.000046 * ::sin(arg);
		deps += 0.000024 * ::cos(arg);
		// line 113 of Table 5.2, period = -329.82 days
		arg = -lp+2*o;
		dpsi += 0.000059 * ::sin(arg);
		deps -= 0.000025 * ::cos(arg);
		// line 114 of Table 5.2, period = 6.99 days
		arg = 2*l-lp+2*f+2*o;
		dpsi -= 0.000048 * ::sin(arg);
		deps += 0.000021 * ::cos(arg);
		// line 115 of Table 5.2, period = 9.35 days
		arg = l-lp+2*f+o;
		dpsi -= 0.000042 * ::sin(arg);
		deps += 0.000022 * ::cos(arg);
		// line 116 of Table 5.2, period = 14.83 days
		arg = 2*d+2*o;
		dpsi -= 0.000046 * ::sin(arg);
		deps += 0.000020 * ::cos(arg);
		// line 117 of Table 5.2, period = 14.19 days
		arg = lp+2*d;
		dpsi -= 0.000067 * ::sin(arg);
		// line 118 of Table 5.2, period = 25.22 days
		arg = -l+lp+2*f+2*o;
		dpsi += 0.000047 * ::sin(arg);
		deps -= 0.000020 * ::cos(arg);
		// line 119 of Table 5.2, period = 73.05 days
		arg = 3*lp+2*f-2*d+2*o;
		dpsi -= 0.000044 * ::sin(arg);
		deps += 0.000019 * ::cos(arg);
		// line 120 of Table 5.2, period = -117.54 days
		arg = -lp-2*f+2*d;
		dpsi += 0.000066 * ::sin(arg);
		// line 121 of Table 5.2, period = 29.66 days
		arg = d+o;
		dpsi -= 0.000037 * ::sin(arg);
		deps += 0.000020 * ::cos(arg);
		// line 122 of Table 5.2, period = -9.53 days
		arg = l-2*f-2*d;
		dpsi -= 0.000064 * ::sin(arg);