34 0.0, -29351.8, -1410.8, 4545.4,
35 -2556.6, 2951.1, -3133.6, 1649.3, -815.1,
36 1361.0, -2404.1, -56.6, 1243.8, 237.5, 453.6, -549.5,
37 895.0, 799.5, 278.6, 55.7, -133.9, -281.1, 212.0, 12.1, -375.6,
38 -233.2, 368.9, 45.4, 187.2, 220.2, -138.7, -122.9, -142.0, 43.0, 20.9, 106.1,
39 64.4, 63.8, -18.4, 76.9, 16.8, -115.7, 48.8, -40.9, -59.8, 14.9, 10.9, -60.7, 72.7,
40 79.5, -77.0, -48.9, -8.8, -14.4, 59.3, -1.0, 15.8, 23.4, 2.5, -7.4, -11.1, -25.1, 14.2, -2.3,
41 23.2, 10.8, 7.1, -17.5 , -12.6, 2.0, 11.4, -21.7, -9.7, 16.9, 12.7, 15.0, 0.7, -16.8, -5.2, 0.9, 3.9,
42 4.6, 7.8, -24.8, 3.0, 12.2, -0.2, 8.3, -2.5, -3.3, -13.1, -5.2, 2.4, 7.2, 8.6, -0.6, -8.7, 0.8, -12.9, 10.0,
43 -1.3, -6.4, 3.3, 0.2, 0.0, 2.0, 2.4, -1.0, 5.3, -0.6, -9.1, -0.9, 0.4, 1.5, -4.2, 0.9, -3.8, -2.7, 0.9, -3.9, -9.1,
44 2.9, -1.5, 0.0, -2.5, 2.9, 2.4, -0.6, -0.6, 0.2, -0.1, 0.5, -0.6, -0.3, -0.1, -1.2, 1.1, -1.7, -1.0, -2.9, -0.2, -1.8, 2.6, -2.3,
45 -2.0, -0.2, -1.3, 0.3, 0.7, 1.2, 1.0, -1.3 , -1.4, 0.6, 0.0, 0.6, 0.6, 0.5, -0.1, -0.1, 0.8, -0.4, 0.1, -0.2, -1.0, -1.3, 0.1, -0.7, 0.2
50 0.0, 12.0, 9.7, -21.5,
51 -11.6, -5.2, -27.7, -8.0, -12.1,
52 -1.3, -4.2, 4.0, 0.4, -0.3, -15.6, -4.1,
53 -1.6, -2.4, -1.1, -6.0, 4.1, 5.6, 1.6, -7.0, -4.4,
54 0.6, 1.4, -0.5, 0.0, 2.2, 0.6, 0.4, 2.2, 1.7, 0.9, 1.9,
55 -0.2, -0.4, 0.3, 0.9, -1.6, 1.2, -0.4, -0.9, 0.9, 0.3, 0.7, 0.9, 0.9,
56 0.0, -0.1, 0.6, -0.1, 0.5, 0.5, -0.8, -0.1, 0.0, -0.8, -1.0, -0.8, 0.6, 0.8, -0.2,
57 -0.1, 0.2, -0.2, 0.0, 0.5, 0.5, -0.4, -0.1, 0.4, 0.3, -0.5, 0.2, -0.6, 0.0, 0.3, 0.2, 0.2,
58 0.0, -0.1, -0.3, 0.1, 0.3, 0.3, -0.3, -0.3, 0.3, 0.0, 0.2, 0.3, -0.1, -0.1, -0.2, 0.1, 0.4, -0.1, 0.1,
59 0.1, 0.0, 0.0, 0.1, 0.0, 0.1, -0.2, 0.0, 0.1, -0.3, -0.1, 0.0, 0.1, -0.1, 0.0, -0.1, -0.1, 0.0, 0.2, 0.0, -0.0,
60 0.0, 0.0, 0.0, 0.0, 0.1, 0.0, 0.0, 0.0, 0.1, -0.1, 0.0, 0.0, 0.0, 0.0, 0.1, -0.1, 0.0, -0.1, 0.0, -0.1, 0.0, -0.1, 0.0,
61 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, -0.1, 0.0, 0.1, 0.0, 0.0, 0.1, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, -0.1, 0.0, 0.0, 0.0, -0.1, -0.1
106 double *geo_mag_y,
double *geo_mag_z,
int16_t iext,
double ext1,
double ext2,
double ext3)
109 double earths_radius = 6371.2;
110 double dtr = 0.01745329;
114 double aa, bb, cc, dd;
131 int ii, j, k, l, m, n;
140 argument = flat * dtr;
141 slat = sinf(argument);
142 if ((90.0 - flat) < 0.001) {
145 if ((90.0 + flat) < 0.001) {
152 clat = cosf(argument);
153 argument = flon * dtr;
154 sl[1] = sinf(argument);
155 cl[1] = cosf(argument);
166 npq = (nmax * (nmax + 3)) / 2;
169 aa = a2 * clat * clat;
170 bb = b2 * slat * slat;
174 argument = elev * (elev + 2.0 * dd) + (a2 * aa + b2 * bb) / cc;
176 cd = (elev + dd) / r;
177 sd = (a2 - b2) / dd * slat * clat / r;
179 slat = slat * cd - clat * sd;
180 clat = clat * cd + aa * sd;
183 ratio = earths_radius / r;
188 p[3] = 4.5 * slat * slat - 1.5;
189 p[4] = 3.0 * aa * clat * slat;
192 q[3] = -3.0 * clat * slat;
193 q[4] = aa * (slat * slat - clat * clat);
195 for (k = 1; k <= npq; ++k) {
201 rr = pow(argument, power);
207 argument = (1.0 - 0.5 / fm);
210 p[k] = (1.0 + 1.0 / fm) * aa * clat *
p[j];
211 q[k] = aa * (clat * q[j] + slat / fm *
p[j]);
212 sl[m] = sl[m - 1] * cl[1] + cl[m - 1] * sl[1];
213 cl[m] = cl[m - 1] * cl[1] - sl[m - 1] * sl[1];
215 argument = fn * fn - fm * fm;
217 argument = ((fn - 1.0) * (fn - 1.0)) - (fm * fm);
218 bb = sqrt(argument) / aa;
219 cc = (2.0 * fn - 1.0) / aa;
222 p[k] = (fn + 1.0) * (cc * slat / fn *
p[ii] - bb / (fn - 1.0) *
p[j]);
223 q[k] = cc * (slat * q[ii] - clat / fn *
p[ii]) - bb * q[j];
230 *geo_mag_x = *geo_mag_x + aa * q[k];
231 *geo_mag_z = *geo_mag_z - aa *
p[k];
235 cc = aa * cl[m] + bb * sl[m];
236 *geo_mag_x = *geo_mag_x + cc * q[k];
237 *geo_mag_z = *geo_mag_z - cc *
p[k];
239 *geo_mag_y = *geo_mag_y + (aa * sl[m] - bb * cl[m]) *
240 fm *
p[k] / ((fn + 1.0) * clat);
242 *geo_mag_y = *geo_mag_y + (aa * sl[m] - bb * cl[m]) * q[k] * slat;
249 aa = ext2 * cl[1] + ext3 * sl[1];
250 *geo_mag_x = *geo_mag_x - ext1 * clat + aa * slat;
251 *geo_mag_y = *geo_mag_y + ext2 * sl[1] - ext3 * cl[1];
252 *geo_mag_z = *geo_mag_z + ext1 * slat + aa * clat;
255 *geo_mag_x = *geo_mag_x * cd + *geo_mag_z * sd;
256 *geo_mag_z = *geo_mag_z * cd - aa * sd;