1use super::helpers::{RegularGridIterator, evenly_spaced_longitudes};
2use crate::{GridPointIndex, def::grib2::template::param_set, error::GribError, grid::AngleUnit};
3
4const MAX_ITER: usize = 10;
5
6impl crate::GridShortName for param_set::GaussianGrid {
7 fn short_name(&self) -> &'static str {
8 "regular_gg"
9 }
10}
11
12impl GridPointIndex for param_set::GaussianGrid {
13 fn grid_shape(&self) -> (usize, usize) {
14 (self.grid.ni as usize, self.grid.nj as usize)
15 }
16
17 fn scanning_mode(&self) -> &super::ScanningMode {
18 &self.scanning_mode
19 }
20}
21
22impl crate::LatLons for param_set::GaussianGrid {
23 type Iter<'a> = RegularGridIterator;
24
25 fn latlons_unchecked<'a>(&'a self) -> Result<Self::Iter<'a>, GribError> {
26 if !self.is_consistent_for_j() {
27 return Err(GribError::InvalidValueError(
28 "Latitudes for first/last grid points are not consistent with scanning mode"
29 .to_owned(),
30 ));
31 }
32
33 let ij = self.ij()?;
34 let mut lat = compute_gaussian_latitudes_in_degrees(self.grid.nj as usize)
35 .map_err(|e| GribError::Unknown(e.to_owned()))?;
36 if self.scanning_mode.scans_positively_for_j() {
37 lat.reverse()
38 };
39 let lat = lat.into_iter().map(|v| v as f32).collect();
40 let lon = evenly_spaced_longitudes(
41 self.grid.first_point_lon,
42 self.grid.last_point_lon,
43 (self.grid.ni - 1) as usize,
44 self.angle_unit() as f32,
45 self.scanning_mode,
46 );
47
48 let iter = RegularGridIterator::new(lat, lon, ij);
49 Ok(iter)
50 }
51}
52
53impl AngleUnit for param_set::GaussianGrid {
54 fn angle_unit(&self) -> f64 {
55 self.grid.angle_unit()
56 }
57}
58
59impl param_set::GaussianGrid {
60 pub(crate) fn is_consistent_for_j(&self) -> bool {
61 let lat_diff = self.grid.last_point_lat - self.grid.first_point_lat;
62 !((lat_diff > 0) ^ self.scanning_mode.scans_positively_for_j())
63 }
64}
65
66fn compute_gaussian_latitudes_in_degrees(div: usize) -> Result<Vec<f64>, &'static str> {
67 let lat: Option<Vec<_>> = compute_gaussian_latitudes(div)
68 .map(|x| x.map(|i| i.to_degrees()))
69 .collect();
70 lat.ok_or("finding root for Legendre polynomial failed")
71}
72
73pub fn compute_gaussian_latitudes(div: usize) -> impl Iterator<Item = Option<f64>> {
96 legendre_roots_iterator(div).map(|x| x.map(|i| i.asin()))
97}
98
99fn legendre_roots_iterator(n: usize) -> impl Iterator<Item = Option<f64>> {
110 let coeff = 1.0_f64 - 1.0 / (8 * n * n) as f64 + 1.0 / (8 * n * n * n) as f64;
111 (0..n).map(move |i| {
112 let guess = coeff * ((4 * i + 3) as f64 * std::f64::consts::PI / (4 * n + 2) as f64).cos();
113 find_root(guess, |x| {
114 let (p_prev, p) = legendre_polynomial(n, x);
115 let fpx = legendre_polynomial_derivative(n, x, p_prev, p);
116 p / fpx
117 })
118 })
119}
120
121fn legendre_polynomial(n: usize, x: f64) -> (f64, f64) {
123 let mut p0 = 1.0;
124 let mut p1 = x;
125 for k in 2..=n {
126 let pk = ((2 * k - 1) as f64 * x * p1 - (k - 1) as f64 * p0) / k as f64;
127 p0 = p1;
128 p1 = pk;
129 }
130 (p0, p1)
131}
132
133fn legendre_polynomial_derivative(n: usize, x: f64, p_prev: f64, p: f64) -> f64 {
134 (n as f64 * (p_prev - x * p)) / (1.0 - x * x)
135}
136
137fn find_root<F>(initial_guess: f64, f: F) -> Option<f64>
139where
140 F: Fn(f64) -> f64,
141{
142 let mut count = MAX_ITER;
143 let mut x = initial_guess;
144 while count > 0 {
145 let dx = f(x);
146 x -= dx;
147 if dx.abs() < f64::EPSILON {
148 return Some(x);
149 }
150
151 count -= 1;
152 }
153 None
154}
155
156#[cfg(test)]
157mod tests {
158 use super::*;
159 use crate::{LatLons, grid::helpers::test_helpers::assert_almost_eq};
160
161 #[test]
162 fn latlon_computation_for_real_world_gaussian_grid_compared_with_results_from_eccodes()
163 -> Result<(), Box<dyn std::error::Error>> {
164 use std::io::Read;
165
166 let mut buf = Vec::new();
167
168 let f = std::fs::File::open("testdata/gdas.t00z.sfluxgrbf000.grib2.0.xz")?;
169 let f = std::io::BufReader::new(f);
170 let mut f = xz2::bufread::XzDecoder::new(f);
171 f.read_to_end(&mut buf)?;
172
173 let f = std::io::Cursor::new(buf);
174 let grib2 = crate::from_reader(f)?;
175
176 let ((_, _), first_submessage) = grib2
177 .submessages()
178 .next()
179 .ok_or_else(|| Box::<dyn std::error::Error>::from("first submessage not found"))?;
180 let grid_shape = first_submessage.grid_shape()?;
181 assert_eq!(grid_shape, (3072, 1536));
182
183 let first_160_lats_expected = "
191 89.910325 89.794157 89.677304 89.560296 89.443229 89.326134 89.209022 89.091901
192 88.974774 88.857642 88.740506 88.623369 88.506229 88.389088 88.271946 88.154803
193 88.037660 87.920515 87.803370 87.686225 87.569079 87.451933 87.334787 87.217640
194 87.100493 86.983346 86.866199 86.749052 86.631904 86.514757 86.397609 86.280461
195 86.163313 86.046165 85.929017 85.811869 85.694721 85.577572 85.460424 85.343275
196 85.226127 85.108979 84.991830 84.874681 84.757533 84.640384 84.523236 84.406087
197 84.288938 84.171789 84.054641 83.937492 83.820343 83.703194 83.586045 83.468896
198 83.351747 83.234599 83.117450 83.000301 82.883152 82.766003 82.648854 82.531705
199 82.414556 82.297407 82.180258 82.063109 81.945960 81.828811 81.711662 81.594512
200 81.477363 81.360214 81.243065 81.125916 81.008767 80.891618 80.774469 80.657320
201 80.540171 80.423021 80.305872 80.188723 80.071574 79.954425 79.837276 79.720126
202 79.602977 79.485828 79.368679 79.251530 79.134381 79.017231 78.900082 78.782933
203 78.665784 78.548635 78.431485 78.314336 78.197187 78.080038 77.962888 77.845739
204 77.728590 77.611441 77.494292 77.377142 77.259993 77.142844 77.025695 76.908545
205 76.791396 76.674247 76.557098 76.439948 76.322799 76.205650 76.088501 75.971351
206 75.854202 75.737053 75.619904 75.502754 75.385605 75.268456 75.151306 75.034157
207 74.917008 74.799859 74.682709 74.565560 74.448411 74.331262 74.214112 74.096963
208 73.979814 73.862664 73.745515 73.628366 73.511217 73.394067 73.276918 73.159769
209 73.042619 72.925470 72.808321 72.691172 72.574022 72.456873 72.339724 72.222574
210 72.105425 71.988276 71.871126 71.753977 71.636828 71.519679 71.402529 71.285380
211 ";
212 let first_160_lats_expected = first_160_lats_expected
213 .split_whitespace()
214 .filter_map(|s| s.parse::<f32>().ok());
215
216 let delta = 1.0e-6;
217 let first_160_lats = first_submessage
218 .latlons()?
219 .map(|(lat, _lon)| lat)
220 .step_by(3072)
221 .take(160);
222 for (actual, expected) in first_160_lats.zip(first_160_lats_expected) {
223 assert_almost_eq!(actual, expected, delta);
224 }
225
226 let first_160_lons_expected = "
234 0.000000 0.117188 0.234375 0.351563 0.468750 0.585938 0.703125 0.820313
235 0.937500 1.054688 1.171875 1.289063 1.406250 1.523438 1.640625 1.757813
236 1.875000 1.992188 2.109375 2.226563 2.343750 2.460938 2.578125 2.695313
237 2.812500 2.929688 3.046875 3.164063 3.281250 3.398438 3.515625 3.632813
238 3.750000 3.867188 3.984375 4.101563 4.218750 4.335938 4.453125 4.570313
239 4.687500 4.804688 4.921875 5.039063 5.156250 5.273438 5.390625 5.507813
240 5.625000 5.742188 5.859375 5.976563 6.093750 6.210938 6.328125 6.445313
241 6.562500 6.679688 6.796875 6.914063 7.031250 7.148438 7.265625 7.382813
242 7.500000 7.617188 7.734375 7.851563 7.968750 8.085938 8.203125 8.320313
243 8.437500 8.554688 8.671875 8.789063 8.906250 9.023438 9.140625 9.257813
244 9.375000 9.492188 9.609375 9.726563 9.843750 9.960938 10.078125 10.195313
245 10.312500 10.429688 10.546875 10.664063 10.781250 10.898438 11.015625 11.132813
246 11.250000 11.367188 11.484375 11.601563 11.718750 11.835938 11.953125 12.070313
247 12.187500 12.304688 12.421875 12.539063 12.656250 12.773438 12.890625 13.007813
248 13.125000 13.242188 13.359375 13.476563 13.593750 13.710938 13.828125 13.945313
249 14.062500 14.179688 14.296875 14.414063 14.531250 14.648438 14.765625 14.882813
250 15.000000 15.117188 15.234375 15.351563 15.468750 15.585938 15.703125 15.820313
251 15.937500 16.054688 16.171875 16.289063 16.406250 16.523438 16.640625 16.757813
252 16.875000 16.992188 17.109375 17.226563 17.343750 17.460938 17.578125 17.695313
253 17.812500 17.929688 18.046875 18.164063 18.281250 18.398438 18.515625 18.632813
254 ";
255 let first_160_lons_expected = first_160_lons_expected
256 .split_whitespace()
257 .filter_map(|s| s.parse::<f32>().ok());
258
259 let delta = 2.0e-6;
260 let first_160_lons = first_submessage.latlons()?.map(|(_lat, lon)| lon).take(160);
261 for (actual, expected) in first_160_lons.zip(first_160_lons_expected) {
262 assert_almost_eq!(actual, expected, delta);
263 }
264
265 Ok(())
266 }
267
268 macro_rules! test_legendre_roots_iterator_with_analytical_solutions {
269 ($((
270 $name:ident,
271 $n:expr,
272 $expected:expr,
273 ),)*) => ($(
274 #[test]
275 fn $name() {
276 let actual = legendre_roots_iterator($n);
277 let expected = $expected.into_iter();
278 for (actual_val, expected_val) in actual.zip(expected) {
279 assert!(actual_val.is_some());
280 let actual_val = actual_val.unwrap();
281 assert_almost_eq!(actual_val, expected_val, f64::EPSILON);
282 }
283 }
284 )*);
285 }
286
287 test_legendre_roots_iterator_with_analytical_solutions! {
288 (
289 legendre_roots_iterator_for_n_being_2_compared_with_analytical_solutions,
290 2,
291 vec![1.0 / 3.0_f64.sqrt(), -1.0 / 3.0_f64.sqrt()],
292 ),
293 (
294 legendre_roots_iterator_for_n_being_5_compared_with_analytical_solutions,
295 5,
296 vec![
297 (5.0_f64 + 2.0 * (10.0_f64 / 7.0).sqrt()).sqrt() / 3.0,
298 (5.0_f64 - 2.0 * (10.0_f64 / 7.0).sqrt()).sqrt() / 3.0,
299 0.0,
300 - (5.0_f64 - 2.0 * (10.0_f64 / 7.0).sqrt()).sqrt() / 3.0,
301 - (5.0_f64 + 2.0 * (10.0_f64 / 7.0).sqrt()).sqrt() / 3.0,
302 ],
303 ),
304 }
305
306 #[test]
308 fn gaussian_latitudes_computation_compared_with_numerical_solutions() {
309 let n = 160;
310 let result = compute_gaussian_latitudes_in_degrees(n);
311 assert!(result.is_ok());
312
313 let actual = result.unwrap().into_iter().take(n / 2);
314 let expected = "
315 + 89.1416, 88.0294, 86.9108, 85.7906, 84.6699, 83.5489,
316 + 82.4278, 81.3066, 80.1853, 79.0640, 77.9426, 76.8212,
317 + 75.6998, 74.5784, 73.4570, 72.3356, 71.2141, 70.0927,
318 + 68.9712, 67.8498, 66.7283, 65.6069, 64.4854, 63.3639,
319 + 62.2425, 61.1210, 59.9995, 58.8780, 57.7566, 56.6351,
320 + 55.5136, 54.3921, 53.2707, 52.1492, 51.0277, 49.9062,
321 + 48.7847, 47.6632, 46.5418, 45.4203, 44.2988, 43.1773,
322 + 42.0558, 40.9343, 39.8129, 38.6914, 37.5699, 36.4484,
323 + 35.3269, 34.2054, 33.0839, 31.9624, 30.8410, 29.7195,
324 + 28.5980, 27.4765, 26.3550, 25.2335, 24.1120, 22.9905,
325 + 21.8690, 20.7476, 19.6261, 18.5046, 17.3831, 16.2616,
326 + 15.1401, 14.0186, 12.8971, 11.7756, 10.6542, 9.5327,
327 + 8.4112, 7.2897, 6.1682, 5.0467, 3.9252, 2.8037,
328 + 1.6822, 0.5607 /
329 ";
330 let expected = expected
331 .split(&['+', ' ', ',', '\n', '/'])
332 .filter_map(|s| s.parse::<f64>().ok());
333
334 let delta = 1.0e-4;
335 for (actual_val, expected_val) in actual.zip(expected) {
336 assert_almost_eq!(actual_val, expected_val, delta);
337 }
338 }
339
340 #[test]
341 fn finding_root() {
342 let actual = find_root(1.0, |x| {
343 let fx = x * x - 2.0;
344 let fpx = x * 2.0;
345 fx / fpx
346 });
347 assert!(actual.is_some());
348 let expected = 1.41421356;
349 assert_almost_eq!(actual.unwrap(), expected, 1.0e-8)
350 }
351
352 #[test]
353 fn failure_to_find_root() {
354 let actual = find_root(1000.0, |x| {
355 let fx = x * x - 2.0;
356 let fpx = x * 2.0;
357 fx / fpx
358 });
359 assert!(actual.is_none());
360 }
361}