org.orekit.bodies.CR3BPSystem Maven / Gradle / Ivy
Go to download
Show more of this group Show more artifacts with this name
Show all versions of orekit Show documentation
Show all versions of orekit Show documentation
OREKIT (ORbits Extrapolation KIT) is a low level space dynamics library.
It provides basic elements (orbits, dates, attitude, frames ...) and
various algorithms to handle them (conversions, analytical and numerical
propagation, pointing ...).
/* Copyright 2002-2022 CS GROUP
* Licensed to CS GROUP (CS) under one or more
* contributor license agreements. See the NOTICE file distributed with
* this work for additional information regarding copyright ownership.
* CS licenses this file to You under the Apache License, Version 2.0
* (the "License"); you may not use this file except in compliance with
* the License. You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
package org.orekit.bodies;
import org.hipparchus.analysis.UnivariateFunction;
import org.hipparchus.analysis.solvers.AllowedSolution;
import org.hipparchus.analysis.solvers.BracketingNthOrderBrentSolver;
import org.hipparchus.analysis.solvers.UnivariateSolverUtils;
import org.hipparchus.geometry.euclidean.threed.Vector3D;
import org.hipparchus.util.FastMath;
import org.orekit.frames.CR3BPRotatingFrame;
import org.orekit.frames.Frame;
import org.orekit.frames.Transform;
import org.orekit.time.AbsoluteDate;
import org.orekit.utils.AbsolutePVCoordinates;
import org.orekit.utils.LagrangianPoints;
import org.orekit.utils.PVCoordinates;
import org.orekit.utils.TimeStampedPVCoordinates;
/**
* Class creating, from two different celestial bodies, the corresponding system
* with respect to the Circular Restricted Three Body problem hypotheses.
* @see "Dynamical systems, the three-body problem, and space mission design, Koon, Lo, Marsden, Ross"
* @author Vincent Mouraux
* @author William Desprats
* @since 10.2
*/
public class CR3BPSystem {
/** Relative accuracy on position for solver. */
private static final double RELATIVE_ACCURACY = 1e-14;
/** Absolute accuracy on position for solver (1mm). */
private static final double ABSOLUTE_ACCURACY = 1e-3;
/** Function value accuracy for solver (set to 0 so we rely only on position for convergence). */
private static final double FUNCTION_ACCURACY = 0;
/** Maximal order for solver. */
private static final int MAX_ORDER = 5;
/** Maximal number of evaluations for solver. */
private static final int MAX_EVALUATIONS = 10000;
/** Mass ratio. */
private final double mu;
/** Distance between the two primaries, meters. */
private final double dDim;
/** Orbital Velocity of m1, m/s. */
private final double vDim;
/** Orbital Period of m1 and m2, seconds. */
private final double tDim;
/** CR3BP System name. */
private final String name;
/** Rotating Frame for the system. */
private final Frame rotatingFrame;
/** Primary body. */
private final CelestialBody primaryBody;
/** Secondary body. */
private final CelestialBody secondaryBody;
/** L1 Point position in the rotating frame. */
private Vector3D l1Position;
/** L2 Point position in the rotating frame. */
private Vector3D l2Position;
/** L3 Point position in the rotating frame. */
private Vector3D l3Position;
/** L4 Point position in the rotating frame. */
private Vector3D l4Position;
/** L5 Point position in the rotating frame. */
private Vector3D l5Position;
/** Distance between a L1 and the secondaryBody. */
private final double gamma1;
/** Distance between a L2 and the secondaryBody. */
private final double gamma2;
/** Distance between a L3 and the primaryBody. */
private final double gamma3;
/**
* Simple constructor.
*
* Standard constructor to use to define a CR3BP System. Mass ratio is
* calculated from JPL data.
*
* @param primaryBody Primary Body in the CR3BP System
* @param secondaryBody Secondary Body in the CR3BP System
* @param a Semi-Major Axis of the secondary body
*/
public CR3BPSystem(final CelestialBody primaryBody, final CelestialBody secondaryBody, final double a) {
this(primaryBody, secondaryBody, a, secondaryBody.getGM() / (secondaryBody.getGM() + primaryBody.getGM()));
}
/**
* Simple constructor.
*
* This constructor can be used to define a CR3BP System if the user wants
* to use a specified mass ratio.
*
* @param primaryBody Primary Body in the CR3BP System
* @param secondaryBody Secondary Body in the CR3BP System
* @param a Semi-Major Axis of the secondary body
* @param mu Mass ratio of the CR3BPSystem
*/
public CR3BPSystem(final CelestialBody primaryBody, final CelestialBody secondaryBody, final double a, final double mu) {
this.primaryBody = primaryBody;
this.secondaryBody = secondaryBody;
this.name = primaryBody.getName() + "_" + secondaryBody.getName();
final double mu1 = primaryBody.getGM();
this.mu = mu;
this.dDim = a;
this.vDim = FastMath.sqrt(mu1 / dDim);
this.tDim = 2 * FastMath.PI * dDim / vDim;
this.rotatingFrame = new CR3BPRotatingFrame(mu, primaryBody, secondaryBody);
computeLagrangianPointsPosition();
// Calculation of collinear points gamma
// L1 Gamma
final double x1 = l1Position.getX();
final double dCP1 = 1 - mu;
this.gamma1 = dCP1 - x1;
// L2 Gamma
final double x2 = l2Position.getX();
final double dCP2 = 1 - mu;
this.gamma2 = x2 - dCP2;
// L3 Gamma
final double x3 = l3Position.getX();
final double dCP3 = -mu;
this.gamma3 = dCP3 - x3;
}
/** Calculation of Lagrangian Points position using CR3BP equations.
*/
private void computeLagrangianPointsPosition() {
// Calculation of Lagrangian Points position using CR3BP equations
// L1
final BracketingNthOrderBrentSolver solver =
new BracketingNthOrderBrentSolver(RELATIVE_ACCURACY,
ABSOLUTE_ACCURACY,
FUNCTION_ACCURACY, MAX_ORDER);
final double baseR1 = 1 - FastMath.cbrt(mu / 3);
final UnivariateFunction l1Equation = x -> {
final double leq1 =
x * (x + mu) * (x + mu) * (x + mu - 1) * (x + mu - 1);
final double leq2 = (1 - mu) * (x + mu - 1) * (x + mu - 1);
final double leq3 = mu * (x + mu) * (x + mu);
return leq1 - leq2 + leq3;
};
final double[] searchInterval1 =
UnivariateSolverUtils.bracket(l1Equation, baseR1, -mu,
1 - mu, 1E-6, 1,
MAX_EVALUATIONS);
final double r1 =
solver.solve(MAX_EVALUATIONS, l1Equation, searchInterval1[0],
searchInterval1[1], AllowedSolution.ANY_SIDE);
this.l1Position = new Vector3D(r1, 0.0, 0.0);
// L2
final double baseR2 = 1 + FastMath.cbrt(mu / 3);
final UnivariateFunction l2Equation = x -> {
final double leq21 =
x * (x + mu) * (x + mu) * (x + mu - 1) * (x + mu - 1);
final double leq22 = (1 - mu) * (x + mu - 1) * (x + mu - 1);
final double leq23 = mu * (x + mu) * (x + mu);
return leq21 - leq22 - leq23;
};
final double[] searchInterval2 =
UnivariateSolverUtils.bracket(l2Equation, baseR2, 1 - mu, 2, 1E-6,
1, MAX_EVALUATIONS);
final double r2 =
solver.solve(MAX_EVALUATIONS, l2Equation, searchInterval2[0],
searchInterval2[1], AllowedSolution.ANY_SIDE);
this.l2Position = new Vector3D(r2, 0.0, 0.0);
// L3
final double baseR3 = -(1 + 5 * mu / 12);
final UnivariateFunction l3Equation = x -> {
final double leq31 =
x * (x + mu) * (x + mu) * (x + mu - 1) * (x + mu - 1);
final double leq32 = (1 - mu) * (x + mu - 1) * (x + mu - 1);
final double leq33 = mu * (x + mu) * (x + mu);
return leq31 + leq32 + leq33;
};
final double[] searchInterval3 =
UnivariateSolverUtils.bracket(l3Equation, baseR3, -2, -mu, 1E-6, 1,
MAX_EVALUATIONS);
final double r3 =
solver.solve(MAX_EVALUATIONS, l3Equation, searchInterval3[0],
searchInterval3[1], AllowedSolution.ANY_SIDE);
this.l3Position = new Vector3D(r3, 0.0, 0.0);
// L4
this.l4Position = new Vector3D(0.5 - mu, FastMath.sqrt(3) / 2, 0);
// L5
this.l5Position = new Vector3D(0.5 - mu, -FastMath.sqrt(3) / 2, 0);
}
/** Get the CR3BP mass ratio of the system mu2/(mu1+mu2).
* @return CR3BP mass ratio of the system mu2/(mu1+mu2)
*/
public double getMassRatio() {
return mu;
}
/** Get the CR3BP distance between the two bodies.
* @return CR3BP distance between the two bodies(m)
*/
public double getDdim() {
return dDim;
}
/** Get the CR3BP orbital velocity of m2.
* @return CR3BP orbital velocity of m2(m/s)
*/
public double getVdim() {
return vDim;
}
/** Get the CR3BP orbital period of m2 around m1.
* @return CR3BP orbital period of m2 around m1(s)
*/
public double getTdim() {
return tDim;
}
/** Get the name of the CR3BP system.
* @return name of the CR3BP system
*/
public String getName() {
return name;
}
/** Get the primary CelestialBody.
* @return primary CelestialBody
*/
public CelestialBody getPrimary() {
return primaryBody;
}
/** Get the secondary CelestialBody.
* @return secondary CelestialBody
*/
public CelestialBody getSecondary() {
return secondaryBody;
}
/** Get the CR3BP Rotating Frame.
* @return CR3BP Rotating Frame
*/
public Frame getRotatingFrame() {
return rotatingFrame;
}
/** Get the position of the Lagrangian point in the CR3BP Rotating frame.
* @param lagrangianPoint Lagrangian Point to consider
* @return position of the Lagrangian point in the CR3BP Rotating frame (-)
*/
public Vector3D getLPosition(final LagrangianPoints lagrangianPoint) {
final Vector3D lPosition;
switch (lagrangianPoint) {
case L1:
lPosition = l1Position;
break;
case L3:
lPosition = l3Position;
break;
case L4:
lPosition = l4Position;
break;
case L5:
lPosition = l5Position;
break;
default:
lPosition = l2Position;
break;
}
return lPosition;
}
/**
* Get the position of the Lagrangian point in the CR3BP Rotating frame.
* @param lagrangianPoint Lagrangian Point to consider
* @return Distance between a Lagrangian Point and its closest primary.
*/
public double getGamma(final LagrangianPoints lagrangianPoint) {
final double gamma;
switch (lagrangianPoint) {
case L1:
gamma = gamma1;
break;
case L2:
gamma = gamma2;
break;
case L3:
gamma = gamma3;
break;
default:
gamma = 0;
}
return gamma;
}
/** Get the PVCoordinates from normalized units to standard units in an output frame.
* @param pv0 Normalized PVCoordinates in the rotating frame
* @param date Date of the transform
* @param outputFrame Frame in which the output PVCoordinates will be
* @return PVCoordinates in the output frame [m,m/s]
*/
private PVCoordinates getRealPV(final PVCoordinates pv0, final AbsoluteDate date, final Frame outputFrame) {
// 1. Dimensionalize the primary-centered rotating state using the instantaneously
// defined characteristic quantities
// 2. Apply the transformation to primary inertial frame
// 3. Apply the transformation to output frame
final Frame primaryInertialFrame = primaryBody.getInertiallyOrientedFrame();
final TimeStampedPVCoordinates pv21 = secondaryBody.getPVCoordinates(date, primaryInertialFrame);
// Distance and Velocity to dimensionalize the state vector
final double dist12 = pv21.getPosition().getNorm();
final double vCircular = FastMath.sqrt(primaryBody.getGM() / dist12);
// Dimensionalized state vector centered on primary body
final PVCoordinates pvDim = new PVCoordinates(pv0.getPosition().scalarMultiply(dist12),
pv0.getVelocity().scalarMultiply(vCircular));
// Transformation between rotating frame and the primary inertial
final Transform rotatingToPrimaryInertial = rotatingFrame.getTransformTo(primaryInertialFrame, date);
// State vector in the primary inertial frame
final PVCoordinates pv2 = rotatingToPrimaryInertial.transformPVCoordinates(pvDim);
// Transformation between primary inertial frame and the output frame
final Transform primaryInertialToOutputFrame = primaryInertialFrame.getTransformTo(outputFrame, date);
return primaryInertialToOutputFrame.transformPVCoordinates(pv2);
}
/** Get the AbsolutePVCoordinates from normalized units to standard units in an output frame.
* This method ensure the constituency of the date of returned AbsolutePVCoordinate, especially
* when apv0 is the result of a propagation in CR3BP normalized model.
* @param apv0 Normalized AbsolutePVCoordinates in the rotating frame
* @param initialDate Date of the at the beginning of the propagation
* @param outputFrame Frame in which the output AbsolutePVCoordinates will be
* @return AbsolutePVCoordinates in the output frame [m,m/s]
*/
public AbsolutePVCoordinates getRealAPV(final AbsolutePVCoordinates apv0, final AbsoluteDate initialDate, final Frame outputFrame) {
final double duration = apv0.getDate().durationFrom(initialDate) * tDim / (2 * FastMath.PI);
final AbsoluteDate date = initialDate.shiftedBy(duration);
// PVCoordinate in the output frame
final PVCoordinates pv3 = getRealPV(apv0.getPVCoordinates(), date, outputFrame);
return new AbsolutePVCoordinates(outputFrame, date, pv3);
}
}