/
Hn.cs
132 lines (111 loc) · 3.61 KB
/
Hn.cs
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
/*
* Copyright Lamont Granquist, Sebastien Gaggini and the MechJeb contributors
* SPDX-License-Identifier: LicenseRef-PD-hp OR Unlicense OR CC0-1.0 OR 0BSD OR MIT-0 OR MIT OR LGPL-2.1+
*/
#nullable enable
using System.Collections.Generic;
using MechJebLib.Functions;
using MechJebLib.Utils;
using static System.Math;
namespace MechJebLib.Primitives
{
public class Hn : HBase<Vn>
{
public int N;
private static readonly ObjectPool<Hn> _pool = new ObjectPool<Hn>(New, Clear);
private static Hn New() => new Hn();
public void Add(double time, double[] value, double[] inTangent, double[] outTangent)
{
_list[time] = new HFrame<Vn>(time, Allocate(value), Allocate(inTangent), Allocate(outTangent));
MinTime = Min(MinTime, time);
MaxTime = Max(MaxTime, time);
RecomputeTangents(_list.IndexOfKey(time));
LastLo = -1;
}
public void Add(double time, double[] value, double[] tangent)
{
if (_list.ContainsKey(time))
{
HFrame<Vn> temp = _list.Values[_list.IndexOfKey(time)];
temp.Value = Allocate(value);
temp.OutTangent = Allocate(tangent);
_list[time] = temp;
}
else
{
Add(time, value, tangent, tangent);
}
}
public static Hn Get(int n)
{
Hn h = _pool.Borrow();
h.N = n;
h.Clear();
return h;
}
public override void Dispose()
{
base.Dispose();
_pool.Release(this);
}
protected override Vn Allocate() => Vn.Rent(N);
private Vn Allocate(IReadOnlyList<double> value)
{
var list = Vn.Rent(N);
for (int i = 0; i < N; i++)
list[i] = value[i];
return list;
}
protected override Vn Allocate(Vn value)
{
var list = Vn.Rent(N);
for (int i = 0; i < N; i++)
list[i] = value[i];
return list;
}
protected override void Subtract(Vn a, Vn b, ref Vn result)
{
for (int i = 0; i < N; i++)
result[i] = a[i] - b[i];
}
protected override void Divide(Vn a, double b, ref Vn result)
{
for (int i = 0; i < N; i++)
result[i] = a[i] / b;
}
protected override void Multiply(Vn a, double b, ref Vn result)
{
for (int i = 0; i < N; i++)
result[i] = a[i] * b;
}
protected override void Addition(Vn a, Vn b, ref Vn result)
{
for (int i = 0; i < N; i++)
result[i] = a[i] + b[i];
}
protected override Vn Interpolant(double x1, Vn y1, Vn yp1, double x2, Vn y2, Vn yp2, double x)
{
var ret = Vn.Rent(N);
Interpolants.CubicHermiteInterpolant(x1, y1, yp1, x2, y2, yp2, x, N, ret);
return ret;
}
private void DisposeKeyframe(HFrame<Vn> frame)
{
Vn.Return(frame.Value);
Vn.Return(frame.InTangent);
Vn.Return(frame.OutTangent);
}
private static void Clear(Hn h) => h.Clear();
public override void Clear()
{
for (int i = 0; i < _list.Count; i++)
{
DisposeKeyframe(_list.Values[i]);
}
MinTime = double.MaxValue;
MaxTime = double.MinValue;
LastLo = -1;
_list.Clear();
}
}
}