public void TestMeanAnomalyCalcs(OrbitDB orbitDB)
{
double sgp = orbitDB.GravitationalParameterAU;
double o_a = orbitDB.SemiMajorAxis;
double o_e = orbitDB.Eccentricity;
double o_i = Angle.ToRadians(orbitDB.Inclination);
double o_Ω = Angle.ToRadians(orbitDB.LongitudeOfAscendingNode);
double o_M0 = Angle.ToRadians(orbitDB.MeanAnomalyAtEpoch);
double o_n = Angle.ToRadians(orbitDB.MeanMotion);
double o_ω = Angle.ToRadians(orbitDB.ArgumentOfPeriapsis);
double o_lop = OrbitMath.LonditudeOfPeriapsis2d(o_Ω, o_ω, o_i);
DateTime o_epoch = orbitDB.Epoch;
double periodInSeconds = orbitDB.OrbitalPeriod.TotalSeconds;
double segmentTime = periodInSeconds / 16;
//lets break the orbit up and check the paremeters at different points of the orbit:
for (int i = 0; i < 16; i++)
{
TimeSpan timeSinceEpoch = TimeSpan.FromSeconds(segmentTime * i);
DateTime segmentDatetime = o_epoch + timeSinceEpoch;
double o_M = OrbitMath.GetMeanAnomalyFromTime(o_M0, o_n, timeSinceEpoch.TotalSeconds); //orbitProcessor uses this calc directly
double o_E = OrbitProcessor.GetEccentricAnomaly(orbitDB, o_M);
double o_ν = OrbitProcessor.GetTrueAnomaly(orbitDB, segmentDatetime);
var pos = OrbitProcessor.GetPosition_AU(orbitDB, segmentDatetime);
var vel = OrbitMath.InstantaneousOrbitalVelocityVector(sgp, pos, o_a, o_e, o_ν);
var M1 = OrbitMath.GetMeanAnomaly(o_e, o_E);
Assert.AreEqual(o_M, M1, 1.0E-7, "MeanAnomaly M expected: " + Angle.ToDegrees(o_M) + " was: " + Angle.ToDegrees(M1));
}
}
internal override void Display()
{
_isRunningFrame = true;
if (IsActive)
{
SetFrameRateArray();
if (ImGui.Begin("debug", ref IsActive))
{
ImGui.Text(_state.CurrentSystemDateTime.ToString());
ImGui.Text("Cursor World Coordinate:");
var mouseWorldCoord = _state.Camera.MouseWorldCoordinate();
ImGui.Text("x" + mouseWorldCoord.X);
ImGui.SameLine();
ImGui.Text("y" + mouseWorldCoord.Y);
if (ImGui.CollapsingHeader("FrameRates", ImGuiTreeNodeFlags.CollapsingHeader))
{
//plot vars: (label, values, valueOffset, overlayText, scaleMin, scaleMax, graphSize, Stride)
//core game processing rate.
//ImGui.PlotHistogram("##GRHistogram", _gameRatesDisplay, 10, _timeSpan.TotalSeconds.ToString(), 0, 1f, new ImVec2(0, 80), sizeof(float));
//ImGui.PlotHistogram("##GRHistogram1", _gameRatesDisplay, 0 , _timeSpan.TotalSeconds.ToString(), 0, 1f, new ImVec2(0, 80), sizeof(float));
ImGui.PlotHistogram("Game Tick ##GTHistogram", _gameRates, _gameRateIndex, _currentGFPS.ToString(), 0f, largestGFPS, new ImVec2(248, 60), sizeof(float));
ImGui.PlotLines("Game Tick ##GTPlotlines", _gameRates, _gameRateIndex, _currentGFPS.ToString(), 0, largestGFPS, new ImVec2(248, 60), sizeof(float));
//current star system processing rate.
ImGui.PlotHistogram("System Tick ##STHistogram", _systemRates, _systemRateIndex, _currentSFPS.ToString(), 0f, 1f, new ImVec2(248, 60), sizeof(float));
ImGui.PlotLines("System Tick ##STPlotlines", _systemRates, _systemRateIndex, _currentSFPS.ToString(), 0, 1, new ImVec2(248, 60), sizeof(float));
//ui framerate
ImGui.PlotHistogram("Frame Rate ##FPSHistogram", _frameRates, _frameRateIndex, _currentFPS.ToString(), 0f, 10000, new ImVec2(248, 60), sizeof(float));
}
if (_state.LastClickedEntity.Name != null)
{
if (ImGui.CollapsingHeader("Selected Entity: " + _state.LastClickedEntity.Name + "###NameHeader", ImGuiTreeNodeFlags.CollapsingHeader))
{
ImGui.Text(_state.LastClickedEntity.Entity.Guid.ToString());
if (_state.LastClickedEntity.Entity.HasDataBlob <PositionDB>())
{
var positiondb = _state.LastClickedEntity.Entity.GetDataBlob <PositionDB>();
var posv4 = positiondb.AbsolutePosition_AU;
ImGui.Text("x: " + posv4.X);
ImGui.Text("y: " + posv4.Y);
ImGui.Text("z: " + posv4.Z);
if (positiondb.Parent != null)
{
ImGui.Text("Parent: " + positiondb.Parent.GetDataBlob <NameDB>().DefaultName);
ImGui.Text("Dist: " + Distance.AuToKm(positiondb.RelativePosition_AU.Length()));
}
}
if (_state.LastClickedEntity.Entity.HasDataBlob <OrbitDB>())
{
if (ImGui.CollapsingHeader("OrbitDB: ###OrbitDBHeader", ImGuiTreeNodeFlags.CollapsingHeader))
{
OrbitDB orbitDB = _state.LastClickedEntity.Entity.GetDataBlob <OrbitDB>();
//if (_state.CurrentSystemDateTime != lastDate)
//{
pos = OrbitProcessor.GetAbsolutePosition_AU(orbitDB, _state.CurrentSystemDateTime);
truAnomoly = OrbitProcessor.GetTrueAnomaly(orbitDB, _state.CurrentSystemDateTime);
lastDate = _state.CurrentSystemDateTime;
//}
ImGui.Text("x: " + pos.X);
ImGui.Text("y: " + pos.Y);
ImGui.Text("z: " + pos.Z);
ImGui.Text("Eccentricity: " + orbitDB.Eccentricity);
ImGui.Text("AoP:" + orbitDB.ArgumentOfPeriapsis);
ImGui.Text("TrueAnomaly: " + truAnomoly);
ImGui.Text("MeanMotion: " + orbitDB.MeanMotion);
ImGui.Text("SOI Radius: " + Distance.AuToKm(GMath.GetSOI(_state.LastClickedEntity.Entity)));
ImGui.Text("Orbital Period:" + orbitDB.OrbitalPeriod);
ImGui.Text("SemiMajAxis: " + orbitDB.SemiMajorAxis);
if (orbitDB.Parent != null)
{
ImGui.Text("Parent: " + orbitDB.Parent.GetDataBlob <NameDB>().DefaultName);
}
if (orbitDB.Children.Count > 0)
{
foreach (var item in orbitDB.Children)
{
ImGui.Text(item.GetDataBlob <NameDB>().DefaultName);
}
}
}
}
if (_state.LastClickedEntity.OrbitIcon != null)
{
if (ImGui.CollapsingHeader("OrbitIcon: ###OrbitIconHeader", ImGuiTreeNodeFlags.CollapsingHeader))
{
OrbitDB orbitDB = _state.LastClickedEntity.Entity.GetDataBlob <OrbitDB>();
string startRadian = _state.LastClickedEntity.OrbitIcon._ellipseStartArcAngleRadians.ToString();
string startDegrees = Angle.ToDegrees(_state.LastClickedEntity.OrbitIcon._ellipseStartArcAngleRadians).ToString();
ImGui.Text("StartAngleRadians: " + startRadian);
ImGui.Text("StartAngleDegrees: " + startDegrees);
}
}
if (_state.LastClickedEntity.Entity.HasDataBlob <PropulsionDB>())
{
if (ImGui.CollapsingHeader("Propulsion: ###PropulsionHeader", ImGuiTreeNodeFlags.CollapsingHeader))
{
PropulsionDB propulsionDB = _state.LastClickedEntity.Entity.GetDataBlob <PropulsionDB>();
ImGui.Text("NonNewt Engine Power: " + propulsionDB.TotalEnginePower);
ImGui.Text("Max Speed: " + propulsionDB.MaximumSpeed_MS);
ImGui.Text("CurrentVector: " + propulsionDB.CurrentVectorMS);
ImGui.Text("Current Speed: " + Vector4.Magnitude(propulsionDB.CurrentVectorMS));
if (_state.LastClickedEntity.Entity.HasDataBlob <CargoStorageDB>())
{
var fuelsGuid = propulsionDB.FuelUsePerKM;
var storage = _state.LastClickedEntity.Entity.GetDataBlob <CargoStorageDB>();
foreach (var fuelItemGuid in fuelsGuid.Keys)
{
var fuel = _state.Game.StaticData.GetICargoable(fuelItemGuid);
ImGui.Text(fuel.Name);
ImGui.SameLine();
ImGui.Text(StorageSpaceProcessor.GetAmount(storage, fuel).ToString());
}
}
}
if (_state.LastClickedEntity.Entity.HasDataBlob <TranslateMoveDB>())
{
var db = _state.LastClickedEntity.Entity.GetDataBlob <TranslateMoveDB>();
if (ImGui.CollapsingHeader("Transit: ###TransitHeader", ImGuiTreeNodeFlags.CollapsingHeader))
{
ImGui.Text("EntryPoint " + db.TranslateEntryPoint_AU);
ImGui.Text("ExitPoint " + db.TranslationExitPoint_AU);
ImGui.Text("EDA " + db.PredictedExitTime.ToString());
double distance = Distance.DistanceBetween(db.TranslateEntryPoint_AU, db.TranslationExitPoint_AU);
ImGui.Text("Distance " + distance + " AU");
ImGui.SameLine();
double distancekm = Distance.AuToKm(distance);
ImGui.Text(distancekm.ToString() + " KM");
var timeToTarget = db.PredictedExitTime - _state.CurrentSystemDateTime;
ImGui.Text("Remaining TTT " + timeToTarget);
var totalTime = db.PredictedExitTime - db.EntryDateTime;
ImGui.Text("Total TTT " + totalTime);
double speed = ((distancekm * 1000) / totalTime.TotalSeconds);
ImGui.Text("speed2 " + speed);
ImGui.Text("LastDateTime: ");
ImGui.Text(db.LastProcessDateTime.ToString());
ImGui.Text("Time Since Last: ");
var timelen = _state.CurrentSystemDateTime - db.LastProcessDateTime;
ImGui.Text(timelen.ToString());
}
}
}
}
}
}
//else IsActive = false;
ImGui.End();
}
_isRunningFrame = false;
_dateChangeSinceLastFrame = false;
}
public void TestingKeplerConversions(OrbitDB orbitDB)
{
double sgp = orbitDB.GravitationalParameterAU;
double o_a = orbitDB.SemiMajorAxis;
double o_e = orbitDB.Eccentricity;
double o_i = Angle.ToRadians(orbitDB.Inclination);
double o_Ω = Angle.ToRadians(orbitDB.LongitudeOfAscendingNode);
double o_M0 = Angle.ToRadians(orbitDB.MeanAnomalyAtEpoch);
double o_n = Angle.ToRadians(orbitDB.MeanMotion);
double o_ω = Angle.ToRadians(orbitDB.ArgumentOfPeriapsis);
double o_lop = OrbitMath.LonditudeOfPeriapsis2d(o_Ω, o_ω, o_i);
DateTime o_epoch = orbitDB.Epoch;
double periodInSeconds = OrbitMath.GetOrbitalPeriodInSeconds(sgp, o_a);
Assert.AreEqual(periodInSeconds, orbitDB.OrbitalPeriod.TotalSeconds, 0.1);
//lets break the orbit up and check the rest of the paremeters at different points of the orbit:
double segmentTime = periodInSeconds / 16;
for (int i = 0; i < 16; i++)
{
TimeSpan timeSinceEpoch = TimeSpan.FromSeconds(segmentTime * i);
DateTime segmentDatetime = o_epoch + timeSinceEpoch;
double o_M = OrbitMath.GetMeanAnomalyFromTime(o_M0, o_n, timeSinceEpoch.TotalSeconds); //orbitProcessor uses this calc directly
double o_E = OrbitProcessor.GetEccentricAnomaly(orbitDB, o_M);
double o_ν = OrbitProcessor.GetTrueAnomaly(orbitDB, segmentDatetime);
var pos = OrbitProcessor.GetPosition_AU(orbitDB, segmentDatetime);
var vel = (Vector3)OrbitMath.InstantaneousOrbitalVelocityVector(sgp, pos, o_a, o_e, o_ν);
var ke = OrbitMath.KeplerFromPositionAndVelocity(sgp, pos, vel, segmentDatetime);
var ke_epoch = ke.Epoch;
double ke_a = ke.SemiMajorAxis;
double ke_e = ke.Eccentricity;
double ke_i = ke.Inclination;
double ke_Ω = ke.LoAN;
double ke_M0 = ke.MeanAnomalyAtEpoch;
double ke_n = ke.MeanMotion;
double ke_ω = ke.AoP;
double ke_E = OrbitMath.GetEccentricAnomalyNewtonsMethod(ke.Eccentricity, ke_M0);
double ke_ν = OrbitMath.TrueAnomalyFromEccentricAnomaly(ke_e, ke_E);
Assert.Multiple(() =>
{
//these should not change (other than floating point errors) between each itteration
Assert.AreEqual(o_a, ke_a, 0.001, "SemiMajorAxis a"); //should be more accurate than this, though if testing from a given set of ke to state, and back, the calculated could be more acurate...
Assert.AreEqual(o_e, ke_e, 0.00001, "Eccentricity e");
Assert.AreEqual(o_i, ke_i, 1.0E-7, "Inclination i expected: " + Angle.ToDegrees(o_i) + " was: " + Angle.ToDegrees(ke_i));
Assert.AreEqual(o_Ω, ke_Ω, 1.0E-7, "LoAN Ω expected: " + Angle.ToDegrees(o_Ω) + " was: " + Angle.ToDegrees(ke_Ω));
Assert.AreEqual(o_ω, ke_ω, 1.0E-7, "AoP ω expected: " + Angle.ToDegrees(o_ω) + " was: " + Angle.ToDegrees(ke_ω));
Assert.AreEqual(o_n, ke_n, 1.0E-7, "MeanMotion n expected: " + Angle.ToDegrees(o_n) + " was: " + Angle.ToDegrees(ke_n));
//these will change between itterations:
Assert.AreEqual(o_E, ke_E, 1.0E-7, "EccentricAnomaly E expected: " + Angle.ToDegrees(o_E) + " was: " + Angle.ToDegrees(ke_E));
Assert.AreEqual(o_ν, ke_ν, 1.0E-7, "True Anomaly ν expected: " + Angle.ToDegrees(o_ν) + " was: " + Angle.ToDegrees(ke_ν));
Assert.AreEqual(o_M, ke_M0, 1.0E-7, "MeanAnomaly M expected: " + Angle.ToDegrees(o_M) + " was: " + Angle.ToDegrees(ke_M0));
});
}
}
public void TestOrbitalVelocityCalcs(OrbitDB orbitDB)
{
double sgp = orbitDB.GravitationalParameterAU;
double o_a = orbitDB.SemiMajorAxis;
double o_e = orbitDB.Eccentricity;
double o_i = Angle.ToRadians(orbitDB.Inclination);
double o_Ω = Angle.ToRadians(orbitDB.LongitudeOfAscendingNode);
double o_M0 = Angle.ToRadians(orbitDB.MeanAnomalyAtEpoch);
double o_n = Angle.ToRadians(orbitDB.MeanMotion);
double o_ω = Angle.ToRadians(orbitDB.ArgumentOfPeriapsis);
double o_lop = OrbitMath.LonditudeOfPeriapsis2d(o_Ω, o_ω, o_i);
DateTime o_epoch = orbitDB.Epoch;
double periodInSeconds = orbitDB.OrbitalPeriod.TotalSeconds;
double segmentTime = periodInSeconds / 16;
//lets break the orbit up and check the paremeters at different points of the orbit:
for (int i = 0; i < 16; i++)
{
TimeSpan timeSinceEpoch = TimeSpan.FromSeconds(segmentTime * i);
DateTime segmentDatetime = o_epoch + timeSinceEpoch;
double o_M = OrbitMath.GetMeanAnomalyFromTime(o_M0, o_n, timeSinceEpoch.TotalSeconds); //orbitProcessor uses this calc directly
double o_E = OrbitProcessor.GetEccentricAnomaly(orbitDB, o_M);
double o_ν = OrbitProcessor.GetTrueAnomaly(orbitDB, segmentDatetime);
var pos = OrbitProcessor.GetPosition_AU(orbitDB, segmentDatetime);
var vel = (Vector3)OrbitMath.InstantaneousOrbitalVelocityVector(sgp, pos, o_a, o_e, o_ν);
Vector3 angularVelocity = Vector3.Cross(pos, vel);
double r = pos.Length();
double speedau = OrbitMath.InstantaneousOrbitalSpeed(sgp, r, o_a);
(double speed, double heading)polarVelocity = OrbitMath.InstantaneousOrbitalVelocityPolarCoordinate(sgp, pos, o_a, o_e, o_ν);
//Tuple<double, double> polarVelocity2 = OrbitMath.PreciseOrbitalVelocityPolarCoordinate2(sgp, pos, o_a, o_e, o_ν, o_lop);
double heading = OrbitMath.HeadingFromPeriaps(pos, o_e, o_a, o_ν);
heading += o_lop;
//Assert.IsTrue(angularVelocity.Z > 0); //TODO:this will break if we test an anti clockwise orbit.
Assert.IsTrue(speedau > 0); //I'm assuming that speed will be <0 if retrograde orbit.
Assert.AreEqual(vel.Length(), speedau, 1.0E-7);
Assert.AreEqual(vel.Length(), polarVelocity.Item1, 1.0E-7);
double hackHeading = OrbitMath.HackVelocityHeading(orbitDB, segmentDatetime);
double hackheadD = Angle.ToDegrees(hackHeading);
double headingD = Angle.ToDegrees(heading);
if (o_e == 0) //we can make this work with ellipses if we add the lop to the position.
{
if (pos.X > 0 && pos.Y > 0) //top right quadrant
{
//Assert.IsTrue(polarVelocity.Item2 > Math.PI * 0.5 && polarVelocity.Item2 < Math.PI);
//Assert.IsTrue(hackHeading > Math.PI * 0.5 && hackHeading < Math.PI);
Assert.IsTrue(heading >= Math.PI * 0.5 && heading <= Math.PI);
}
if (pos.X < 0 && pos.Y > 0)//top left quadrant
{
//Assert.IsTrue(polarVelocity.Item2 > Math.PI && polarVelocity.Item2 < Math.PI * 1.5);
//Assert.IsTrue(hackHeading > Math.PI && hackHeading < Math.PI * 1.5);
Assert.IsTrue(heading >= Math.PI && heading <= Math.PI * 1.5);
}
if (pos.X < 0 && pos.Y < 0)//bottom left quadrant
{
//Assert.IsTrue(polarVelocity.Item2 > Math.PI * 1.5 && polarVelocity.Item2 < Math.PI * 2);
//Assert.IsTrue(hackHeading > Math.PI * 1.5 && hackHeading < Math.PI * 2);
Assert.IsTrue(heading >= Math.PI * 1.5 && heading <= Math.PI * 2);
}
if (pos.X > 0 && pos.Y < 0)//bottom right quadrant
{
//Assert.IsTrue(polarVelocity.Item2 > 0 && polarVelocity.Item2 < Math.PI * 0.5);
//Assert.IsTrue(hackHeading > 0 && hackHeading < Math.PI * 0.5);
Assert.IsTrue(heading >= 0 && heading <= Math.PI * 0.5);
}
}
}
}
public void TestOrbitDBFromVectors(double parentMass, double objMass, Vector3 position, Vector3 velocity)
{
double angleΔ = 0.0000000001;
double sgp_m = OrbitMath.CalculateStandardGravityParameterInM3S2(objMass, parentMass);
KeplerElements ke = OrbitMath.KeplerFromPositionAndVelocity(sgp_m, position, velocity, new DateTime());
Game game = new Game();
EntityManager man = new EntityManager(game, false);
BaseDataBlob[] parentblobs = new BaseDataBlob[3];
parentblobs[0] = new PositionDB(man.ManagerGuid)
{
X_AU = 0, Y_AU = 0, Z_AU = 0
};
parentblobs[1] = new MassVolumeDB()
{
Mass = parentMass
};
parentblobs[2] = new OrbitDB();
Entity parentEntity = new Entity(man, parentblobs);
OrbitDB objOrbit = OrbitDB.FromVector(parentEntity, objMass, parentMass, sgp_m, position, velocity, new DateTime());
Vector3 resultPos = OrbitProcessor.GetPosition_AU(objOrbit, new DateTime());
//check LoAN
var objLoAN = objOrbit.LongitudeOfAscendingNode;
var keLoAN = ke.LoAN;
var loANDifference = objLoAN - keLoAN;
Assert.AreEqual(keLoAN, objLoAN, angleΔ);
//check AoP
var objAoP = objOrbit.ArgumentOfPeriapsis;
var keAoP = ke.AoP;
var difference = objAoP - keAoP;
Assert.AreEqual(keAoP, objAoP, angleΔ);
//check MeanAnomalyAtEpoch
var objM0 = objOrbit.MeanAnomalyAtEpoch;
var keM0 = ke.MeanAnomalyAtEpoch;
Assert.AreEqual(keM0, objM0, angleΔ);
Assert.AreEqual(objM0, OrbitMath.GetMeanAnomalyFromTime(objM0, objOrbit.MeanMotion_DegreesSec, 0), "meanAnomalyError");
//checkEpoch
var objEpoch = objOrbit.Epoch;
var keEpoch = ke.Epoch;
Assert.AreEqual(keEpoch, objEpoch);
//check EccentricAnomaly:
var objE = (OrbitProcessor.GetEccentricAnomaly(objOrbit, objOrbit.MeanAnomalyAtEpoch_Degrees));
//var keE = (OrbitMath.Gete(position, ke.SemiMajorAxis, ke.LinearEccentricity, ke.AoP));
/*
* if (objE != keE)
* {
* var dif = objE - keE;
* Assert.AreEqual(keE, objE, angleΔ);
* }
*/
//check trueAnomaly
var orbTrueAnom = OrbitProcessor.GetTrueAnomaly(objOrbit, new DateTime());
var orbtaDeg = Angle.ToDegrees(orbTrueAnom);
var differenceInRadians = orbTrueAnom - ke.TrueAnomalyAtEpoch;
var differenceInDegrees = Angle.ToDegrees(differenceInRadians);
if (ke.TrueAnomalyAtEpoch != orbTrueAnom)
{
Vector3 eccentVector = OrbitMath.EccentricityVector(sgp_m, position, velocity);
var tacalc1 = OrbitMath.TrueAnomaly(eccentVector, position, velocity);
var tacalc2 = OrbitMath.TrueAnomaly(sgp_m, position, velocity);
var diffa = differenceInDegrees;
var diffb = Angle.ToDegrees(orbTrueAnom - tacalc1);
var diffc = Angle.ToDegrees(orbTrueAnom - tacalc2);
var ketaDeg = Angle.ToDegrees(tacalc1);
}
Assert.AreEqual(0, Angle.DifferenceBetweenRadians(ke.TrueAnomalyAtEpoch, orbTrueAnom), angleΔ,
"more than " + angleΔ + " radians difference, at " + differenceInRadians + " \n " +
"(more than " + Angle.ToDegrees(angleΔ) + " degrees difference at " + differenceInDegrees + ")" + " \n " +
"ke Angle: " + ke.TrueAnomalyAtEpoch + " obj Angle: " + orbTrueAnom + " \n " +
"ke Angle: " + Angle.ToDegrees(ke.TrueAnomalyAtEpoch) + " obj Angle: " + Angle.ToDegrees(orbTrueAnom));
Assert.AreEqual(ke.Eccentricity, objOrbit.Eccentricity);
Assert.AreEqual(ke.SemiMajorAxis, objOrbit.SemiMajorAxis);
var lenke1 = ke.SemiMajorAxis * 2;
var lenke2 = ke.Apoapsis + ke.Periapsis;
Assert.AreEqual(lenke1, lenke2, 1.0E-10);
var lendb1 = objOrbit.SemiMajorAxis_AU * 2;
var lendb2 = objOrbit.Apoapsis_AU + objOrbit.Periapsis_AU;
Assert.AreEqual(lendb1, lendb2, 1.0E-10);
Assert.AreEqual(lenke1, lendb1, 1.0E-10);
Assert.AreEqual(lenke2, lendb2, 1.0E-10);
var ke_apkm = Distance.AuToKm(ke.Apoapsis);
var db_apkm = Distance.AuToKm(objOrbit.Apoapsis_AU);
var differnce = ke_apkm - db_apkm;
Assert.AreEqual(ke.Apoapsis, objOrbit.Apoapsis_AU, 1.0E-10);
Assert.AreEqual(ke.Periapsis, objOrbit.Periapsis_AU, 1.0E-10);
Vector3 posKM = Distance.AuToKm(position);
Vector3 resultKM = Distance.AuToKm(resultPos);
double keslr = EllipseMath.SemiLatusRectum(ke.SemiMajorAxis, ke.Eccentricity);
double keradius = OrbitMath.RadiusAtAngle(ke.TrueAnomalyAtEpoch, keslr, ke.Eccentricity);
Vector3 kemathPos = OrbitMath.GetRalitivePosition(ke.LoAN, ke.AoP, ke.Inclination, ke.TrueAnomalyAtEpoch, keradius);
Vector3 kemathPosKM = Distance.AuToKm(kemathPos);
Assert.AreEqual(kemathPosKM.Length(), posKM.Length(), 0.01);
Assert.AreEqual(posKM.Length(), resultKM.Length(), 0.01, "TA: " + orbtaDeg);
Assert.AreEqual(posKM.X, resultKM.X, 0.01, "TA: " + orbtaDeg);
Assert.AreEqual(posKM.Y, resultKM.Y, 0.01, "TA: " + orbtaDeg);
Assert.AreEqual(posKM.Z, resultKM.Z, 0.01, "TA: " + orbtaDeg);
if (velocity.Z == 0)
{
Assert.IsTrue(ke.Inclination == 0);
Assert.IsTrue(objOrbit.Inclination_Degrees == 0);
}
//var speedVectorAU = OrbitProcessor.PreciseOrbitalVector(sgp, position, ke.SemiMajorAxis);
//var speedVectorAU2 = OrbitProcessor.PreciseOrbitalVector(objOrbit, new DateTime());
//Assert.AreEqual(speedVectorAU, speedVectorAU2);
}
public void TestIntercept()
{
double myMass = 10000;
double parentMass = 1.989e30; //solar mass.
Game game = new Game();
EntityManager mgr = new EntityManager(game, false);
BaseDataBlob[] parentblobs = new BaseDataBlob[3];
parentblobs[0] = new PositionDB(mgr.ManagerGuid)
{
X_AU = 0, Y_AU = 0, Z_AU = 0
};
parentblobs[1] = new MassVolumeDB()
{
Mass = parentMass
};
parentblobs[2] = new OrbitDB();
Entity parentEntity = new Entity(mgr, parentblobs);
Vector3 currentPos_m = new Vector3 {
X = Distance.AuToMt(-0.77473184638034), Y = Distance.AuToMt(0.967145228951685)
};
Vector3 currentVelocity_m = new Vector3 {
Y = Distance.KmToM(40)
};
double nonNewtSpeed_m = Distance.KmToM(283.018);
Vector3 targetObjPosition = new Vector3 {
X = Distance.AuToMt(0.149246434443459), Y = Distance.AuToMt(-0.712107888348067)
};
Vector3 targetObjVelocity = new Vector3 {
Y = Distance.KmToM(35)
};
double sgp_m = OrbitMath.CalculateStandardGravityParameterInM3S2(myMass, parentMass);
//KeplerElements ke = OrbitMath.KeplerFromVelocityAndPosition(sgp, targetObjPosition, targetObjVelocity);
var currentDateTime = new DateTime(2000, 1, 1);
OrbitDB targetOrbit = OrbitDB.FromVector(parentEntity, myMass, parentMass, sgp_m, targetObjPosition, targetObjVelocity, currentDateTime);
var intercept_m = OrbitMath.GetInterceptPosition_m(currentPos_m, nonNewtSpeed_m, targetOrbit, currentDateTime);
var futurePos1_m = OrbitProcessor.GetAbsolutePosition_m(targetOrbit, intercept_m.Item2);
var futurePos2_m = intercept_m.Item1;
Assert.AreEqual(futurePos1_m.Length(), futurePos2_m.Length(), 0.01);
Assert.AreEqual(futurePos1_m.X, futurePos2_m.X, 0.01);
Assert.AreEqual(futurePos1_m.Y, futurePos2_m.Y, 0.01);
Assert.AreEqual(futurePos1_m.Z, futurePos2_m.Z, 0.01);
var time = intercept_m.Item2 - currentDateTime;
var distance_m = (currentPos_m - intercept_m.Item1).Length();
var speed = distance_m / time.TotalSeconds;
var distb_m = nonNewtSpeed_m * time.TotalSeconds;
var timeb = distance_m / nonNewtSpeed_m;
Assert.AreEqual(nonNewtSpeed_m, speed, 1.0e-4);
var dif = distance_m - distb_m;
Assert.AreEqual(distance_m, distb_m, 100.0, "Out by a difference of " + dif + " meters");
}
internal override void Display()
{
_isRunningFrame = true;
if (IsActive)
{
SetFrameRateArray();
if (ImGui.Begin("debug", ref IsActive))
{
ImGui.Text(_state.PrimarySystemDateTime.ToString());
ImGui.Text("Cursor World Coordinate:");
var mouseWorldCoord = _state.Camera.MouseWorldCoordinate();
ImGui.Text("x" + mouseWorldCoord.X);
ImGui.SameLine();
ImGui.Text("y" + mouseWorldCoord.Y);
if (ImGui.CollapsingHeader("FrameRates", ImGuiTreeNodeFlags.CollapsingHeader))
{
//plot vars: (label, values, valueOffset, overlayText, scaleMin, scaleMax, graphSize, Stride)
//core game processing rate.
//ImGui.PlotHistogram("##GRHistogram", _gameRatesDisplay, 10, _timeSpan.TotalSeconds.ToString(), 0, 1f, new ImVec2(0, 80), sizeof(float));
//ImGui.PlotHistogram("##GRHistogram1", _gameRatesDisplay, 0 , _timeSpan.TotalSeconds.ToString(), 0, 1f, new ImVec2(0, 80), sizeof(float));
//string label, ref float values...
//ImGui.PlotHistogram(
ImGui.PlotHistogram("Game Tick ##GTHistogram", ref _gameRates[0], _gameRates.Length, _gameRateIndex, _currentGFPS.ToString(), 0f, largestGFPS, new Vector2(248, 60), sizeof(float));
ImGui.PlotLines("Game Tick ##GTPlotlines", ref _gameRates[0], _gameRates.Length, _gameRateIndex, _currentGFPS.ToString(), 0, largestGFPS, new Vector2(248, 60), sizeof(float));
//current star system processing rate.
ImGui.PlotHistogram("System Tick ##STHistogram", ref _systemRates[0], _systemRates.Length, _systemRateIndex, _currentSFPS.ToString(), 0f, 1f, new Vector2(248, 60), sizeof(float));
ImGui.PlotLines("System Tick ##STPlotlines", ref _systemRates[0], _systemRates.Length, _systemRateIndex, _currentSFPS.ToString(), 0, 1, new Vector2(248, 60), sizeof(float));
//ui framerate
ImGui.PlotHistogram("Frame Rate ##FPSHistogram", ref _frameRates[0], _frameRates.Length, _frameRateIndex, _currentFPS.ToString(), 0f, 10000, new Vector2(248, 60), sizeof(float));
foreach (var item in _systemState.StarSystem.ManagerSubpulses.ProcessTime)
{
ImGui.Text(item.Key.Name);
ImGui.SameLine();
ImGui.Text(item.Value.ToString());
}
}
if (ImGui.CollapsingHeader("GraphicTests", ImGuiTreeNodeFlags.CollapsingHeader))
{
var window = GraphicDebugWindow.GetWindow(_state);
window.Display();
window.Enable(true, _state);
}
ImGui.Text("Selected Star System: " + _state.SelectedStarSysGuid);
ImGui.Text("Number Of Entites: " + _state.SelectedSystem.NumberOfEntites);
if (ImGui.CollapsingHeader("Log"))
{
ImGui.BeginChild("LogChild", new Vector2(800, 300), true);
ImGui.Columns(4, "Events", true);
ImGui.Text("DateTime");
ImGui.NextColumn();
ImGui.Text("Faction");
ImGui.NextColumn();
ImGui.Text("Entity");
ImGui.NextColumn();
ImGui.Text("Event Message");
ImGui.NextColumn();
foreach (var gameEvent in StaticRefLib.EventLog.GetAllEvents())
{
string entityStr = "";
if (gameEvent.Entity != null)
{
if (gameEvent.Entity.HasDataBlob <NameDB>())
{
entityStr = gameEvent.Entity.GetDataBlob <NameDB>().DefaultName;
}
else
{
entityStr = gameEvent.Entity.Guid.ToString();
}
}
string factionStr = "";
if (gameEvent.Faction != null)
{
if (gameEvent.Faction.HasDataBlob <NameDB>())
{
factionStr = gameEvent.Faction.GetDataBlob <NameDB>().DefaultName;
}
else
{
factionStr = gameEvent.Faction.Guid.ToString();
}
}
ImGui.Separator();
ImGui.Text(gameEvent.Time.ToString());
ImGui.NextColumn();
ImGui.Text(factionStr);
ImGui.NextColumn();
ImGui.Text(entityStr);
ImGui.NextColumn();
ImGui.TextWrapped(gameEvent.Message);
ImGui.NextColumn();
}
//ImGui.Separator();
//ImGui.Columns();
ImGui.EndChild();
}
if (ImGui.CollapsingHeader("Entity List"))
{
List <Entity> factionOwnedEntites = _state.SelectedSystem.GetEntitiesByFaction(_state.Faction.Guid);
List <string> entityNames = new List <string>();
foreach (var entity in factionOwnedEntites)
{
var name = entity.GetDataBlob <NameDB>();
if (name != null)
{
entityNames.Add(name.GetName(_state.Faction.Guid));
}
}
int item = 0;
ImGui.ListBox("Entites", ref item, entityNames.ToArray(), entityNames.Count);
}
if (_selectedEntityState != null && _selectedEntityState.Name != null && _selectedEntity.IsValid)
{
if (ImGui.CollapsingHeader("Selected Entity: " + _state.LastClickedEntity.Name + "###NameHeader", ImGuiTreeNodeFlags.CollapsingHeader))
{
ImGui.Text(_state.LastClickedEntity.Entity.Guid.ToString());
if (_selectedEntity.HasDataBlob <PositionDB>())
{
var positiondb = _selectedEntity.GetDataBlob <PositionDB>();
var posv4 = positiondb.AbsolutePosition_AU;
ImGui.Text("x: " + posv4.X);
ImGui.Text("y: " + posv4.Y);
ImGui.Text("z: " + posv4.Z);
if (positiondb.Parent != null)
{
ImGui.Text("Parent: " + positiondb.Parent.GetDataBlob <NameDB>().DefaultName);
ImGui.Text("Dist: " + Distance.AuToKm(positiondb.RelativePosition_AU.Length()));
}
}
if (_selectedEntity.HasDataBlob <MassVolumeDB>())
{
if (ImGui.CollapsingHeader("MassVolumeDB: ###MassVolDBHeader", ImGuiTreeNodeFlags.CollapsingHeader))
{
MassVolumeDB mvdb = _selectedEntity.GetDataBlob <MassVolumeDB>();
ImGui.Text("Mass " + mvdb.Mass + "Kg");
ImGui.Text("Volume " + mvdb.Volume + "Km^3");
ImGui.Text("Density " + mvdb.Density + "g/cm^3");
ImGui.Text("Radius " + mvdb.Radius + "Km");
}
}
if (_selectedEntity.HasDataBlob <OrbitDB>())
{
if (ImGui.Checkbox("Draw SOI", ref _drawSOI))
{
SimpleCircle cir;
if (_drawSOI)
{
var soiradius = OrbitProcessor.GetSOI(_selectedEntity);
var colour = new SDL2.SDL.SDL_Color()
{
r = 0, g = 255, b = 0, a = 100
};
cir = new SimpleCircle(_selectedEntity.GetDataBlob <PositionDB>(), soiradius, colour);
_state.SelectedSysMapRender.UIWidgets.Add(nameof(cir), cir);
}
else
{
_state.SelectedSysMapRender.UIWidgets.Remove(nameof(cir));
}
}
if (ImGui.CollapsingHeader("OrbitDB: ###OrbitDBHeader", ImGuiTreeNodeFlags.CollapsingHeader))
{
OrbitDB orbitDB = _selectedEntity.GetDataBlob <OrbitDB>();
//if (_state.CurrentSystemDateTime != lastDate)
//{
pos = OrbitProcessor.GetAbsolutePosition_AU(orbitDB, _state.PrimarySystemDateTime);
truAnomoly = OrbitProcessor.GetTrueAnomaly(orbitDB, _state.PrimarySystemDateTime);
lastDate = _state.PrimarySystemDateTime;
//}
ImGui.Text("x: " + pos.X);
ImGui.Text("y: " + pos.Y);
ImGui.Text("z: " + pos.Z);
ImGui.Text("Eccentricity: " + orbitDB.Eccentricity);
ImGui.Text("AoP:" + orbitDB.ArgumentOfPeriapsis);
ImGui.Text("TrueAnomaly: " + truAnomoly);
ImGui.Text("MeanMotion: " + orbitDB.MeanMotion + " in Deg/s");
ImGui.Text("MeanVelocity: " + OrbitMath.MeanOrbitalVelocityInAU(orbitDB) + "Au/s");
ImGui.Text("MeanVelocity: " + Distance.AuToKm(OrbitMath.MeanOrbitalVelocityInAU(orbitDB)) + "Km/s");
ImGui.Text("SOI Radius: " + Distance.AuToKm(OrbitProcessor.GetSOI(_state.LastClickedEntity.Entity)));
ImGui.Text("Orbital Period:" + orbitDB.OrbitalPeriod);
ImGui.Text("SemiMajAxis: " + orbitDB.SemiMajorAxis);
ImGui.Text("Periapsis: " + Distance.AuToKm(orbitDB.Periapsis).ToString("g3") + " Km");
ImGui.Text("Appoapsis: " + Distance.AuToKm(orbitDB.Apoapsis).ToString("g3") + " Km");
if (orbitDB.Parent != null)
{
ImGui.Text("Parent: " + orbitDB.Parent.GetDataBlob <NameDB>().DefaultName);
}
if (orbitDB.Children.Count > 0)
{
foreach (var item in orbitDB.Children)
{
ImGui.Text(item.GetDataBlob <NameDB>().DefaultName);
}
}
}
}
if (_selectedEntity.HasDataBlob <NewtonMoveDB>())
{
if (ImGui.Checkbox("Draw Parent SOI", ref _drawParentSOI))
{
SimpleCircle psoi;
SimpleLine psoilin;
if (_drawParentSOI)
{
var myPos = _selectedEntity.GetDataBlob <PositionDB>();
var parent = myPos.Parent;
var pObt = parent.GetDataBlob <OrbitDB>();
var cnmve = _selectedEntity.GetDataBlob <NewtonMoveDB>();
var soiradius = OrbitProcessor.GetSOI(parent);
var colour = new SDL2.SDL.SDL_Color()
{
r = 0, g = 255, b = 0, a = 100
};
psoi = new SimpleCircle(parent.GetDataBlob <PositionDB>(), soiradius, colour);
var pmass = parent.GetDataBlob <MassVolumeDB>().Mass;
var mymass = _selectedEntity.GetDataBlob <MassVolumeDB>().Mass;
var sgp = GameConstants.Science.GravitationalConstant * (pmass + mymass) / 3.347928976e33;
var vel = Distance.KmToAU(cnmve.CurrentVector_kms);
var cpos = myPos.RelativePosition_AU;
var eccentVector = OrbitMath.EccentricityVector(sgp, cpos, vel);
double ce = eccentVector.Length();
var r = cpos.Length();
var v = vel.Length();
var ca = 1 / (2 / r - Math.Pow(v, 2) / sgp);
var cp = EllipseMath.SemiLatusRectum(ca, ce);
var cAoP = Math.Atan2(eccentVector.Y, eccentVector.X);
/*
* var pa = pObt.SemiMajorAxis;
* var pe = pObt.Eccentricity;
* var pp = EllipseMath.SemiLatusRectum(pa, pe);
*/
double θ = OrbitMath.AngleAtRadus(soiradius, cp, ce);
θ += cAoP;
var x = soiradius * Math.Cos(θ);
var y = soiradius * Math.Sin(θ);
psoilin = new SimpleLine(parent.GetDataBlob <PositionDB>(), new PointD()
{
X = x, Y = y
}, colour);
_state.SelectedSysMapRender.UIWidgets.Add(nameof(psoi), psoi);
_state.SelectedSysMapRender.UIWidgets.Add(nameof(psoilin), psoilin);
}
else
{
_state.SelectedSysMapRender.UIWidgets.Remove(nameof(psoi));
_state.SelectedSysMapRender.UIWidgets.Remove(nameof(psoilin));
}
}
}
if (_state.LastClickedEntity.OrbitIcon != null)
{
if (ImGui.CollapsingHeader("OrbitIcon: ###OrbitIconHeader", ImGuiTreeNodeFlags.CollapsingHeader))
{
OrbitDB orbitDB = _selectedEntity.GetDataBlob <OrbitDB>();
//string startRadian = _state.LastClickedEntity.OrbitIcon._ellipseStartArcAngleRadians.ToString();
//string startDegrees = Angle.ToDegrees(_state.LastClickedEntity.OrbitIcon._ellipseStartArcAngleRadians).ToString();
//ImGui.Text("StartAngleRadians: " + startRadian);
//ImGui.Text("StartAngleDegrees: " + startDegrees);
if (ImGui.CollapsingHeader("OrbitIconLines", ImGuiTreeNodeFlags.CollapsingHeader))
{
var window = OrbitalDebugWindow.GetWindow(_state.LastClickedEntity);
window.Display();
window.Enable(true, _state);
}
}
}
if (_selectedEntity.HasDataBlob <PropulsionAbilityDB>())
{
if (ImGui.CollapsingHeader("Propulsion: ###PropulsionHeader", ImGuiTreeNodeFlags.CollapsingHeader))
{
PropulsionAbilityDB propulsionDB = _selectedEntity.GetDataBlob <PropulsionAbilityDB>();
ImGui.Text("NonNewt Engine Power: " + propulsionDB.TotalEnginePower);
ImGui.Text("Max Speed: " + propulsionDB.MaximumSpeed_MS);
ImGui.Text("CurrentVector: " + propulsionDB.CurrentVectorMS);
ImGui.Text("Current Speed: " + ECSLib.Vector3.Magnitude(propulsionDB.CurrentVectorMS));
if (_state.LastClickedEntity.Entity.HasDataBlob <CargoStorageDB>())
{
var fuelsGuid = propulsionDB.FuelUsePerKM;
var storage = _state.LastClickedEntity.Entity.GetDataBlob <CargoStorageDB>();
foreach (var fuelItemGuid in fuelsGuid.Keys)
{
var fuel = _state.Game.StaticData.GetICargoable(fuelItemGuid);
ImGui.Text(fuel.Name);
ImGui.SameLine();
ImGui.Text(StorageSpaceProcessor.GetAmount(storage, fuel).ToString());
}
}
}
if (_state.LastClickedEntity.Entity.HasDataBlob <TranslateMoveDB>())
{
var db = _state.LastClickedEntity.Entity.GetDataBlob <TranslateMoveDB>();
if (ImGui.CollapsingHeader("Transit: ###TransitHeader", ImGuiTreeNodeFlags.CollapsingHeader))
{
ImGui.Text("EntryPoint " + db.TranslateEntryPoint_AU);
ImGui.Text("ExitPoint " + db.TranslateExitPoint_AU);
ImGui.Text("EDA " + db.PredictedExitTime.ToString());
double distance = Distance.DistanceBetween(db.TranslateEntryPoint_AU, db.TranslateExitPoint_AU);
ImGui.Text("Distance " + distance + " AU");
ImGui.SameLine();
double distancekm = Distance.AuToKm(distance);
ImGui.Text(distancekm.ToString() + " KM");
var timeToTarget = db.PredictedExitTime - _state.PrimarySystemDateTime;
ImGui.Text("Remaining TTT " + timeToTarget);
var totalTime = db.PredictedExitTime - db.EntryDateTime;
ImGui.Text("Total TTT " + totalTime);
double speed = ((distancekm * 1000) / totalTime.TotalSeconds);
ImGui.Text("speed2 " + speed);
ImGui.Text("LastDateTime: ");
ImGui.Text(db.LastProcessDateTime.ToString());
ImGui.Text("Time Since Last: ");
var timelen = _state.PrimarySystemDateTime - db.LastProcessDateTime;
ImGui.Text(timelen.ToString());
}
}
}
if (_selectedEntity.HasDataBlob <SensorInfoDB>())
{
var actualEntity = _selectedEntity.GetDataBlob <SensorInfoDB>().DetectedEntity;
if (actualEntity.IsValid && actualEntity.HasDataBlob <AsteroidDamageDB>())
{
var dmgDB = actualEntity.GetDataBlob <AsteroidDamageDB>();
ImGui.Text("Remaining HP: " + dmgDB.Health.ToString());
}
}
}
}
}
//else IsActive = false;
ImGui.End();
}
_isRunningFrame = false;
_dateChangeSinceLastFrame = false;
}
public static Entity CreateShip(ShipDesign shipDesign, Entity ownerFaction, Vector3 position, Entity parent, StarSystem starsys, string shipName = null)
{
List <BaseDataBlob> dataBlobs = new List <BaseDataBlob>();
var shipinfo = new ShipInfoDB();
dataBlobs.Add(shipinfo);
var mvdb = MassVolumeDB.NewFromMassAndVolume(shipDesign.MassPerUnit, shipDesign.VolumePerUnit);
dataBlobs.Add(mvdb);
PositionDB posdb = new PositionDB(Distance.MToAU(position), starsys.Guid, parent);
dataBlobs.Add(posdb);
EntityDamageProfileDB damagedb = (EntityDamageProfileDB)shipDesign.DamageProfileDB.Clone();
dataBlobs.Add(damagedb);
ComponentInstancesDB compInstances = new ComponentInstancesDB();
dataBlobs.Add(compInstances);
OrderableDB ordable = new OrderableDB();
dataBlobs.Add(ordable);
var ship = Entity.Create(starsys, ownerFaction.Guid, dataBlobs);
StaticDataStore staticdata = StaticRefLib.StaticData;
ComponentDesigner fireControlDesigner;
ComponentDesign integratedfireControl;
ComponentTemplateSD bfcSD = staticdata.ComponentTemplates[new Guid("33fcd1f5-80ab-4bac-97be-dbcae19ab1a0")];
fireControlDesigner = new ComponentDesigner(bfcSD, ownerFaction.GetDataBlob <FactionTechDB>());
fireControlDesigner.Name = "Bridge Computer Systems";
fireControlDesigner.ComponentDesignAttributes["Range"].SetValueFromInput(0);
fireControlDesigner.ComponentDesignAttributes["Tracking Speed"].SetValueFromInput(0);
fireControlDesigner.ComponentDesignAttributes["Size vs Range"].SetValueFromInput(0);
//return fireControlDesigner.CreateDesign(faction);
integratedfireControl = fireControlDesigner.CreateDesign(ownerFaction);
ownerFaction.GetDataBlob <FactionTechDB>().IncrementLevel(integratedfireControl.TechID);
//some DB's need tobe created after the entity.
var namedb = new NameDB(ship.Guid.ToString());
namedb.SetName(ownerFaction.Guid, shipName);
OrbitDB orbit = OrbitDB.FromPosition(parent, ship, starsys.ManagerSubpulses.StarSysDateTime);
ship.SetDataBlob(namedb);
ship.SetDataBlob(orbit);
EntityManipulation.AddComponentToEntity(ship, integratedfireControl, 1);
foreach (var item in shipDesign.Components)
{
EntityManipulation.AddComponentToEntity(ship, item.design, item.count);
}
if (ship.HasDataBlob <NewtonThrustAbilityDB>())
{
NewtonionMovementProcessor.UpdateNewtonThrustAbilityDB(ship);
}
return(ship);
}
public void TestIntercept()
{
double myMass = 10000;
double parentMass = 1.989e30; //solar mass.
Game game = new Game();
EntityManager mgr = new EntityManager(game, false);
BaseDataBlob[] parentblobs = new BaseDataBlob[3];
parentblobs[0] = new PositionDB(mgr.ManagerGuid)
{
X = 0, Y = 0, Z = 0
};
parentblobs[1] = new MassVolumeDB()
{
Mass = parentMass
};
parentblobs[2] = new OrbitDB();
Entity parentEntity = new Entity(mgr, parentblobs);
Vector3 currentPos = new Vector3 {
X = -0.77473184638034, Y = 0.967145228951685
};
Vector3 currentVelocity = new Vector3 {
Y = Distance.KmToAU(40)
};
double nonNewtSpeed = Distance.KmToAU(283.018);
Vector3 targetObjPosition = new Vector3 {
X = 0.149246434443459, Y = -0.712107888348067
};
Vector3 targetObjVelocity = new Vector3 {
Y = Distance.KmToAU(35)
};
double sgp = GameConstants.Science.GravitationalConstant * (parentMass + myMass) / 3.347928976e33;
//KeplerElements ke = OrbitMath.KeplerFromVelocityAndPosition(sgp, targetObjPosition, targetObjVelocity);
var currentDateTime = new DateTime(2000, 1, 1);
OrbitDB targetOrbit = OrbitDB.FromVector(parentEntity, myMass, parentMass, sgp, targetObjPosition, targetObjVelocity, currentDateTime);
var intercept = InterceptCalcs.GetInterceptPosition2(currentPos, nonNewtSpeed, targetOrbit, currentDateTime);
var futurePos1 = Distance.AuToKm(OrbitProcessor.GetAbsolutePosition_AU(targetOrbit, intercept.Item2));
var futurePos2 = Distance.AuToKm(intercept.Item1);
Assert.AreEqual(futurePos1.Length(), futurePos2.Length(), 0.01);
Assert.AreEqual(futurePos1.X, futurePos2.X, 0.01);
Assert.AreEqual(futurePos1.Y, futurePos2.Y, 0.01);
Assert.AreEqual(futurePos1.Z, futurePos2.Z, 0.01);
var time = intercept.Item2 - currentDateTime;
var distance = (currentPos - intercept.Item1).Length();
var distancekm = Distance.AuToKm(distance);
var speed = distance / time.TotalSeconds;
var speed2 = distancekm / time.TotalSeconds;
var distb = nonNewtSpeed * time.TotalSeconds;
var distbKM = Distance.AuToKm(distb);
var timeb = distance / nonNewtSpeed;
Assert.AreEqual(nonNewtSpeed, speed, 1.0e-10);
var dif = distancekm - distbKM;
Assert.AreEqual(distancekm, distbKM, 0.25);
}
void HandleChanges(EntityState entityState)
{
foreach (var changeData in entityState.Changes)
{
if (changeData.ChangeType == EntityChangeData.EntityChangeType.DBAdded)
{
if (changeData.Datablob is OrbitDB)
{
OrbitDB orbit = (OrbitDB)changeData.Datablob;
if (orbit.Parent == null)
{
continue;
}
if (!orbit.IsStationary)
{
if (_sysState.EntityStatesWithPosition.ContainsKey(changeData.Entity.Guid))
{
entityState = _sysState.EntityStatesWithPosition[changeData.Entity.Guid];
}
else
{
entityState = new EntityState(changeData.Entity)
{
Name = "Unknown"
}
};
_orbitRings[changeData.Entity.Guid] = new OrbitEllipseIcon(entityState, _state.UserOrbitSettingsMtx);
}
}
if (changeData.Datablob is WarpMovingDB)
{
var widget = new ShipMoveWidget(changeData.Entity);
widget.OnPhysicsUpdate();
//Matrix matrix = new Matrix();
//matrix.Scale(_camera.ZoomLevel);
//widget.OnFrameUpdate(matrix, _camera);
_moveIcons[changeData.Entity.Guid] = widget;
//_moveIcons.Add(changeData.Entity.ID, widget);
}
if (changeData.Datablob is NewtonMoveDB)
{
if (entityState.Entity.HasDataBlob <NewtonMoveDB>()) //because sometimes it can be added and removed in a single tick.
{
OrbitHypobolicIcon orb;
orb = new OrbitHypobolicIcon(entityState, _state.UserOrbitSettingsMtx);
_orbitRings.AddOrUpdate(changeData.Entity.Guid, orb, ((guid, data) => data = orb));
}
}
//if (changeData.Datablob is NameDB)
//TextIconList[changeData.Entity.ID] = new TextIcon(changeData.Entity, _camera);
//_entityIcons[changeData.Entity.ID] = new EntityIcon(changeData.Entity, _camera);
}
if (changeData.ChangeType == EntityChangeData.EntityChangeType.DBRemoved)
{
if (changeData.Datablob is OrbitDB)
{
_orbitRings.TryRemove(changeData.Entity.Guid, out IDrawData foo);
}
if (changeData.Datablob is WarpMovingDB)
{
_moveIcons.TryRemove(changeData.Entity.Guid, out IDrawData foo);
}
if (changeData.Datablob is NewtonMoveDB)
{
_orbitRings.TryRemove(changeData.Entity.Guid, out IDrawData foo);
}
//if (changeData.Datablob is NameDB)
//TextIconList.Remove(changeData.Entity.ID);
}
}
}
void TextIconsDistribute()
{
if (_nameIcons.Count == 0)
{
return;
}
var occupiedPosition = new List <IRectangle>();
IComparer <IRectangle> byViewPos = new ByViewPosition();
var textIconList = new List <NameIcon>(_nameIcons.Values);
//Consolidate TextIcons that share the same position and name
textIconList.Sort();
int listLength = textIconList.Count;
int textIconQuantity = 1;
for (int i = 1; i < listLength; i++)
{
if (textIconList[i - 1].CompareTo(textIconList[i]) == 0)
{
textIconQuantity++;
textIconList.RemoveAt(i);
i--;
listLength--;
}
else if (textIconQuantity > 1)
{
textIconList[i - 1].NameString += " x" + textIconQuantity;
textIconQuantity = 1;
}
}
//Placement happens bottom to top, left to right
//Each newly placed Texticon is compared to only the Texticons that are placed above its position
//Therefore a sorted list of the occupied Positions is maintained
occupiedPosition.Add(textIconList[0]);
List <NameIcon> texiconsCopy = new List <NameIcon>();
texiconsCopy.AddRange(_nameIcons.Values);
int numTextIcons = texiconsCopy.Count;
for (int i = 1; i < numTextIcons; i++)
{
var item = texiconsCopy[i - 1];
Vector2 height = new Vector2()
{
X = 0, Y = item.Height
};
int lowestPosIndex = occupiedPosition.BinarySearch(item.ViewDisplayRect + height, byViewPos);
int lpi = lowestPosIndex;
if (lowestPosIndex < 0)
{
lpi = ~lowestPosIndex;
}
for (int j = lpi; j < occupiedPosition.Count; j++)
{
if (item.ViewDisplayRect.Intersects(occupiedPosition[j]))
{
var newpoint = new Vector2()
{
X = item.ViewOffset.X,
Y = item.ViewOffset.Y - occupiedPosition[j].Height
};
item.ViewOffset = newpoint;
}
}
//Inserts the new label sorted
int insertIndex = occupiedPosition.BinarySearch(item, byViewPos);
if (insertIndex < 0)
{
insertIndex = ~insertIndex;
}
occupiedPosition.Insert(insertIndex, item);
}
}
public OrbitalDebugWidget(EntityState entityState) : base(entityState.OrbitIcon.BodyPositionDB)
{
var orbitIcon = entityState.OrbitIcon;
_bodyPosition = orbitIcon.BodyPositionDB;
_orbitDB = entityState.Entity.GetDataBlob <OrbitDB>();
if (_orbitDB.Parent == null) //primary star
{
_positionDB = orbitIcon.BodyPositionDB;
}
else
{
_positionDB = _orbitDB.Parent.GetDataBlob <PositionDB>(); //orbit's position is parent's body position.
}
EntityGuid = entityState.Entity.Guid;
_loan = Angle.ToRadians(_orbitDB.LongitudeOfAscendingNode);
_aop = Angle.ToRadians(_orbitDB.ArgumentOfPeriapsis);
_loP = orbitIcon._loP_radians;
var cP = new PointD()
{
X = orbitIcon.WorldPosition.X, Y = orbitIcon.WorldPosition.Y
};
cP.X -= orbitIcon._linearEccentricity;
var f1 = new PointD()
{
X = cP.X + orbitIcon._linearEccentricity, Y = cP.Y
};
var f2 = new PointD()
{
X = cP.X - orbitIcon._linearEccentricity, Y = cP.Y
};
var coVertex = new PointD()
{
X = cP.X, Y = cP.Y + orbitIcon.SemiMinor
};
var periapsisPnt = new PointD()
{
X = cP.X - orbitIcon.SemiMaj, Y = cP.Y
};
var apoapsisPnt = new PointD()
{
X = cP.X + orbitIcon.SemiMaj, Y = cP.Y
};
_cP = DrawTools.RotatePoint(cP, _loP);
_f1 = DrawTools.RotatePoint(f1, _loP);
_f2 = DrawTools.RotatePoint(f2, _loP);
_coVertex = DrawTools.RotatePoint(coVertex, _loP);
_periapsisPnt = DrawTools.RotatePoint(periapsisPnt, _loP);
_apoapsisPnt = DrawTools.RotatePoint(apoapsisPnt, _loP);
_semiMajAxis = orbitIcon.SemiMaj;
_semiMinAxis = orbitIcon.SemiMinor;
DateTime systemDateTime = _orbitDB.Parent.Manager.ManagerSubpulses.StarSysDateTime;
_trueAnom = OrbitProcessor.GetTrueAnomaly(_orbitDB, systemDateTime);
double secondsFromEpoch = (systemDateTime - _orbitDB.Epoch).TotalSeconds;
_meanAnom = OrbitMath.GetMeanAnomalyFromTime(Angle.ToRadians(_orbitDB.MeanAnomalyAtEpoch), Angle.ToRadians(_orbitDB.MeanMotion), secondsFromEpoch);
_eccentricAnom = OrbitProcessor.GetEccentricAnomaly(_orbitDB, _meanAnom);
_bodyPosPnt = new PointD()
{
X = (_bodyPosition.AbsolutePosition_AU + _worldPosition).X,
Y = (_bodyPosition.AbsolutePosition_AU + _worldPosition).Y
};
CreateLines();
}
