//<summary>
//Takes in position and velocity realtive to the body being orbited
//</summary>
private void calculateInitialOrbitalElements(Vector2 position, Vector2 velocity)
{
gravityElements.Mu = GlobalElements.GRAV_CONST * gravityElements.MassiveBody.GetComponent <MassiveBodyElements>().mass;
gravityElements.Position = position;
gravityElements.velocity = velocity;
//Calculate Global Tranformation Vector
gravityElements.GlobalTransformationVector = OrbitalHelper.calculateGlobalTranformationVector(gravityElements.MassiveBody);
//Calculate eccentricity
gravityElements.Eccentricity = OrbitalHelper.calculateEccentricity(position, velocity, gravityElements.Mu);
//Determine orbit type
gravityElements.OrbitType = OrbitalHelper.determineOrbitType(gravityElements.Eccentricity);
//Calculate Mechanical Energy
gravityElements.MechanicalEnergy = OrbitalHelper.calculateMechanicalEnergy(gravityElements.Position, gravityElements.velocity, gravityElements.Mu, gravityElements.OrbitType);
//Calculate Semi Major Axis
gravityElements.SemiMajorAxis = OrbitalHelper.calculateSemiMajorAxis(gravityElements.MechanicalEnergy, gravityElements.Mu, gravityElements.OrbitType);
//Calculate SemiLatusRectum
gravityElements.SemiLatusRectum = OrbitalHelper.calculateSemiLatusRectum(gravityElements.SemiMajorAxis, gravityElements.Eccentricity, gravityElements.Perigee, gravityElements.OrbitType);
//Calculate Perigee
gravityElements.Perigee = OrbitalHelper.calculatePerigee(gravityElements.SemiMajorAxis, gravityElements.Eccentricity, gravityElements.OrbitType);
//Calculate Apogee
gravityElements.Apogee = OrbitalHelper.calculateApogee(gravityElements.SemiMajorAxis, gravityElements.Eccentricity, gravityElements.OrbitType);
//Calculate Center
gravityElements.Center = OrbitalHelper.calculateCenter(gravityElements.SemiMajorAxis, gravityElements.Perigee, gravityElements.OrbitType);
//Calculate GlobalRotationAngle
gravityElements.GlobalRotationAngle = OrbitalHelper.calculateGlobalRotationAngle(gravityElements.Eccentricity, gravityElements.OrbitType);
//Find orbital directions
gravityElements.Clockwise = OrbitalHelper.clockwiseOrbit(gravityElements.Position, gravityElements.velocity);
gravityElements.TowardsPerigee = OrbitalHelper.towardsPerigeeOrbit(gravityElements.velocity, gravityElements.Eccentricity, gravityElements.OrbitType);
//Calculate trueAnomaly
gravityElements.TrueAnomaly = OrbitalHelper.calculateTrueAnomaly(gravityElements.Eccentricity, gravityElements.Position, gravityElements.TowardsPerigee, gravityElements.Clockwise, gravityElements.OrbitType);
//Calculate Eccentric Anomaly
gravityElements.EccentricAnomaly = OrbitalHelper.calculateEccentricAnomaly(gravityElements.Eccentricity, gravityElements.TrueAnomaly, gravityElements.TowardsPerigee, gravityElements.OrbitType);
//Calculate Anomaly at current epoch
gravityElements.AnomalyAtEpoch = OrbitalHelper.calculateAnomalyAtCurrentEpoch(gravityElements.Eccentricity, gravityElements.EccentricAnomaly, gravityElements.Clockwise, gravityElements.OrbitType);
gravityElements.MeanAnomaly = gravityElements.AnomalyAtEpoch;
//Calculate Angular Momentum
gravityElements.AngularMomentum = OrbitalHelper.calculateAngularMomentum(gravityElements.Eccentricity, gravityElements.Perigee, gravityElements.SemiMajorAxis, gravityElements.SemiLatusRectum,
gravityElements.Mu, gravityElements.OrbitType);
//Calculate time at epoch
gravityElements.TimeAtEpoch = OrbitalHelper.calculateTimeAtEpoch(gravityElements.Eccentricity, gravityElements.EccentricAnomaly, gravityElements.SemiMajorAxis, gravityElements.Mu,
gravityElements.Clockwise, gravityElements.TowardsPerigee, gravityElements.OrbitType);
}
//<summary>
//Takes in everything in global coordinates (relative to the origin(0, 0)) and returns the game object that is influencing the craft
//</summary>
//<param name="position"> Re-read the summary
//<param name="asdf"> Here's to the little guys
private GameObject findInfluencingCelestialBody(Vector2 position, Vector2 velocity, GameObject currentMassiveBody)
{
GameObject[] massiveBodies = GameObject.FindGameObjectsWithTag("MassiveBody");
List <GameObject> spheresOfInfluence = new List <GameObject>();
for (int i = 0; i < massiveBodies.Length; i++)
{
//quick and dirty calculation of altitude
double mu = massiveBodies[i].GetComponent <MassiveBodyElements>().mass *GlobalElements.GRAV_CONST;
Vector2 relativePosition = position - MiscHelperFuncs.convertToVec2(massiveBodies[i].transform.position);
Vector2 relativeVelocity = velocity + massiveBodies[i].GetComponent <GravityElements>().velocity;
Vector2 eccentricity = OrbitalHelper.calculateEccentricity(relativePosition, relativeVelocity, mu);
OrbitTypes orbitType = OrbitalHelper.determineOrbitType(eccentricity);
double mechanicalEnergy = OrbitalHelper.calculateMechanicalEnergy(relativePosition, relativeVelocity, mu, orbitType);
double semiMajorAxis = OrbitalHelper.calculateSemiMajorAxis(mechanicalEnergy, mu, orbitType);
Vector2 perigee = OrbitalHelper.calculatePerigee(semiMajorAxis, eccentricity, orbitType);
double semiLatusRectum = OrbitalHelper.calculateSemiLatusRectum(semiMajorAxis, eccentricity, perigee, orbitType); //semiMajorAxis * (1 - Math.Pow(eccentricity.magnitude, 2));
double trueAnomaly = Vector2.Angle(relativePosition, eccentricity);
trueAnomaly = MiscHelperFuncs.convertToRadians(trueAnomaly);
trueAnomaly = Math.Abs(MiscHelperFuncs.wrapAngle(trueAnomaly));
double altitude = Vector2.Distance(massiveBodies[i].transform.position, transform.position);//semiLatusRectum / (1 + eccentricity.magnitude * Math.Cos(trueAnomaly));
if (massiveBodies[i].GetComponent <MassiveBodyElements>().SphereOfInfluence > altitude && massiveBodies[i].transform.GetInstanceID() != this.transform.GetInstanceID())
{
if (altitude < 0)
{
Debug.Log("altitude: " + altitude);
Debug.Log("semilatusrectum: " + semiLatusRectum);
Debug.Log("Eccentricity: " + eccentricity.magnitude);
Debug.Log("true anomaly: " + trueAnomaly);
}
spheresOfInfluence.Add(massiveBodies[i]);
}
}
double smallestDistance = double.PositiveInfinity;
GameObject returnGameObject = currentMassiveBody;
foreach (GameObject massiveBody in spheresOfInfluence)
{
double distance = Vector2.Distance(massiveBody.transform.position, transform.position);
if (distance < smallestDistance)
{
smallestDistance = distance;
returnGameObject = massiveBody;
}
}
return(returnGameObject);
}