public void get_InitialState(IAgVAMCSInitialState InitStateObj, int depth, List <string> localParent)
{
depth++;
#region List Header
l_SegObj.Add(null);
l_Names.Add("Orbit State/Elements");
l_unit.Add("");
l_Values.Add(double.PositiveInfinity);
l_types.Add(" ");
l_depth.Add(depth);
l_isQuantity.Add(false);
l_implemClass.Add(implem_Classes.NULL);
l_localParents.Add(localParent);
#endregion
AgEVAElementType m_CoordType = InitStateObj.ElementType;
if (m_CoordType == AgEVAElementType.eVAElementTypeKeplerian)
{
IAgVAElementKeplerian keplerState = InitStateObj.Element as IAgVAElementKeplerian;
OrbElems.Add("Apoapsis Altitude", keplerState.ApoapsisAltitudeSize); l_unit.Add(units.u_Distance);
OrbElems.Add("Apoapsis Radius", keplerState.ApoapsisRadiusSize); l_unit.Add(units.u_Distance);
OrbElems.Add("Eccentricity", keplerState.Eccentricity); l_unit.Add(units.u_Null);
OrbElems.Add("Inclination", keplerState.Inclination); l_unit.Add(units.u_Angle);
OrbElems.Add("RAAN", keplerState.RAAN); l_unit.Add(units.u_Angle);
OrbElems.Add("True Anomaly", keplerState.TrueAnomaly); l_unit.Add(units.u_Angle);
OrbElems.Add("Semi-Major Axis", keplerState.SemiMajorAxis); l_unit.Add(units.u_Distance);
OrbElems.Add("Period", keplerState.Period); l_unit.Add(units.u_Time);
OrbElems.Add("Mean Motion", keplerState.MeanMotion); l_unit.Add(units.u_AngleRate);
OrbElems.Add("Arg Of Latitude", keplerState.ArgOfLatitude); l_unit.Add(units.u_Angle);
OrbElems.Add("Arg Of Periapsis", keplerState.ArgOfPeriapsis); l_unit.Add(units.u_Angle);
OrbElems.Add("Mean Anomaly", keplerState.MeanMotion); l_unit.Add(units.u_Angle);
OrbElems.Add("LAN", keplerState.LAN); l_unit.Add(units.u_Angle);
OrbElems.Add("Periapsis Altitude", keplerState.PeriapsisAltitudeSize); l_unit.Add(units.u_Distance);
OrbElems.Add("Periapsis Radius", keplerState.PeriapsisRadiusSize); l_unit.Add(units.u_Distance);
update_Lists(OrbElems, depth, InitStateObj, implem_Classes.Astg_InitState, localParent);
}
else if (m_CoordType == AgEVAElementType.eVAElementTypeCartesian)
{
IAgVAElementCartesian cartesianState = InitStateObj.Element as IAgVAElementCartesian;
OrbElems.Add("X", cartesianState.X); l_unit.Add(units.u_Distance);
OrbElems.Add("Y", cartesianState.Y); l_unit.Add(units.u_Distance);
OrbElems.Add("Z", cartesianState.Z); l_unit.Add(units.u_Distance);
OrbElems.Add("Vx", cartesianState.Vx); l_unit.Add(units.u_Velocity);
OrbElems.Add("Vy", cartesianState.Vy); l_unit.Add(units.u_Velocity);
OrbElems.Add("Vz", cartesianState.Vz); l_unit.Add(units.u_Velocity);
update_Lists(OrbElems, depth, InitStateObj, implem_Classes.Astg_InitState, localParent);
}
}
public static PropagationResults PropagateAstrogatorSatellite(AgStkObjectRoot root, AgUiApplication app, InitialState state, TLE tle, Data satData, Uncertainty uncertainty, int runId, int nRuns, string propName)
{
PropagationResults propResults = new PropagationResults();
propResults.RunNumber = runId.ToString().PadLeft(3, '0');
IAgSatellite sat = root.CurrentScenario.Children.New(AgESTKObjectType.eSatellite, tle.GetSatNumber() + "Astrogator") as IAgSatellite;
//Set the propagator to Astrogator
sat.SetPropagatorType(AgEVePropagatorType.ePropagatorAstrogator);
//get the Driver for the Propagator
IAgVADriverMCS driver = sat.Propagator as IAgVADriverMCS;
//Clear all segments from the MCS
driver.MainSequence.RemoveAll();
//// Target Sequence ////
IAgVAMCSTargetSequence ts = driver.MainSequence.Insert(AgEVASegmentType.eVASegmentTypeTargetSequence, "SetupState", "-") as IAgVAMCSTargetSequence;
ts.Action = AgEVATargetSeqAction.eVATargetSeqActionRunActiveProfiles;
// add the initial state segment in the target sequence
IAgVAMCSInitialState initState = ts.Segments.Insert(AgEVASegmentType.eVASegmentTypeInitialState, "InitialState", "-") as IAgVAMCSInitialState;
initState.OrbitEpoch = ((IAgScenario)root.CurrentScenario).StartTime;
// define elements
initState.SetElementType(AgEVAElementType.eVAElementTypeCartesian);
IAgVAElementCartesian cart = initState.Element as IAgVAElementCartesian;
cart.X = Convert.ToDouble(state.CartesianPosX);
cart.Y = Convert.ToDouble(state.CartesianPosY);
cart.Z = Convert.ToDouble(state.CartesianPosZ);
cart.Vx = Convert.ToDouble(state.CartesianVelX);
cart.Vy = Convert.ToDouble(state.CartesianVelY);
cart.Vz = Convert.ToDouble(state.CartesianVelZ);
// spacecraft parameters
IAgVASpacecraftParameters spacecraftParameters = (IAgVASpacecraftParameters)initState.SpacecraftParameters;
spacecraftParameters.DryMass = satData.Mass;
spacecraftParameters.Cd = satData.Cd;
spacecraftParameters.DragArea = satData.DragArea;
spacecraftParameters.Cr = satData.Cr;
spacecraftParameters.SolarRadiationPressureArea = satData.SunArea;
spacecraftParameters.RadiationPressureArea = 1e-10;
IAgVAFuelTank fuelTank = (IAgVAFuelTank)initState.FuelTank;
fuelTank.FuelMass = 0;
// enable the control parameter for the state variables
initState.EnableControlParameter(AgEVAControlInitState.eVAControlInitStateCartesianX);
initState.EnableControlParameter(AgEVAControlInitState.eVAControlInitStateCartesianY);
initState.EnableControlParameter(AgEVAControlInitState.eVAControlInitStateCartesianZ);
initState.EnableControlParameter(AgEVAControlInitState.eVAControlInitStateCartesianVx);
initState.EnableControlParameter(AgEVAControlInitState.eVAControlInitStateCartesianVy);
initState.EnableControlParameter(AgEVAControlInitState.eVAControlInitStateCartesianVz);
// add the results
((IAgVAMCSSegment)initState).Results.Add("Relative Motion/InTrack");
IAgVAStateCalcRelMotion intrackRel = ((IAgVAMCSSegment)initState).Results[0] as IAgVAStateCalcRelMotion;
intrackRel.ReferenceSelection = AgEVACalcObjectReference.eVACalcObjectReferenceSpecified;
IAgLinkToObject link_1 = intrackRel.Reference as IAgLinkToObject;
link_1.BindTo("Satellite/" + tle.GetSatNumber().ToString());
((IAgVAMCSSegment)initState).Results.Add("Relative Motion/Radial");
IAgVAStateCalcRelMotion radialRel = ((IAgVAMCSSegment)initState).Results[1] as IAgVAStateCalcRelMotion;
radialRel.ReferenceSelection = AgEVACalcObjectReference.eVACalcObjectReferenceSpecified;
IAgLinkToObject link_2 = radialRel.Reference as IAgLinkToObject;
link_2.BindTo("Satellite/" + tle.GetSatNumber().ToString());
((IAgVAMCSSegment)initState).Results.Add("Relative Motion/CrossTrack");
IAgVAStateCalcRelMotion crosstrackRel = ((IAgVAMCSSegment)initState).Results[2] as IAgVAStateCalcRelMotion;
crosstrackRel.ReferenceSelection = AgEVACalcObjectReference.eVACalcObjectReferenceSpecified;
IAgLinkToObject link_3 = crosstrackRel.Reference as IAgLinkToObject;
link_3.BindTo("Satellite/" + tle.GetSatNumber().ToString());
((IAgVAMCSSegment)initState).Results.Add("Relative Motion/InTrackRate");
IAgVAStateCalcRelMotion intrackrateRel = ((IAgVAMCSSegment)initState).Results[3] as IAgVAStateCalcRelMotion;
intrackrateRel.ReferenceSelection = AgEVACalcObjectReference.eVACalcObjectReferenceSpecified;
IAgLinkToObject link_4 = intrackrateRel.Reference as IAgLinkToObject;
link_4.BindTo("Satellite/" + tle.GetSatNumber().ToString());
((IAgVAMCSSegment)initState).Results.Add("Relative Motion/RadialRate");
IAgVAStateCalcRelMotion radialrateRel = ((IAgVAMCSSegment)initState).Results[4] as IAgVAStateCalcRelMotion;
radialrateRel.ReferenceSelection = AgEVACalcObjectReference.eVACalcObjectReferenceSpecified;
IAgLinkToObject link_5 = radialrateRel.Reference as IAgLinkToObject;
link_5.BindTo("Satellite/" + tle.GetSatNumber().ToString());
((IAgVAMCSSegment)initState).Results.Add("Relative Motion/CrossTrackRate");
IAgVAStateCalcRelMotion crosstrackrateRel = ((IAgVAMCSSegment)initState).Results[5] as IAgVAStateCalcRelMotion;
crosstrackrateRel.ReferenceSelection = AgEVACalcObjectReference.eVACalcObjectReferenceSpecified;
IAgLinkToObject link_6 = crosstrackrateRel.Reference as IAgLinkToObject;
link_6.BindTo("Satellite/" + tle.GetSatNumber().ToString());
/// differential corrector setup ///
IAgVAProfileDifferentialCorrector dc = ts.Profiles["Differential Corrector"] as IAgVAProfileDifferentialCorrector;
// control parameters
IAgVADCControl xControlParam = dc.ControlParameters.GetControlByPaths("InitialState", "InitialState.Cartesian.X");
xControlParam.Enable = true;
xControlParam.MaxStep = 1;
xControlParam.Perturbation = 0.1;
IAgVADCControl yControlParam = dc.ControlParameters.GetControlByPaths("InitialState", "InitialState.Cartesian.Y");
yControlParam.Enable = true;
yControlParam.MaxStep = 1;
yControlParam.Perturbation = 0.1;
IAgVADCControl zControlParam = dc.ControlParameters.GetControlByPaths("InitialState", "InitialState.Cartesian.Z");
zControlParam.Enable = true;
zControlParam.MaxStep = 1;
zControlParam.Perturbation = 0.1;
IAgVADCControl vxControlParam = dc.ControlParameters.GetControlByPaths("InitialState", "InitialState.Cartesian.Vx");
vxControlParam.Enable = true;
vxControlParam.MaxStep = 0.001;
vxControlParam.Perturbation = 1e-04;
IAgVADCControl vyControlParam = dc.ControlParameters.GetControlByPaths("InitialState", "InitialState.Cartesian.Vy");
vyControlParam.Enable = true;
vyControlParam.MaxStep = 0.001;
vyControlParam.Perturbation = 1e-04;
IAgVADCControl vzControlParam = dc.ControlParameters.GetControlByPaths("InitialState", "InitialState.Cartesian.Vz");
vzControlParam.Enable = true;
vzControlParam.MaxStep = 0.001;
vzControlParam.Perturbation = 1e-04;
// results
double[] deviations = uncertainty.GetRandomDeviation();
IAgVADCResult intrackResult = dc.Results.GetResultByPaths("InitialState", "InTrack");
intrackResult.Enable = true;
intrackResult.DesiredValue = deviations[0];
intrackResult.Tolerance = 0.01;
IAgVADCResult radialResult = dc.Results.GetResultByPaths("InitialState", "Radial");
radialResult.Enable = true;
radialResult.DesiredValue = deviations[1];
radialResult.Tolerance = 0.01;
IAgVADCResult crosstrackResult = dc.Results.GetResultByPaths("InitialState", "CrossTrack");
crosstrackResult.Enable = true;
crosstrackResult.DesiredValue = deviations[2];
crosstrackResult.Tolerance = 0.01;
IAgVADCResult intrackRateResult = dc.Results.GetResultByPaths("InitialState", "InTrackRate");
intrackRateResult.Enable = true;
intrackRateResult.DesiredValue = deviations[3] / 1000;
intrackRateResult.Tolerance = 0.001;
IAgVADCResult radialRateResult = dc.Results.GetResultByPaths("InitialState", "RadialRate");
radialRateResult.Enable = true;
radialRateResult.DesiredValue = deviations[4] / 1000;
radialRateResult.Tolerance = 0.001;
IAgVADCResult crosstrackRateResult = dc.Results.GetResultByPaths("InitialState", "CrossTrackRate");
crosstrackRateResult.Enable = true;
crosstrackRateResult.DesiredValue = deviations[5] / 1000;
crosstrackRateResult.Tolerance = 0.001;
/// Propagator ///
IAgVAMCSPropagate propagate = driver.MainSequence.Insert(AgEVASegmentType.eVASegmentTypePropagate, "ToGround", "-") as IAgVAMCSPropagate;
((IAgVAMCSSegment)propagate).Properties.Color = Color.Red;
//propagate.PropagatorName = "CustomProp";
propagate.PropagatorName = propName;
// add an Epoch stopping condition
IAgVAStoppingConditionCollection propStoppingConditions = propagate.StoppingConditions as IAgVAStoppingConditionCollection;
IAgVAStoppingConditionElement epochElement = propStoppingConditions.Add("Epoch");
IAgVAStoppingCondition epoch = (IAgVAStoppingCondition)epochElement.Properties;
epoch.Trip = ((IAgScenario)root.CurrentScenario).StopTime;
// add an Altitude stopping condition
IAgVAStoppingConditionElement altitudeElement = propStoppingConditions.Add("Altitude");
IAgVAStoppingCondition altitude = (IAgVAStoppingCondition)altitudeElement.Properties;
altitude.Trip = 0;
// remove the original stopping condition
propagate.StoppingConditions.Remove("Duration");
// run the MCS
driver.RunMCS();
driver.ClearDWCGraphics();
// get the stop time
IAgDataPrvInterval dp = ((IAgStkObject)sat).DataProviders.GetDataPrvIntervalFromPath("Astrogator MCS Ephemeris Segments") as IAgDataPrvInterval;
IAgDrResult result = dp.Exec(((IAgScenario)root.CurrentScenario).StartTime, ((IAgScenario)root.CurrentScenario).StopTime);
string satStopTime = result.DataSets[3].GetValues().GetValue(1).ToString();
if (satStopTime.Equals((Convert.ToString(((IAgScenario)root.CurrentScenario).StopTime))))
{
// the satellite does not decay (it is propagated until the scenario stop time)
propResults.IsDecayed = false;
}
else
{
propResults.IsDecayed = true;
propResults.ImpactEpoch = satStopTime;
// remove the millisecond part
satStopTime = satStopTime.Split('.')[0];
//ask for LLA data at stop time
IAgDataPrvTimeVar dpInfo = ((IAgStkObject)sat).DataProviders.GetDataPrvInfoFromPath("LLA State//Fixed") as IAgDataPrvTimeVar;
IAgDrResult resInfo = dpInfo.ExecSingle(satStopTime);
string lat = resInfo.DataSets[1].GetValues().GetValue(0).ToString();
string lon = resInfo.DataSets[2].GetValues().GetValue(0).ToString();
string alt = resInfo.DataSets[3].GetValues().GetValue(0).ToString();
propResults.ImpactLat = lat;
propResults.ImpactLon = lon;
propResults.ImpactAlt = alt;
// create a target object
IAgTarget target = root.CurrentScenario.Children.New(AgESTKObjectType.eTarget, "Target" + (runId).ToString().PadLeft(3, '0')) as IAgTarget;
target.Graphics.Color = Color.Red;
target.Graphics.LabelVisible = false;
IAgPosition pos = target.Position;
pos.AssignGeodetic(lat, lon, 0);
// create and display the time event
IAgCrdnProvider provider = root.CurrentScenario.Children["Target" + (runId).ToString().PadLeft(3, '0')].Vgt;
IAgCrdnEventEpoch eventEpoch = provider.Events.Factory.CreateEventEpoch(runId.ToString().PadLeft(3, '0') + "_Impact", "Impact Epoch") as IAgCrdnEventEpoch;
eventEpoch.Epoch = satStopTime;
try { root.ExecuteCommand("Timeline * TimeComponent Add ContentView \"Scenario Availability\" \"Target/Target" + (runId).ToString().PadLeft(3, '0') + " " + runId.ToString().PadLeft(3, '0') + "_Impact Time Instant\""); }
catch (Exception) { }
root.ExecuteCommand("Timeline * Refresh");
// create a unique ephemeris file for each Astrogator run
DateTime now = DateTime.Now;
string satEphemerisPath = Directory.GetCurrentDirectory() + "\\Ephemeris\\Reentry_run_" + (runId).ToString().PadLeft(3, '0') + ".e";
root.ExecuteCommand("ExportDataFile */Satellite/" + tle.GetSatNumber() + "Astrogator Ephemeris \"" + satEphemerisPath + "\" Type STK CoordSys ICRF CentralBody Earth InterpBoundaries Include");
propResults.EphemerisFilePath = satEphemerisPath;
// unload Astrogator satellite
root.CurrentScenario.Children[tle.GetSatNumber() + "Astrogator"].Unload();
if (runId == nRuns)
{
// remove the TLE sat
// root.CurrentScenario.Children[tle.GetSatNumber()].Unload();
}
}
try
{
AGI.Ui.Core.IAgUiWindowsCollection windows = app.Windows;
foreach (dynamic window in app.Windows)
{
string windowCaption = (string)window.Caption;
if (windowCaption.Contains("Setup"))
{
window.Close();
}
}
}
catch (Exception ex)
{
}
return(propResults);
}
public void set_InitialState(object InitStateObj, string name, double value)
{
IAgVAMCSInitialState state = InitStateObj as IAgVAMCSInitialState;
AgEVAElementType CoordType = state.ElementType;
if (CoordType == AgEVAElementType.eVAElementTypeKeplerian)
{
IAgVAElementKeplerian keplerState = state.Element as IAgVAElementKeplerian;
if (name == "Apoapsis Altitude")
{
keplerState.ApoapsisAltitudeSize = value;
}
else if (name == "Apoapsis Radius")
{
keplerState.ApoapsisRadiusSize = value;
}
else if (name == "Eccentricity")
{
keplerState.Eccentricity = value;
}
else if (name == "Inclination")
{
keplerState.Inclination = value;
}
else if (name == "RAAN")
{
keplerState.RAAN = value;
}
else if (name == "True Anomaly")
{
keplerState.TrueAnomaly = value;
}
else if (name == "Semi-Major Axis")
{
keplerState.SemiMajorAxis = value;
}
else if (name == "Period")
{
keplerState.Period = value;
}
else if (name == "Mean Motion")
{
keplerState.MeanMotion = value;
}
else if (name == "Arg Of Latitude")
{
keplerState.ArgOfLatitude = value;
}
else if (name == "Arg Of Periapsis")
{
keplerState.ArgOfPeriapsis = value;
}
else if (name == "Mean Anomaly")
{
keplerState.MeanMotion = value;
}
else if (name == "LAN")
{
keplerState.LAN = value;
}
else if (name == "Periapsis Altitude")
{
keplerState.PeriapsisAltitudeSize = value;
}
else if (name == "Periapsis Radius")
{
keplerState.PeriapsisRadiusSize = value;
}
}
else if (CoordType == AgEVAElementType.eVAElementTypeCartesian)
{
IAgVAElementCartesian cartesianState = state.Element as IAgVAElementCartesian;
if (name == "X")
{
cartesianState.X = value;
}
else if (name == "Y")
{
cartesianState.Y = value;
}
else if (name == "Z")
{
cartesianState.Z = value;
}
else if (name == "Vx")
{
cartesianState.Vx = value;
}
else if (name == "Vy")
{
cartesianState.Vy = value;
}
else if (name == "Vz")
{
cartesianState.Vz = value;
}
}
}
