1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17 package org.apache.commons.math4.legacy.analysis.interpolation;
18
19 import org.apache.commons.numbers.angle.Reduce;
20 import org.apache.commons.numbers.arrays.SortInPlace;
21 import org.apache.commons.math4.legacy.analysis.UnivariateFunction;
22 import org.apache.commons.math4.legacy.exception.MathIllegalArgumentException;
23 import org.apache.commons.math4.legacy.exception.NonMonotonicSequenceException;
24 import org.apache.commons.math4.legacy.exception.NumberIsTooSmallException;
25 import org.apache.commons.math4.legacy.core.MathArrays;
26
27
28
29
30
31
32
33
34
35
36 public class UnivariatePeriodicInterpolator
37 implements UnivariateInterpolator {
38
39 public static final int DEFAULT_EXTEND = 5;
40
41 private final UnivariateInterpolator interpolator;
42
43 private final double period;
44
45 private final int extend;
46
47
48
49
50
51
52
53
54
55
56
57
58 public UnivariatePeriodicInterpolator(UnivariateInterpolator interpolator,
59 double period,
60 int extend) {
61 this.interpolator = interpolator;
62 this.period = period;
63 this.extend = extend;
64 }
65
66
67
68
69
70
71
72
73
74 public UnivariatePeriodicInterpolator(UnivariateInterpolator interpolator,
75 double period) {
76 this(interpolator, period, DEFAULT_EXTEND);
77 }
78
79
80
81
82
83
84
85 @Override
86 public UnivariateFunction interpolate(double[] xval,
87 double[] yval)
88 throws NumberIsTooSmallException, NonMonotonicSequenceException {
89 if (xval.length < extend) {
90 throw new NumberIsTooSmallException(xval.length, extend, true);
91 }
92
93 MathArrays.checkOrder(xval);
94 final double offset = xval[0];
95 final Reduce reduce = new Reduce(offset, period);
96
97 final int len = xval.length + extend * 2;
98 final double[] x = new double[len];
99 final double[] y = new double[len];
100 for (int i = 0; i < xval.length; i++) {
101 final int index = i + extend;
102 x[index] = reduce.applyAsDouble(xval[i]);
103 y[index] = yval[i];
104 }
105
106
107 for (int i = 0; i < extend; i++) {
108 int index = xval.length - extend + i;
109 x[i] = reduce.applyAsDouble(xval[index]) - period;
110 y[i] = yval[index];
111
112 index = len - extend + i;
113 x[index] = reduce.applyAsDouble(xval[i]) + period;
114 y[index] = yval[i];
115 }
116
117 SortInPlace.ASCENDING.apply(x, y);
118
119 final UnivariateFunction f = interpolator.interpolate(x, y);
120 return new UnivariateFunction() {
121
122 @Override
123 public double value(final double x) throws MathIllegalArgumentException {
124 return f.value(reduce.applyAsDouble(x));
125 }
126 };
127 }
128 }