private void DisplaySelected_Click(object sender, EventArgs e)
{
if (listView1.FocusedItem != null && listView1.FocusedItem.Index != -1)
{
if (CommonData.HasManeuvers)
{
IAgStkObject passiveSatObj = CreatorFunctions.GetCreateSatellite("PassiveCheck");
IAgSatellite passiveSat = passiveSatObj as IAgSatellite;
passiveSat.VO.OrbitSystems.InertialByWindow.IsVisible = false;
passiveSat.VO.OrbitSystems.RemoveAll();
passiveSat.VO.OrbitSystems.Add("Satellite/" + CommonData.TargetName + " VVLH System");
passiveSat.SetPropagatorType(AgEVePropagatorType.ePropagatorAstrogator);
IAgVADriverMCS passiveDriver = passiveSat.Propagator as IAgVADriverMCS;
IAgVAMCSInitialState intState = passiveDriver.MainSequence[0] as IAgVAMCSInitialState;
IAgVAMCSPropagate prop = passiveDriver.MainSequence[1] as IAgVAMCSPropagate;
IAgVAStoppingConditionElement sc1 = prop.StoppingConditions[0];
IAgVAStoppingCondition sc = sc1.Properties as IAgVAStoppingCondition;
sc.Trip = CommonData.RunList[listView1.FocusedItem.Index].PropTime;
AgVAElementCartesian element = intState.Element as AgVAElementCartesian;
intState.OrbitEpoch = CommonData.RunList[listView1.FocusedItem.Index].ManeuverTime;
element.Vx = CommonData.RunList[listView1.FocusedItem.Index].Vx;
element.Vy = CommonData.RunList[listView1.FocusedItem.Index].Vy;
element.Vz = CommonData.RunList[listView1.FocusedItem.Index].Vz;
element.X = CommonData.RunList[listView1.FocusedItem.Index].X;
element.Y = CommonData.RunList[listView1.FocusedItem.Index].Y;
element.Z = CommonData.RunList[listView1.FocusedItem.Index].Z;
passiveDriver.RunMCS();
}
else
{
MessageBox.Show("Actor satellite has no maneuvers. Visualization is simply the Actor's current trjectory");
}
}
}
//Main Function
private void Generate_Click(object sender, EventArgs e)
{
int check = FieldCheck();
if (check == 0)
{
RemoveProximityGeometry();
try
{
CommonData.StkRoot.UnitPreferences.SetCurrentUnit("Distance", "km");
CommonData.RunList.Clear();
CommonData.TargetName = TargetSat.Text;
CommonData.ActorName = ActorSat.Text;
//Set user bounds for safety
double userMinRange = Double.Parse(SphericalMag.Text) / 1000;
double userMinR = Double.Parse(RMag.Text) / 1000;
double userMinI = Double.Parse(IMag.Text) / 1000;
double userMinC = Double.Parse(CMag.Text) / 1000;
IAgScenario scenario = CommonData.StkRoot.CurrentScenario as IAgScenario;
IAgStkObject satObj = CommonData.StkRoot.GetObjectFromPath("Satellite/" + ActorSat.Text);
IAgSatellite sat = satObj as IAgSatellite;
//Get all maneuver end times for actor satellite
IAgDataProviderGroup maneuverDpGroup = satObj.DataProviders["Astrogator Maneuver Ephemeris Block Final"] as IAgDataProviderGroup;
IAgDataPrvTimeVar maneuverDp = maneuverDpGroup.Group["Cartesian Elems"] as IAgDataPrvTimeVar;
IAgDrResult result = maneuverDp.Exec(scenario.StartTime, scenario.StopTime, 60);
IAgDrDataSetCollection maneuverData = result.DataSets;
//If there is maneuvers, run iterations for each maneuver. If no maneuvers then just pull closest RIC data for entire trajectory
if (maneuverData.Count != 0)
{
CommonData.HasManeuvers = true;
//Get maneuver numbers
IAgDataPrvInterval summaryDp = satObj.DataProviders["Maneuver Summary"] as IAgDataPrvInterval;
IAgDrResult summaryResult = summaryDp.Exec(scenario.StartTime, scenario.StopTime);
Array maneuverNumbers = summaryResult.DataSets.GetDataSetByName("Maneuver Number").GetValues();
int maxManeuverNum = maneuverNumbers.Length;
//Get handles to cartesian position and velocity to seed passive safety runs
IAgDataProviderGroup cartPos = satObj.DataProviders["Cartesian Position"] as IAgDataProviderGroup;
IAgDataPrvTimeVar cartPosDP = cartPos.Group["ICRF"] as IAgDataPrvTimeVar;
IAgDataProviderGroup cartVel = satObj.DataProviders["Cartesian Velocity"] as IAgDataProviderGroup;
IAgDataPrvTimeVar cartVelDP = cartVel.Group["ICRF"] as IAgDataPrvTimeVar;
//Create passive safety satellite. Set to Astrogator and pull handles to initial state and propagate segments
IAgStkObject passiveSatObj = CreatorFunctions.GetCreateSatellite("PassiveCheck");
IAgSatellite passiveSat = passiveSatObj as IAgSatellite;
passiveSat.SetPropagatorType(AgEVePropagatorType.ePropagatorAstrogator);
IAgVADriverMCS passiveDriver = passiveSat.Propagator as IAgVADriverMCS;
IAgVAMCSInitialState intState = passiveDriver.MainSequence[0] as IAgVAMCSInitialState;
IAgVAMCSPropagate prop = passiveDriver.MainSequence[1] as IAgVAMCSPropagate;
IAgVAStoppingConditionElement sc1 = prop.StoppingConditions[0];
IAgVAStoppingCondition sc = sc1.Properties as IAgVAStoppingCondition;
sc.Trip = PropTime.Text;
AgVAElementCartesian element = intState.Element as AgVAElementCartesian;
Array epoch;
Array vx;
Array vy;
Array vz;
Array x;
Array y;
Array z;
String epochCur;
DateTime dateCur;
//Assign cartesian elements to PassiveCheck satellite from actor maneuver maneuver data. Run each iteration to see if resulting trajectory violates constraints
for (int i = 0; i < maxManeuverNum; i++)
{
//Get maneuver time and offset in time by 0.25 sec to account for boundrary conditions around impulsive maneuvers
epoch = maneuverData[0 + (i * 7)].GetValues();
epochCur = epoch.GetValue(0).ToString();
dateCur = DateTime.Parse(epochCur);
dateCur = dateCur.AddMilliseconds(250);
//dateCur = DateTime.ParseExact(epochCur, "dd MMM yyyy HH:mm:ss.fff", CultureInfo.InvariantCulture);
epochCur = dateCur.ToString("dd MMM yyyy HH:mm:ss.fff");
//Get cartesian state vector for given time
result = cartPosDP.ExecSingle(epochCur);
x = result.DataSets.GetDataSetByName("x").GetValues();
y = result.DataSets.GetDataSetByName("y").GetValues();
z = result.DataSets.GetDataSetByName("z").GetValues();
result = cartVelDP.ExecSingle(epochCur);
vx = result.DataSets.GetDataSetByName("x").GetValues();
vy = result.DataSets.GetDataSetByName("y").GetValues();
vz = result.DataSets.GetDataSetByName("z").GetValues();
//Create passive run output to be used in visualization
PassiveRun run = new PassiveRun();
run.UserMinRange = Double.Parse(SphericalMag.Text) / 1000;
run.UserMinR = Double.Parse(RMag.Text) / 1000;
run.UserMinI = Double.Parse(IMag.Text) / 1000;
run.UserMinC = Double.Parse(CMag.Text) / 1000;
intState.OrbitEpoch = epochCur;
element.Vx = Double.Parse(vx.GetValue(0).ToString());
element.Vy = Double.Parse(vy.GetValue(0).ToString());
element.Vz = Double.Parse(vz.GetValue(0).ToString());
element.X = Double.Parse(x.GetValue(0).ToString());
element.Y = Double.Parse(y.GetValue(0).ToString());
element.Z = Double.Parse(z.GetValue(0).ToString());
passiveDriver.RunMCS();
run.Vx = Double.Parse(vx.GetValue(0).ToString());
run.Vy = Double.Parse(vy.GetValue(0).ToString());
run.Vz = Double.Parse(vz.GetValue(0).ToString());
run.X = Double.Parse(x.GetValue(0).ToString());
run.Y = Double.Parse(y.GetValue(0).ToString());
run.Z = Double.Parse(z.GetValue(0).ToString());
run.PropTime = Double.Parse(PropTime.Text);
//Pull closest point to target for each iteration and save to passive run output
IAgDataProvider psatDp = passiveSatObj.DataProviders["RIC Coordinates"] as IAgDataProvider;
psatDp.PreData = "Satellite/" + TargetSat.Text;
IAgDataPrvTimeVar psatDpTimeVar = psatDp as IAgDataPrvTimeVar;
IAgDrResult psatDp2 = psatDpTimeVar.Exec(scenario.StartTime, scenario.StopTime, Double.Parse(TimeStep.Text));
run.Range = psatDp2.DataSets.GetDataSetByName("Range").GetValues();
run.Intrack = psatDp2.DataSets.GetDataSetByName("In-Track").GetValues();
run.Crosstrack = psatDp2.DataSets.GetDataSetByName("Cross-Track").GetValues();
run.Radial = psatDp2.DataSets.GetDataSetByName("Radial").GetValues();
run.MinRange = MathFunctions.ArrayMin(run.Range);
run.MinIntrack = MathFunctions.ArrayMinAbs(run.Intrack);
run.MinCrosstrack = MathFunctions.ArrayMinAbs(run.Crosstrack);
run.MinRadial = MathFunctions.ArrayMinAbs(run.Radial);
//run.ManeuverTime = epoch.GetValue(0).ToString();
run.ManeuverTime = epochCur;
//spherical
if (radioButton1.Checked)
{
run.IsSpherical = true;
if (run.MinRange < userMinRange)
{
run.Safe = false;
}
else
{
run.Safe = true;
}
}
//independent axis
else
{
run.IsSpherical = false;
if (Math.Abs(run.MinIntrack) < userMinI && Math.Abs(run.MinRadial) < userMinR && Math.Abs(run.MinCrosstrack) < userMinC)
{
bool tripped = false;
for (int j = 0; j < run.Range.Length; j++)
{
if (Math.Abs(Double.Parse(run.Intrack.GetValue(j).ToString())) < userMinI && Math.Abs(Double.Parse(run.Radial.GetValue(j).ToString())) < userMinR && Math.Abs(Double.Parse(run.Crosstrack.GetValue(j).ToString())) < userMinC)
{
run.Safe = false;
tripped = true;
break;
}
}
if (!tripped)
{
run.Safe = true;
}
}
else
{
run.Safe = true;
}
}
CommonData.RunList.Add(run);
}
}
else
{
CommonData.HasManeuvers = false;
PassiveRun run = new PassiveRun();
IAgDataProvider satDp = satObj.DataProviders["RIC Coordinates"] as IAgDataProvider;
satDp.PreData = "Satellite/" + TargetSat.Text;
IAgDataPrvTimeVar satDpTimeVar = satDp as IAgDataPrvTimeVar;
IAgDrResult satDp2 = satDpTimeVar.Exec(scenario.StartTime, scenario.StopTime, Double.Parse(TimeStep.Text));
run.Range = satDp2.DataSets.GetDataSetByName("Range").GetValues();
run.Intrack = satDp2.DataSets.GetDataSetByName("In-Track").GetValues();
run.Crosstrack = satDp2.DataSets.GetDataSetByName("Cross-Track").GetValues();
run.Radial = satDp2.DataSets.GetDataSetByName("Radial").GetValues();
run.MinRange = MathFunctions.ArrayMin(run.Range);
run.MinIntrack = MathFunctions.ArrayMinAbs(run.Intrack);
run.MinCrosstrack = MathFunctions.ArrayMinAbs(run.Crosstrack);
run.MinRadial = MathFunctions.ArrayMinAbs(run.Radial);
run.ManeuverTime = "N/A";
//spherical
if (radioButton1.Checked)
{
run.IsSpherical = true;
if (run.MinRange < userMinRange)
{
run.Safe = false;
}
else
{
run.Safe = true;
}
}
//independent axis
else
{
run.IsSpherical = false;
if (Math.Abs(run.MinIntrack) < userMinI && Math.Abs(run.MinRadial) < userMinR && Math.Abs(run.MinCrosstrack) < userMinC)
{
bool tripped = false;
for (int j = 0; j < run.Range.Length; j++)
{
if (Math.Abs(Double.Parse(run.Intrack.GetValue(j).ToString())) < userMinI && Math.Abs(Double.Parse(run.Radial.GetValue(j).ToString())) < userMinR && Math.Abs(Double.Parse(run.Crosstrack.GetValue(j).ToString())) < userMinC)
{
run.Safe = false;
tripped = true;
break;
}
}
if (!tripped)
{
run.Safe = true;
}
}
else
{
run.Safe = true;
}
}
CommonData.RunList.Add(run);
}
CommonData.BeenRun = true;
}
catch (Exception)
{
MessageBox.Show("Passive Safety Check Failed");
}
}
}
