/
Maneuvers.cs
94 lines (76 loc) · 2.61 KB
/
Maneuvers.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
/*
* 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 MechJebLib.Core.TwoBody;
using MechJebLib.Primitives;
using MechJebLib.Utils;
namespace MechJebLib.Core.Functions
{
public class Maneuvers
{
public static V3 DeltaVRelativeToCircularVelocity(double mu, V3 r, V3 v, double n = 1.0)
{
Check.Finite(mu);
Check.Finite(r);
Check.Finite(v);
Check.Positive(mu);
Check.NonZero(r);
var h = V3.Cross(r, v);
return n * Maths.CircularVelocityFromHvec(mu, r, h) - v;
}
public static V3 DeltaVToCircularize(double mu, V3 r, V3 v)
{
Check.Finite(mu);
Check.Finite(r);
Check.Finite(v);
Check.Positive(mu);
Check.NonZero(r);
var h = V3.Cross(r, v);
return Maths.CircularVelocityFromHvec(mu, r, h) - v;
}
public static V3 DeltaVToCircularizeAfterTime(double mu, V3 r, V3 v, double dt)
{
Check.Finite(mu);
Check.Finite(r);
Check.Finite(v);
Check.Finite(dt);
Check.Positive(mu);
Check.NonZero(r);
(V3 r1, V3 v1) = Farnocchia.Solve(mu, dt, r, v);
var h = V3.Cross(r1, v1);
return Maths.CircularVelocityFromHvec(mu, r, h) - v1;
}
public static V3 DeltaVToCircularizeAtPeriapsis(double mu, V3 r, V3 v)
{
Check.Finite(mu);
Check.Finite(r);
Check.Finite(v);
Check.Positive(mu);
Check.NonZero(r);
double dt = Maths.TimeToNextPeriapsis(mu, r, v);
Check.Finite(dt);
return DeltaVToCircularizeAfterTime(mu, r, v, dt);
}
public static V3 DeltaVToCircularizeAtApoapsis(double mu, V3 r, V3 v)
{
Check.Finite(mu);
Check.Finite(r);
Check.Finite(v);
Check.Positive(mu);
Check.NonZero(r);
double dt = Maths.TimeToNextApoapsis(mu, r, v);
Check.Finite(dt);
return DeltaVToCircularizeAfterTime(mu, r, v, dt);
}
public static V3 DeltaVToChangeInclination(V3 r, V3 v, double newInc)
{
return Maths.VelocityForInclination(r, v, newInc) - v;
}
public static V3 DeltaVToChangeFPA(V3 r, V3 v, double newFPA)
{
return Maths.VelocityForFPA(r, v, newFPA) - v;
}
}
}