geodeticframes.cpp

1 gps基本算法

		deps += 0.000001 * ::cos(arg);
		// line 123 of Table 5.2, period = 8.90 days
		arg = l+lp+2*f+o;
		dpsi += 0.000036 * ::sin(arg);
		deps -= 0.000018 * ::cos(arg);
		// line 124 of Table 5.2, period = 6.73 days
		arg = 2*l+lp+2*f+2*o;
		dpsi += 0.000040 * ::sin(arg);
		deps -= 0.000017 * ::cos(arg);
		// line 125 of Table 5.2, period = 27.32 days
		arg = lp+d;
		dpsi += 0.000057 * ::sin(arg);
		// line 126 of Table 5.2, period = 32.76 days
		arg = l-2*f+2*d;
		dpsi -= 0.000058 * ::sin(arg);
		// line 127 of Table 5.2, period = 25.72 days
		arg = l+lp+o;
		dpsi -= 0.000034 * ::sin(arg);
		deps += 0.000019 * ::cos(arg);
		// line 128 of Table 5.2, period = -7.13 days
		arg = -2*l-2*d;
		dpsi -= 0.000059 * ::sin(arg);
		deps += 0.000001 * ::cos(arg);
		// line 129 of Table 5.2, period = 32.11 days
		arg = -l+2*d+2*o;
		dpsi -= 0.000038 * ::sin(arg);
		deps += 0.000017 * ::cos(arg);
		// line 130 of Table 5.2, period = -29.40 days
		arg = -d+o;
		dpsi += 0.000033 * ::sin(arg);
		deps -= 0.000018 * ::cos(arg);
		// line 131 of Table 5.2, period = -15.35 days
		arg = lp-2*d+o;
		dpsi -= 0.000033 * ::sin(arg);
		deps += 0.000018 * ::cos(arg);
		// line 132 of Table 5.2, period = -32.45 days
		arg = -l+2*f-2*d+2*o;
		dpsi += 0.000036 * ::sin(arg);
		deps -= 0.000016 * ::cos(arg);
		// line 133 of Table 5.2, period = -29.67 days
		arg = -l+lp+o;
		dpsi -= 0.000031 * ::sin(arg);
		deps += 0.000017 * ::cos(arg);
		// line 134 of Table 5.2, period = 6.98 days
		arg = l+2*f+d+2*o;
		dpsi += 0.000033 * ::sin(arg);
		deps -= 0.000014 * ::cos(arg);
		// line 135 of Table 5.2, period = -7.38 days
		arg = -4*d;
		dpsi -= 0.000048 * ::sin(arg);
		deps += 0.000001 * ::cos(arg);
		// line 136 of Table 5.2, period = 9.33 days
		arg = 2*f+d+o;
		dpsi += 0.000027 * ::sin(arg);
		deps -= 0.000014 * ::cos(arg);
		// line 137 of Table 5.2, period = -31.52 days
		arg = l-2*d+2*o;
		dpsi += 0.000032 * ::sin(arg);
		deps -= 0.000014 * ::cos(arg);
		// line 138 of Table 5.2, period = 13.22 days
		arg = l+2*f-d+2*o;
		dpsi -= 0.000033 * ::sin(arg);
		deps += 0.000013 * ::cos(arg);
		// line 139 of Table 5.2, period = 9.87 days
		arg = l-lp+2*d;
		dpsi += 0.000048 * ::sin(arg);
		// line 140 of Table 5.2, period = 5.80 days
		arg = -l+2*f+4*d+o;
		dpsi -= 0.000026 * ::sin(arg);
		deps += 0.000013 * ::cos(arg);
		// line 141 of Table 5.2, period = -7.08 days
		arg = -2*f-2*d;
		dpsi -= 0.000041 * ::sin(arg);
		deps += 0.000001 * ::cos(arg);
		// line 142 of Table 5.2, period = -26.77 days
		arg = l-2*f+o;
		dpsi += 0.000027 * ::sin(arg);
		deps -= 0.000014 * ::cos(arg);
		// line 143 of Table 5.2, period = 313.04 days
		arg = -l+2*f-d+o;
		dpsi -= 0.000023 * ::sin(arg);
		deps += 0.000014 * ::cos(arg);
		// line 144 of Table 5.2, period = 22.40 days
		arg = l+lp+2*f-2*d+o;
		dpsi += 0.000023 * ::sin(arg);
		deps -= 0.000012 * ::cos(arg);
		// line 145 of Table 5.2, period = 4.58 days
		arg = 4*l+2*f+2*o;
		dpsi -= 0.000026 * ::sin(arg);
		deps += 0.000011 * ::cos(arg);
		// line 146 of Table 5.2, period = 9.11 days
		arg = lp+2*f+d+2*o;
		dpsi -= 0.000024 * ::sin(arg);
		deps += 0.000010 * ::cos(arg);
		// line 147 of Table 5.2, period = -6.85 days
		arg = -2*l-2*f;
		dpsi -= 0.000036 * ::sin(arg);
		deps += 0.000001 * ::cos(arg);
		// line 148 of Table 5.2, period = 12.38 days
		arg = 2*l+lp+2*f-2*d+2*o;
		dpsi += 0.000025 * ::sin(arg);
		deps -= 0.000010 * ::cos(arg);
		// line 149 of Table 5.2, period = 14.32 days
		arg = 2*l-lp;
		dpsi += 0.000038 * ::sin(arg);
		// line 150 of Table 5.2, period = -25.53 days
		arg = -l-lp+o;
		dpsi += 0.000021 * ::sin(arg);
		deps -= 0.000012 * ::cos(arg);
		// line 151 of Table 5.2, period = 14.60 days
		arg = -2*l+2*f+2*d+o;
		dpsi += 0.000022 * ::sin(arg);
		deps -= 0.000011 * ::cos(arg);
		// line 152 of Table 5.2, period = -2266.12 days
		arg = 3*o;
		dpsi -= 0.000022 * ::sin(arg);
		deps += 0.000010 * ::cos(arg);
		// line 153 of Table 5.2, period = 8.68 days
		arg = l+4*f-2*d+2*o;
		dpsi += 0.000023 * ::sin(arg);
		deps -= 0.000009 * ::cos(arg);
		// line 154 of Table 5.2, period = 4.68 days
		arg = 2*l+2*f+2*d+o;
		dpsi -= 0.000019 * ::sin(arg);
		deps += 0.000010 * ::cos(arg);
		// line 155 of Table 5.2, period = 7.34 days
		arg = -2*l+2*f+4*d+o;
		dpsi -= 0.000020 * ::sin(arg);
		deps += 0.000010 * ::cos(arg);
		// line 156 of Table 5.2, period = 14.22 days
		arg = lp+2*d+o;
		dpsi += 0.000018 * ::sin(arg);
		deps -= 0.000009 * ::cos(arg);
		// line 157 of Table 5.2, period = 14.25 days
		arg = l+d;
		dpsi -= 0.000033 * ::sin(arg);
		// line 158 of Table 5.2, period = 10.10 days
		arg = -l+4*d+o;
		dpsi -= 0.000018 * ::sin(arg);
		deps += 0.000009 * ::cos(arg);
		// line 159 of Table 5.2, period = 9.05 days
		arg = -l+4*f+o;
		dpsi += 0.000019 * ::sin(arg);
		deps -= 0.000009 * ::cos(arg);
		// line 160 of Table 5.2, period = -35.23 days
		arg = 2*f-3*d+2*o;
		dpsi -= 0.000020 * ::sin(arg);
		deps += 0.000008 * ::cos(arg);
		// line 161 of Table 5.2, period = 6.82 days
		arg = 4*f+2*o;
		dpsi += 0.000019 * ::sin(arg);
		deps -= 0.000008 * ::cos(arg);
		// line 162 of Table 5.2, period = 13.28 days
		arg = 2*l+lp;
		dpsi -= 0.000028 * ::sin(arg);
		// line 163 of Table 5.2, period = -16.10 days
		arg = 2*f-4*d+o;
		dpsi -= 0.000016 * ::sin(arg);
		deps += 0.000009 * ::cos(arg);
		// line 164 of Table 5.2, period = 5.90 days
		arg = -l-lp+2*f+4*d+2*o;
		dpsi -= 0.000017 * ::sin(arg);
		deps += 0.000007 * ::cos(arg);
		// line 165 of Table 5.2, period = 38.52 days
		arg = -l-2*lp+2*d;
		dpsi += 0.000027 * ::sin(arg);
		// line 166 of Table 5.2, period = 7.39 days
		arg = 4*d+o;
		dpsi -= 0.000016 * ::sin(arg);
		deps += 0.000007 * ::cos(arg);
		// line 167 of Table 5.2, period = 15.42 days
		arg = -lp+2*d+o;
		dpsi -= 0.000014 * ::sin(arg);
		deps += 0.000007 * ::cos(arg);
		// line 168 of Table 5.2, period = 4.08 days
		arg = l+2*f+4*d+2*o;
		dpsi -= 0.000016 * ::sin(arg);
		deps += 0.000007 * ::cos(arg);
		// line 169 of Table 5.2, period = -194.13 days
		arg = -2*l+2*d+2*o;
		dpsi += 0.000018 * ::sin(arg);
		deps -= 0.000008 * ::cos(arg);
		// line 170 of Table 5.2, period = 1616.44 days
		arg = -2*l+2*lp+2*d;
		dpsi -= 0.000022 * ::sin(arg);
		// line 171 of Table 5.2, period = -507.16 days
		arg = -2*l-lp+2*f+o;
		dpsi += 0.000009 * ::sin(arg);
		deps -= 0.000005 * ::cos(arg);
		// line 172 of Table 5.2, period = -9.17 days
		arg = -3*l+o;
		dpsi -= 0.000014 * ::sin(arg);
		deps += 0.000007 * ::cos(arg);
		// line 173 of Table 5.2, period = 13.69 days
		arg = 2*f+3*o;
		dpsi += 0.000020 * ::sin(arg);
		// line 174 of Table 5.2, period = 4.79 days
		arg = 2*f+4*d+o;
		dpsi -= 0.000012 * ::sin(arg);
		deps += 0.000006 * ::cos(arg);
		// line 175 of Table 5.2, period = 12.64 days
		arg = 4*f-2*d+o;
		dpsi += 0.000012 * ::sin(arg);
		deps -= 0.000007 * ::cos(arg);
		// line 176 of Table 5.2, period = 16.06 days
		arg = -2*lp+2*d;
		dpsi += 0.000021 * ::sin(arg);
		// line 177 of Table 5.2, period = 438.33 days
		arg = l-d+o;
		dpsi += 0.000017 * ::sin(arg) - 0.000003 * ::cos(arg);
		deps -= 0.000005 * ::cos(arg) + 0.000001 * ::sin(arg);
		// line 178 of Table 5.2, period = 5.56 days
		arg = l+lp+2*f+2*d+2*o;
		dpsi += 0.000015 * ::sin(arg);
		deps -= 0.000006 * ::cos(arg);
		// line 179 of Table 5.2, period = 8.73 days
		arg = 3*l+2*f-2*d+o;
		dpsi += 0.000012 * ::sin(arg);
		deps -= 0.000007 * ::cos(arg);
		// line 180 of Table 5.2, period = 29.26 days
		arg = -l-lp+2*f+2*o;
		dpsi -= 0.000016 * ::sin(arg);
		deps += 0.000006 * ::cos(arg);
		// line 181 of Table 5.2, period = -129.17 days
		arg = -2*l-lp+2*d+o;
		dpsi -= 0.000013 * ::sin(arg);
		deps += 0.000007 * ::cos(arg);
		// line 182 of Table 5.2, period = -14.70 days
		arg = -2*d+2*o;
		dpsi += 0.000013 * ::sin(arg);
		deps -= 0.000005 * ::cos(arg);
		// line 183 of Table 5.2, period = 7.38 days
		arg = -2*lp+2*f+2*d+2*o;
		dpsi -= 0.000013 * ::sin(arg);
		deps += 0.000005 * ::cos(arg);
		// line 184 of Table 5.2, period = -10.07 days
		arg = l-4*d+o;
		dpsi -= 0.000012 * ::sin(arg);
		deps += 0.000006 * ::cos(arg);
		// line 185 of Table 5.2, period = 29.39 days
		arg = -l+lp+2*d+o;
		dpsi -= 0.000010 * ::sin(arg);
		deps += 0.000006 * ::cos(arg);
		// line 186 of Table 5.2, period = 15.94 days
		arg = -2*l+4*d+o;
		dpsi += 0.000011 * ::sin(arg);
		deps -= 0.000006 * ::cos(arg);
		// line 187 of Table 5.2, period = 25.33 days
		arg = 2*f-d+o;
		dpsi -= 0.000010 * ::sin(arg);
		deps += 0.000005 * ::cos(arg);
		// line 188 of Table 5.2, period = 187.67 days
		arg = 2*lp+o;
		dpsi -= 0.000009 * ::sin(arg);
		deps += 0.000005 * ::cos(arg);
		// line 189 of Table 5.2, period = 90.10 days
		arg = 2*lp+2*f-2*d+o;
		dpsi += 0.000008 * ::sin(arg);
		deps -= 0.000005 * ::cos(arg);
		// line 190 of Table 5.2, period = 7.13 days
		arg = 2*l+2*d+o;
		dpsi -= 0.000009 * ::sin(arg);
		deps += 0.000005 * ::cos(arg);
		// line 191 of Table 5.2, period = -15.87 days
		arg = 2*l-4*d+o;
		dpsi -= 0.000011 * ::sin(arg);
		deps += 0.000005 * ::cos(arg);
		// line 192 of Table 5.2, period = 95.42 days
		arg = 2*l+2*f-4*d+o;
		dpsi += 0.000010 * ::sin(arg);
		deps -= 0.000005 * ::cos(arg);
		// line 193 of Table 5.2, period = -9.10 days
		arg = -l-2*f+o;
		dpsi -= 0.000010 * ::sin(arg);
		deps += 0.000005 * ::cos(arg);
		// line 194 of Table 5.2, period = 25.13 days
		arg = -l+lp+2*f+o;
		dpsi += 0.000009 * ::sin(arg);
		deps -= 0.000005 * ::cos(arg);
		// line 195 of Table 5.2, period = -35.80 days
		arg = -l+lp+2*f-2*d+o;
		dpsi -= 0.000011 * ::sin(arg);
		deps += 0.000005 * ::cos(arg);
		// line 196 of Table 5.2, period = 10.37 days
		arg = -l-lp+4*d;
		dpsi += 0.000015 * ::sin(arg);
		// line 197 of Table 5.2, period = 37.63 days
		arg = -3*l+4*d;
		dpsi += 0.000016 * ::sin(arg);
		// line 198 of Table 5.2, period = 4.00 days
		arg = 3*l+2*f+2*d+2*o;
		dpsi -= 0.000014 * ::sin(arg);
		// line 199 of Table 5.2, period = 471.89 days
		arg = 2*l-lp-2*d;
		dpsi -= 0.000009 * ::sin(arg) - 0.000001 * ::cos(arg);
		deps += 0.000001 * ::cos(arg);
		// line 200 of Table 5.2, period = -3396.16 days
		arg = 2*lp-2*f+2*d;
		dpsi -= 0.000009 * ::sin(arg);
		// line 201 of Table 5.2, period = 4.86 days
		arg = -lp+2*f+4*d+2*o;
		dpsi -= 0.000009 * ::sin(arg);
		// line 202 of Table 5.2, period = 27.32 days
		arg = -lp+2*f-d+2*o;
		dpsi += 0.000009 * ::sin(arg);
		// line 203 of Table 5.2, period = 9.37 days
		arg = l+lp+2*d;
		dpsi -= 0.000010 * ::sin(arg);
		// line 204 of Table 5.2, period = 219.17 days
		arg = 2*l-2*d+2*o;
		dpsi -= 0.000011 * ::sin(arg);
		// line 205 of Table 5.2, period = 4.74 days
		arg = 2*l-lp+2*f+2*d+2*o;
		dpsi -= 0.000009 * ::sin(arg);
		// line 206 of Table 5.2, period = 6.89 days
		arg = 4*l;
		dpsi += 0.000009 * ::sin(arg);
		// line 207 of Table 5.2, period = 6.64 days
		arg = 4*l+2*f-2*d+2*o;
		dpsi += 0.000012 * ::sin(arg);
		// line 208 of Table 5.2, period = 15.31 days
		arg = -l+3*d;
		dpsi -= 0.000010 * ::sin(arg);
		// line 209 of Table 5.2, period = 23.43 days
		arg = -l+4*f-2*d+2*o;
		dpsi -= 0.000009 * ::sin(arg);
		// line 210 of Table 5.2, period = 10.08 days
		arg = -l-2*lp+2*f+2*d+2*o;
		dpsi -= 0.000009 * ::sin(arg);
		// line 211 of Table 5.2, period = 16.63 days
		arg = -2*l-lp+4*d;
		dpsi += 0.000012 * ::sin(arg);
		// line 212 of Table 5.2, period = 7.50 days
		arg = -2*l-lp+2*f+4*d+2*o;
		dpsi -= 0.000012 * ::sin(arg);
		// line 213 of Table 5.2, period = 6.95 days
		arg = lp+2*f+2*d+o;
		dpsi += 0.000007 * ::sin(arg);
		// line 214 of Table 5.2, period = 12.71 days
		arg = 2*lp+2*f+2*o;
		dpsi += 0.000007 * ::sin(arg);
		// line 215 of Table 5.2, period = 14.77 days
		arg = -2*lp+2*f+2*o;
		dpsi -= 0.000008 * ::sin(arg);
		// line 216 of Table 5.2, period = 5.82 days
		arg = l+4*d;
		dpsi += 0.000008 * ::sin(arg);
		// line 217 of Table 5.2, period = 5.63 days
		arg = l+2*f+2*d;
		dpsi += 0.000008 * ::sin(arg);