internal OrbitOrderWiget(Entity targetEntity) : base(targetEntity.GetDataBlob <PositionDB>()) { _bodyPositionDB = targetEntity.GetDataBlob <PositionDB>(); OrbitEllipseSemiMaj_m = 20000; OrbitEllipseSemiMinor_m = 20000; _linearEccentricity_m = 0; _soiWorldRadius_AU = OrbitProcessor.GetSOI_AU(targetEntity); _targetWorldRadius_AU = targetEntity.GetDataBlob <MassVolumeDB>().RadiusInAU; Setup(); }
void TargetSelected() { TargetEntity = _uiState.LastClickedEntity; _uiState.Camera.PinToEntity(TargetEntity.Entity); _targetRadiusAU = TargetEntity.Entity.GetDataBlob <MassVolumeDB>().RadiusInAU; _targetRadius_m = TargetEntity.Entity.GetDataBlob <MassVolumeDB>().RadiusInM; var soiWorldRad_AU = OrbitProcessor.GetSOI_AU(TargetEntity.Entity); _apMax = soiWorldRad_AU; float soiViewUnits = _uiState.Camera.ViewDistance(soiWorldRad_AU); _massTargetBody = TargetEntity.Entity.GetDataBlob <MassVolumeDB>().MassDry; _stdGravParamTargetBody_m = OrbitMath.CalculateStandardGravityParameterInM3S2(_massOrderingEntity, _massTargetBody); InsertionCalcs(); System.Numerics.Vector2 viewPortSize = _uiState.Camera.ViewPortSize; float windowLen = Math.Min(viewPortSize.X, viewPortSize.Y); if (soiViewUnits < windowLen * 0.5) { //zoom so soi fills ~3/4 screen. var soilenwanted = windowLen * 0.375; _uiState.Camera.ZoomLevel = (float)(soilenwanted / _apMax); } if (_orbitWidget != null) { _orbitWidget = new OrbitOrderWiget(TargetEntity.Entity); _uiState.SelectedSysMapRender.UIWidgets[nameof(_orbitWidget)] = _orbitWidget; } else { _orbitWidget = new OrbitOrderWiget(TargetEntity.Entity); _uiState.SelectedSysMapRender.UIWidgets.Add(nameof(_orbitWidget), _orbitWidget); } OrderingEntityState.DebugOrbitOrder = _orbitWidget; _moveWidget.SetArrivalTarget(TargetEntity.Entity); _tooltipText = "Select Insertion Point"; CurrentState = States.NeedsInsertionPoint; }
public OrbitOrderWiget(OrbitDB orbitDB) : base(orbitDB.Parent.GetDataBlob <PositionDB>()) { var targetEntity = orbitDB.Parent; _bodyPositionDB = targetEntity.GetDataBlob <PositionDB>(); OrbitEllipseSemiMaj_m = (float)orbitDB.SemiMajorAxis; _eccentricity = orbitDB.Eccentricity; EllipseMath.SemiMinorAxis(OrbitEllipseSemiMaj_m, _eccentricity); _linearEccentricity_m = (float)(orbitDB.Eccentricity * OrbitEllipseSemiMaj_m); _soiWorldRadius_AU = OrbitProcessor.GetSOI_AU(targetEntity); _targetWorldRadius_AU = targetEntity.GetDataBlob <MassVolumeDB>().RadiusInAU; Setup(); }
public void TestEccentricAnomalyCalcs(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_ν); double linierEccentricity = o_e * o_a; var E1 = OrbitMath.GetEccentricAnomalyNewtonsMethod(o_e, o_M); //newtons method. var E2 = OrbitMath.GetEccentricAnomalyNewtonsMethod2(o_e, o_M); //newtons method. var E3 = OrbitMath.GetEccentricAnomalyFromTrueAnomaly(o_ν, o_e); var E4 = OrbitMath.GetEccentricAnomalyFromStateVectors(pos, o_a, linierEccentricity, o_ω); //var E5 = OrbitMath.GetEccentricAnomalyFromStateVectors2(sgp, o_a, pos, vel); Assert.Multiple(() => { Assert.AreEqual(o_E, E1, "EccentricAnomaly E expected: " + Angle.ToDegrees(o_E) + " was: " + Angle.ToDegrees(E1));// these two should be calculatd the same way. Assert.AreEqual(o_E, E2, 1.0E-7, "EccentricAnomaly E expected: " + Angle.ToDegrees(o_E) + " was: " + Angle.ToDegrees(E2)); Assert.AreEqual(o_E, E3, 1.0E-7, "EccentricAnomaly E expected: " + Angle.ToDegrees(o_E) + " was: " + Angle.ToDegrees(E3)); Assert.AreEqual(o_E, E4, 1.0E-7, "EccentricAnomaly E expected: " + Angle.ToDegrees(o_E) + " was: " + Angle.ToDegrees(E4)); //Assert.AreEqual(o_E, E5, 1.0E-7, "EccentricAnomaly E expected: " + Angle.ToDegrees(o_E) + " was: " + Angle.ToDegrees(E5)); }); } }
void OnEntityChange(EntityState entity) { OrderingEntity = entity; _actionDateTime = _state.PrimarySystemDateTime; _orderEntityOrbit = entity.Entity.GetDataBlob <OrbitDB>(); _massParentBody = _orderEntityOrbit.Parent.GetDataBlob <MassVolumeDB>().Mass; _massOrderingEntity = OrderingEntity.Entity.GetDataBlob <MassVolumeDB>().Mass; _stdGravParam = GameConstants.Science.GravitationalConstant * (_massParentBody + _massOrderingEntity) / 3.347928976e33; _positonAtChange_AU = OrbitProcessor.GetPosition_AU(_orderEntityOrbit, _actionDateTime); var velAtChange2d = OrbitProcessor.GetOrbitalVector(_orderEntityOrbit, _actionDateTime); _orbitalVelocityAtChange = new ECSLib.Vector3(velAtChange2d.X, velAtChange2d.Y, 0); _origionalAngle = Math.Atan2(_orbitalVelocityAtChange.X, _orbitalVelocityAtChange.Y); IsActive = true; }
public void TestAngleOfPeriapsCalcs(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); Vector3 vel = (Vector3)OrbitMath.InstantaneousOrbitalVelocityVector(sgp, pos, o_a, o_e, o_ν); Vector3 angularVelocity = Vector3.Cross(pos, vel); Vector3 nodeVector = Vector3.Cross(new Vector3(0, 0, 1), angularVelocity); Vector3 eccentVector = OrbitMath.EccentricityVector(sgp, pos, vel); //var ω1 = OrbitMath.ArgumentOfPeriapsis(nodeVector, eccentVector, position, velocity); //var ω2 = OrbitMath.ArgumentOfPeriapsis(nodeVector, eccentVector, position, velocity, o_Ω); var ω3 = OrbitMath.ArgumentOfPeriapsis2(pos, o_i, o_Ω, o_ν); Assert.Multiple(() => { //Assert.AreEqual(o_ω, ω1, 1.0E-7, "AoP ω expected: " + Angle.ToDegrees(o_ω) + " was: " + Angle.ToDegrees(ω1)); //Assert.AreEqual(ω1, ω2, 1.0E-7, "AoP ω expected: " + Angle.ToDegrees(ω1) + " was: " + Angle.ToDegrees(ω2)); Assert.AreEqual(o_ω, ω3, 1.0E-7, "AoP ω expected: " + Angle.ToDegrees(o_ω) + " was: " + Angle.ToDegrees(ω3)); }); } }
public override void OnPhysicsUpdate() { DateTime atDateTime = _entity.Manager.ManagerSubpulses.StarSysDateTime; if (_orbitDB != null) { var headingVector = OrbitProcessor.InstantaneousOrbitalVelocityVector_m(_orbitDB, atDateTime); var heading = Math.Atan2(headingVector.Y, headingVector.X); Heading = (float)heading; } else if (_newtonMoveDB != null) { Heading = (float)Math.Atan2(_newtonMoveDB.CurrentVector_ms.Y, _newtonMoveDB.CurrentVector_ms.X); } else if (_warpMoveDB != null) { Heading = _warpMoveDB.Heading_Radians; } }
public override void OnPhysicsUpdate() { DateTime atDateTime = _entity.Manager.ManagerSubpulses.StarSysDateTime; if (_orbitDB != null) { //var ecAnom = Angle.ToRadians(_orbitDB.) var truAnom = OrbitProcessor.GetTrueAnomaly(_orbitDB, atDateTime); var heading = OrbitMath.HeadingFromPeriaps(_positionDB.RelativePosition_AU, _orbitDB.Eccentricity, _orbitDB.SemiMajorAxis, truAnom); Heading = (float)(heading + _lop); } else if (_newtonMoveDB != null) { Heading = (float)Math.Atan2(_newtonMoveDB.CurrentVector_kms.Y, _newtonMoveDB.CurrentVector_kms.X); } else if (_tlmoveDB != null) { Heading = _tlmoveDB.Heading_Radians; } }
/* * this gets the index by attempting to find the angle between the body and the center of the ellipse. possibly faster, but math is hard. * TODO: try doing this using TrueAnnomaly. * public override void OnPhysicsUpdate() * { * * //adjust so moons get the right positions * Vector4 pos = _bodyPositionDB.AbsolutePosition;// - _positionDB.AbsolutePosition; * PointD pointD = new PointD() { x = pos.X, y = pos.Y }; * * * //adjust for focal point * pos.X += _focalDistance; * * //rotate to the LonditudeOfPeriapsis. * double x2 = (pos.X * Math.Cos(-_orbitAngleRadians)) - (pos.Y * Math.Sin(-_orbitAngleRadians)); * double y2 = (pos.X * Math.Sin(-_orbitAngleRadians)) + (pos.Y * Math.Cos(-_orbitAngleRadians)); * * _ellipseStartArcAngleRadians = (float)(Math.Atan2(y2, x2)); //Atan2 returns a value between -180 and 180; * * //PointD pnt = _points.OrderBy(p => CalcDistance(p, new PointD() {x = pos.X, y = pos.Y })).First(); * * //get the indexPosition in the point array we want to start drawing from: this should be the segment where the planet is. * double unAdjustedIndex = (_ellipseStartArcAngleRadians / _segmentArcSweepRadians); * while (unAdjustedIndex < 0) * { * unAdjustedIndex += (2 * Math.PI); * } * _index = (int)unAdjustedIndex; * * } */ public override void OnPhysicsUpdate() { //Vector4 pos = _bodyPositionDB.AbsolutePosition_AU; Vector4 pos = OrbitProcessor.GetPosition_AU(_orbitDB, _orbitDB.OwningEntity.Manager.ManagerSubpulses.SystemLocalDateTime); _bodyRalitivePos = new PointD() { X = pos.X, Y = pos.Y }; double minDist = CalcDistance(_bodyRalitivePos, _points[_index]); for (int i = 0; i < _points.Count(); i++) { double dist = CalcDistance(_bodyRalitivePos, _points[i]); if (dist < minDist) { minDist = dist; _index = i; } } }
void EntitySelected() { OrderingEntity = _state.LastClickedEntity; _orderEntityOrbit = OrderingEntity.Entity.GetDataBlob <OrbitDB>(); CurrentState = States.NeedsTarget; _massCurrentBody = _orderEntityOrbit.Parent.GetDataBlob <MassVolumeDB>().Mass; _massOrderingEntity = OrderingEntity.Entity.GetDataBlob <MassVolumeDB>().Mass; _stdGravParamCurrentBody = GameConstants.Science.GravitationalConstant * (_massCurrentBody + _massOrderingEntity) / 3.347928976e33; if (_moveWidget == null) { _moveWidget = new TranslateMoveOrderWidget(_state, OrderingEntity.Entity); _state.SelectedSysMapRender.UIWidgets.Add(nameof(_moveWidget), _moveWidget); } DepartureCalcs(); //debug code: var sgpCur = _orderEntityOrbit.GravitationalParameterAU; var ralitiveVel1 = OrbitProcessor.InstantaneousOrbitalVelocityVector(_orderEntityOrbit, _departureDateTime); var ralPosCBAU = OrderingEntity.Entity.GetDataBlob <PositionDB>().RelativePosition_AU; var smaCurrOrbtAU = _orderEntityOrbit.SemiMajorAxis; //var ralitiveVel2 = OrbitMath.PreciseOrbitalVelocityVector(_stdGravParamCurrentBody, ralPosCBAU, smaCurrOrbtAU, _orderEntityOrbit.Eccentricity, _orderEntityOrbit.LongitudeOfAscendingNode + _orderEntityOrbit.ArgumentOfPeriapsis); }
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.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; }
internal override void Display() { if (IsActive) { var size = new System.Numerics.Vector2(200, 100); var pos = new System.Numerics.Vector2(_state.MainWinSize.X / 2 - size.X / 2, _state.MainWinSize.Y / 2 - size.Y / 2); ImGui.SetNextWindowSize(size, ImGuiCond.FirstUseEver); ImGui.SetNextWindowPos(pos, ImGuiCond.FirstUseEver); if (ImGui.Begin(_displayText, ref IsActive, _flags)) { //put calcs that needs refreshing each frame in here. (ie calculations from mouse cursor position) if (_orbitWidget != null) { switch (CurrentState) { case States.NeedsEntity: break; case States.NeedsTarget: { } break; case States.NeedsInsertionPoint: { var maxprogradeDV = _maxDV - Math.Abs(_radialDV); var maxradialDV = _maxDV - Math.Abs(_progradeDV); if (ImGui.SliderFloat("Prograde DV", ref _progradeDV, -maxprogradeDV, maxprogradeDV)) { InsertionCalcs(); } if (ImGui.SliderFloat("Radial DV", ref _radialDV, -maxradialDV, maxradialDV)) { InsertionCalcs(); } var mousePos = ImGui.GetMousePos(); var mouseWorldPos = _state.Camera.MouseWorldCoordinate(); _targetInsertionPoint_AU = (mouseWorldPos - GetTargetPosition()); //ralitive to the target body _moveWidget.SetArrivalPosition(_targetInsertionPoint_AU); //var velAU = OrbitProcessor.PreciseOrbitalVector(sgpCBAU, ralPosCBAU, smaCurrOrbtAU); var ke = OrbitMath.KeplerFromPositionAndVelocity(_stdGravParamTargetBody, _targetInsertionPoint_AU, _insertionOrbitalVelocity, _departureDateTime); _ke = ke; _orbitWidget.SetParametersFromKeplerElements(ke, _targetInsertionPoint_AU); _apoapsisKm = Distance.AuToKm(ke.Apoapsis); _periapsisKM = Distance.AuToKm(ke.Periapsis); _eccentricity = ke.Eccentricity; break; } /* * case States.NeedsSecondApsis: * { * TODO: when we've got newtonion engines, allow second apsis choice and expend Dv. * var mousePos = ImGui.GetMousePos(); * * var mouseWorldPos = _state.Camera.MouseWorldCoordinate(); * * var ralitivePos = (GetTargetPosition() - mouseWorldPos); * _orbitWidget.SetPeriapsis(ralitivePos.X, ralitivePos.Y); * * //_periapsisKM = Distance.AuToKm((GetTargetPosition() - mouseWorldPos).Length()); * var distanceSelected = Distance.AuToKm((GetTargetPosition() - mouseWorldPos).Length()); * var d1 = Math.Max(_peMin, distanceSelected); //can't be lower than body radius * _periapsisKM = Math.Min(d1, _apoapsisKm); //can't be higher than apoapsis. * * break; * }*/ case States.NeedsActioning: { var maxprogradeDV = _maxDV - Math.Abs(_radialDV); var maxradialDV = _maxDV - Math.Abs(_progradeDV); if (ImGui.SliderFloat("Prograde DV", ref _progradeDV, -maxprogradeDV, maxprogradeDV)) { InsertionCalcs(); } if (ImGui.SliderFloat("Radial DV", ref _radialDV, -maxradialDV, maxradialDV)) { InsertionCalcs(); } var ke = OrbitMath.KeplerFromPositionAndVelocity(_stdGravParamTargetBody, _targetInsertionPoint_AU, _insertionOrbitalVelocity, _departureDateTime); _ke = ke; _orbitWidget.SetParametersFromKeplerElements(ke, _targetInsertionPoint_AU); _apoapsisKm = Distance.AuToKm(ke.Apoapsis); _periapsisKM = Distance.AuToKm(ke.Periapsis); _eccentricity = ke.Eccentricity; break; } default: break; } } ImGui.SetTooltip(_tooltipText); ImGui.Text("Target: "); if (TargetEntity != null) { ImGui.SameLine(); ImGui.Text(TargetEntity.Name); } ImGui.Text("Apoapsis: "); ImGui.SameLine(); ImGui.Text(_apoapsisKm.ToString("g3") + " (Alt: " + _apAlt.ToString("g3") + ")"); ImGui.Text("Periapsis: "); ImGui.SameLine(); ImGui.Text(_periapsisKM.ToString("g3") + " (Alt: " + _peAlt.ToString("g3") + ")"); ImGui.Text("DepartureVelocity: "); //ImGui.SameLine(); ImGui.Text(_departureOrbitalSpeed.ToString() + " AU"); ImGui.Text(Distance.AuToKm(_departureOrbitalSpeed).ToString() + " KM"); ImGui.Text("InsertionVelocity: "); //ImGui.SameLine(); ImGui.Text(_insertionOrbitalSpeed.ToString() + " AU"); ImGui.Text(Distance.AuToKm(_insertionOrbitalSpeed).ToString() + " KM"); ImGui.Text("Eccentricity: "); ImGui.Text(_eccentricity.ToString("g3")); ImGui.Text("Departure Vector: "); ImGui.SameLine(); ImGui.Text(_departureOrbitalVelocity.ToString("g3")); ImGui.Text(Distance.AuToMt(_departureOrbitalVelocity).ToString("N") + "m/s"); ImGui.Text("Departure Angle: "); ImGui.SameLine(); ImGui.Text(_departureAngle.ToString("g3") + " radians or " + Angle.ToDegrees(_departureAngle).ToString("F") + " deg "); var pc = OrbitProcessor.InstantaneousOrbitalVelocityPolarCoordinate(_orderEntityOrbit, _departureDateTime); ImGui.Text("Departure Polar Coordinates: "); ImGui.Text(pc.Item1.ToString() + " AU or " + Distance.AuToMt(pc.Item1).ToString("F") + " m/s"); ImGui.Text(pc.Item2.ToString("g3") + " radians or " + Angle.ToDegrees(pc.Item2).ToString("F") + " deg ");; ImGui.Text("Insertion Vector: "); ImGui.SameLine(); ImGui.Text(_insertionOrbitalVelocity.ToString("g3")); ImGui.Text("LoAN: "); ImGui.SameLine(); ImGui.Text(_ke.LoAN.ToString("g3")); ImGui.Text("AoP: "); ImGui.SameLine(); ImGui.Text(_ke.AoP.ToString("g3")); ImGui.Text("LoP Angle: "); ImGui.SameLine(); ImGui.Text((_ke.LoAN + _ke.AoP).ToString("g3") + " radians or " + Angle.ToDegrees(_ke.LoAN + _ke.AoP).ToString("F") + " deg "); if (_orbitWidget != null) { ImGui.Text("Clockwise " + _orbitWidget.IsClockwiseOrbit.ToString()); } //if (CurrentState != States.NeedsActioning) //use alpha on the button if it's not useable. //ImGui.PushStyleVar(ImGuiStyleVar.Alpha, ImGui.GetStyle().Alpha * 0.5f); if (ImGui.Button("Action Order") && CurrentState == States.NeedsActioning) //only do suff if clicked if it's usable. { fsm[(byte)CurrentState, (byte)Events.ClickedAction].Invoke(); //ImGui.PopStyleVar(); } if (_smMode) { ImGui.SameLine(); if (ImGui.Button("Add OrbitDB")) { ActionAddDB(); } } ImGui.End(); } } }
public static void LaunchMissile(Entity launchingEntity, Entity targetEntity, double launchForce, OrdnanceDesign missileDesign, int count) { var atDatetime = launchingEntity.Manager.StarSysDateTime; var parentPositionDB = launchingEntity.GetDataBlob <PositionDB>(); Vector3 parentPosition = parentPositionDB.AbsolutePosition_m; var parentPosRal = parentPositionDB.RelativePosition_m; var tgtEntityOrbit = targetEntity.GetDataBlob <OrbitDB>(); if (targetEntity.HasDataBlob <OrbitUpdateOftenDB>()) { tgtEntityOrbit = targetEntity.GetDataBlob <OrbitUpdateOftenDB>(); } //MissileLauncherAtb launcherAtb; VolumeStorageDB cargo = launchingEntity.GetDataBlob <VolumeStorageDB>(); int numMis = cargo.TypeStores[missileDesign.CargoTypeID].CurrentStoreInUnits[missileDesign.ID]; if (numMis < 1) { return; } double launchSpeed = launchForce / missileDesign.MassPerUnit; double burnTime = ((missileDesign.WetMass - missileDesign.DryMass) / missileDesign.BurnRate) * 0.8; //use 80% of fuel. double drymass = (missileDesign.WetMass - missileDesign.DryMass) * 0.8; //use 80% of fuel. double launchManuverDv = OrbitMath.TsiolkovskyRocketEquation(missileDesign.WetMass, drymass, missileDesign.ExaustVelocity); double totalDV = OrbitMath.TsiolkovskyRocketEquation(missileDesign.WetMass, missileDesign.DryMass, missileDesign.ExaustVelocity); double speed = launchSpeed + launchManuverDv; var misslPositionDB = (PositionDB)parentPositionDB.Clone(); Vector3 parentVelocity = Entity.GetRalitiveFutureVelocity(launchingEntity, launchingEntity.StarSysDateTime); var orderabledb = new OrderableDB(); var newtmovedb = new NewtonMoveDB(misslPositionDB.Parent, parentVelocity); string defaultName = "Missile"; string factionsName = missileDesign.Name; if (count > 1) { defaultName += " x" + count; factionsName += " x" + count; } List <BaseDataBlob> dataBlobs = new List <BaseDataBlob>(); dataBlobs.Add(new ProjectileInfoDB(launchingEntity.Guid, count)); dataBlobs.Add(new ComponentInstancesDB()); dataBlobs.Add(misslPositionDB); dataBlobs.Add(MassVolumeDB.NewFromMassAndVolume(missileDesign.WetMass, missileDesign.WetMass)); dataBlobs.Add(new NameDB(defaultName, launchingEntity.FactionOwner, factionsName)); dataBlobs.Add(newtmovedb); dataBlobs.Add(orderabledb); var newMissile = Entity.Create(launchingEntity.Manager, launchingEntity.FactionOwner, dataBlobs); foreach (var tuple in missileDesign.Components) { EntityManipulation.AddComponentToEntity(newMissile, tuple.design, tuple.count); } var newtdb = newMissile.GetDataBlob <NewtonThrustAbilityDB>(); newtdb.DryMass_kg = missileDesign.MassPerUnit; newtdb.SetFuel(missileDesign.WetMass - missileDesign.MassPerUnit); bool directAttack = false; if (directAttack) { /* * var tgtintercept = OrbitMath.GetInterceptPosition_m(parentPosition, speed, tgtEntityOrbit, atDatetime); * var tgtEstPos = tgtintercept.position + targetEntity.GetDataBlob<PositionDB>().RelativePosition_m; * * var tgtCurPos = Entity.GetPosition_m(targetEntity, atDatetime); * * var vectorToTgt = Vector3.Normalise(tgtCurPos - parentPosRal); * * //var vectorToTgt = Vector3.Normalise(tgtEstPos - parentPosRal); * var launcherVector = vectorToTgt * launchSpeed; * * * var launchVelocity = parentVelocity + launcherVector; * var manuverDV = vectorToTgt * launchManuverDv; * * launchVelocity = parentVelocity + launcherVector; */ ThrustToTargetCmd.CreateCommand(launchingEntity.FactionOwner, newMissile, launchingEntity.StarSysDateTime, targetEntity); } else { var launchOrbit = launchingEntity.GetDataBlob <OrbitDB>(); if (launchingEntity.HasDataBlob <OrbitUpdateOftenDB>()) { launchOrbit = launchingEntity.GetDataBlob <OrbitUpdateOftenDB>(); } var launchTrueAnomaly = OrbitProcessor.GetTrueAnomaly(launchOrbit, atDatetime); var targetTrueAnomaly = OrbitProcessor.GetTrueAnomaly(tgtEntityOrbit, atDatetime); var phaseAngle = targetTrueAnomaly - launchTrueAnomaly; var manuvers = InterceptCalcs.OrbitPhasingManuvers(launchOrbit, atDatetime, phaseAngle); var manuverDV = manuvers[0].deltaV; //newtmovedb.ActionOnDateTime = atDatetime; //newtmovedb.DeltaVForManuver_FoRO_m = manuverDV; NewtonThrustCommand.CreateCommand(launchingEntity.FactionOwner, newMissile, atDatetime, manuverDV); DateTime futureDate = atDatetime + TimeSpan.FromSeconds(manuvers[1].timeInSeconds); Vector3 futureDV = manuvers[1].deltaV; NewtonThrustCommand.CreateCommand(launchingEntity.FactionOwner, newMissile, futureDate, futureDV); //ThrustToTargetCmd.CreateCommand(launchingEntity.FactionOwner, newMissile, futureDate + TimeSpan.FromSeconds(1), targetEntity); } cargo.RemoveCargoByUnit(missileDesign, 1); //remove missile from parent. }
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 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.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; }
internal override void Display() { if (IsActive) { ImVec2 size = new ImVec2(200, 100); ImVec2 pos = new ImVec2(_state.MainWinSize.x / 2 - size.x / 2, _state.MainWinSize.y / 2 - size.y / 2); ImGui.SetNextWindowSize(size, ImGuiCond.FirstUseEver); ImGui.SetNextWindowPos(pos, ImGuiCond.FirstUseEver); if (ImGui.Begin(_displayText, ref IsActive, _flags)) { ImGui.SetTooltip(_tooltipText); ImGui.Text("Target: "); ImGui.SameLine(); ImGui.Text(TargetEntity.Name); ImGui.Text("Apoapsis: "); ImGui.SameLine(); ImGui.Text(_apoapsisKm.ToString("g3") + " (Alt: " + _apAlt.ToString("g3") + ")"); ImGui.Text("Periapsis: "); ImGui.SameLine(); ImGui.Text(_periapsisKM.ToString("g3") + " (Alt: " + _peAlt.ToString("g3") + ")"); ImGui.Text("OrbitalVelocity: "); ImGui.SameLine(); ImGui.Text(_PreciseOrbitalSpeedKm_s.ToString()); if (ImGui.Button("Action Order")) { fsm[(byte)CurrentState, (byte)Events.ClickedAction].Invoke(); } if (_smMode) { ImGui.SameLine(); if (ImGui.Button("Add OrbitDB")) { ActionAddDB(); } } if (_orbitWidget != null) { switch (CurrentState) { case States.NeedsEntity: break; case States.NeedsTarget: break; case States.NeedsInsertionPoint: { var mousePos = ImGui.GetMousePos(); var mouseWorldPos = _state.Camera.MouseWorldCoordinate(); _targetInsertionPoint_AU = (mouseWorldPos - GetTargetPosition()); //var intercept = InterceptCalcs.GetInterceptPosition(OrderingEntity.Entity, TargetEntity.Entity.GetDataBlob<OrbitDB>(), TargetEntity.Entity.Manager.ManagerSubpulses.SystemLocalDateTime); //var distanceAU = (GetTargetPosition() - mouseWorldPos).Length(); //var distanceSelectedKM = Distance.AuToKm(distanceAU); //var d1 = Math.Min(_apMax, distanceSelectedKM); //can't be higher than SOI //_apoapsisKm = Math.Max(d1, _peMin); //cant be lower than the body radius //_moveWidget.SetArrivalRadius(distanceAU); _moveWidget.SetArrivalPosition(_targetInsertionPoint_AU); var massCurrBody = OrderingEntity.Entity.GetDataBlob <OrbitDB>().Parent.GetDataBlob <MassVolumeDB>().Mass; var massTargetBody = TargetEntity.Entity.GetDataBlob <MassVolumeDB>().Mass; var mymass = OrderingEntity.Entity.GetDataBlob <MassVolumeDB>().Mass; var ralPosCBAU = OrderingEntity.Entity.GetDataBlob <PositionDB>().RelativePosition_AU; var smaCurrOrbtAU = OrderingEntity.Entity.GetDataBlob <OrbitDB>().SemiMajorAxis; var sgpCBAU = GameConstants.Science.GravitationalConstant * (massCurrBody + mymass) / 3.347928976e33; // (149597870700 * 149597870700 * 149597870700); var velAU = OrbitProcessor.PreciseOrbitalVector(sgpCBAU, ralPosCBAU, smaCurrOrbtAU); var sgpTBAU = GameConstants.Science.GravitationalConstant * (massTargetBody + mymass) / 3.347928976e33; var ke = OrbitMath.KeplerFromVelocityAndPosition(sgpTBAU, _targetInsertionPoint_AU, velAU); _PreciseOrbitalSpeedKm_s = Distance.AuToKm(velAU.Length()); _orbitWidget.SetParametersFromKeplerElements(ke, _targetInsertionPoint_AU); _apoapsisKm = Distance.AuToKm(ke.Apoapsis); _periapsisKM = Distance.AuToKm(ke.Periapsis); break; } /* * case States.NeedsSecondApsis: * { * TODO: when we've got newtonion engines, allow second apsis choise and expend Dv. * var mousePos = ImGui.GetMousePos(); * * var mouseWorldPos = _state.Camera.MouseWorldCoordinate(); * * var ralitivePos = (GetTargetPosition() - mouseWorldPos); * _orbitWidget.SetPeriapsis(ralitivePos.X, ralitivePos.Y); * * //_periapsisKM = Distance.AuToKm((GetTargetPosition() - mouseWorldPos).Length()); * var distanceSelected = Distance.AuToKm((GetTargetPosition() - mouseWorldPos).Length()); * var d1 = Math.Max(_peMin, distanceSelected); //can't be lower than body radius * _periapsisKM = Math.Min(d1, _apoapsisKm); //can't be higher than apoapsis. * * break; * }*/ case States.NeedsActioning: break; default: break; } } ImGui.End(); } } }
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); }
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(); }
internal void CreatePointArray() { _dv = _newtonMoveDB.DeltaVForManuver_m.Length(); Vector3 vel = Distance.MToAU(_newtonMoveDB.CurrentVector_ms); Vector3 pos = myPosDB.RelativePosition_AU; Vector3 eccentVector = OrbitMath.EccentricityVector(_sgp, pos, vel); double e = eccentVector.Length(); double r = pos.Length(); double v = vel.Length(); double a = 1 / (2 / r - Math.Pow(v, 2) / _sgp); //semiMajor Axis double b = -a *Math.Sqrt(Math.Pow(e, 2) - 1); //semiMinor Axis double linierEccentricity = e * a; double soi = OrbitProcessor.GetSOI_AU(_newtonMoveDB.SOIParent); //longditudeOfPeriapsis; double _lop = Math.Atan2(eccentVector.Y, eccentVector.X); if (Vector3.Cross(pos, vel).Z < 0) //anti clockwise orbit { _lop = Math.PI * 2 - _lop; } double p = EllipseMath.SemiLatusRectum(a, e); double angleToSOIPoint = Math.Abs(OrbitMath.AngleAtRadus(soi, p, e)); //double thetaMax = angleToSOIPoint; double maxX = soi * Math.Cos(angleToSOIPoint); //maxX = maxX - a + linierEccentricity; double foo = maxX / a; double thetaMax = Math.Log(foo + Math.Sqrt(foo * foo - 1)); if (_numberOfPoints % 2 == 0) { _numberOfPoints += 1; } int ctrIndex = _numberOfPoints / 2; double dtheta = thetaMax / (ctrIndex - 1); double fooA = Math.Cosh(dtheta); double fooB = (a / b) * Math.Sinh(dtheta); double fooC = (b / a) * Math.Sinh(dtheta); double xn = a; double yn = 0; var points = new PointD[ctrIndex + 1]; points[0] = new PointD() { X = xn, Y = yn }; for (int i = 1; i < ctrIndex + 1; i++) { var lastx = xn; var lasty = yn; xn = fooA * lastx + fooB * lasty; yn = fooC * lastx + fooA * lasty; points[i] = new PointD() { X = xn, Y = yn }; } _points = new PointD[_numberOfPoints]; _points[ctrIndex] = new PointD() { X = ((points[0].X - linierEccentricity) * Math.Cos(_lop)) - (points[0].Y * Math.Sin(_lop)), Y = ((points[0].X - linierEccentricity) * Math.Sin(_lop)) + (points[0].Y * Math.Cos(_lop)) }; for (int i = 1; i < ctrIndex + 1; i++) { double x = points[i].X - linierEccentricity; //adjust for the focal point double ya = points[i].Y; double yb = -points[i].Y; double x2a = (x * Math.Cos(_lop)) - (ya * Math.Sin(_lop)); //rotate to loan double y2a = (x * Math.Sin(_lop)) + (ya * Math.Cos(_lop)); double x2b = (x * Math.Cos(_lop)) - (yb * Math.Sin(_lop)); double y2b = (x * Math.Sin(_lop)) + (yb * Math.Cos(_lop)); _points[ctrIndex + i] = new PointD() { X = x2a, Y = y2a }; _points[ctrIndex - i] = new PointD() { X = x2b, Y = y2b }; } }
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); }