%
%   Spacecraft
%

Create Spacecraft SimSat;

SimSat.DateFormat       = UTCGregorian;
SimSat.Epoch            = '01 Mar 2005 00:00:00.000';
SimSat.CoordinateSystem = EarthMJ2000Eq;
SimSat.DisplayStateType = Cartesian;
SimSat.X                = 6648.937;
SimSat.Y                = -335.169;
SimSat.Z                = 2789.137;
SimSat.VX               = -0.34697109;
SimSat.VY               =  7.092177415;
SimSat.VZ               =  2.14549075;
SimSat.DryMass          = 850;
SimSat.Cd               = 2.2;
SimSat.Cr               = 1.8;
SimSat.DragArea         = 15;
SimSat.SRPArea          = 1;
SimSat.Id               = 'LEOSat';
SimSat.AddHardware      = {Transponder1, Antenna2};

Create Spacecraft EstSat;

EstSat.DateFormat       = UTCGregorian;
EstSat.Epoch            = '01 Mar 2005 00:00:00.000';
EstSat.CoordinateSystem = EarthMJ2000Eq;
EstSat.DisplayStateType = Cartesian;
EstSat.X                = 6648.937;
EstSat.Y                = -335.169;
EstSat.Z                = 2789.137;
EstSat.VX               = -0.34697109;
EstSat.VY               =  7.092177415;
EstSat.VZ               =  2.14549075;
EstSat.DryMass          = 850;
EstSat.Cd               = 2.2;
EstSat.Cr               = 1.8;
EstSat.DragArea         = 15;
EstSat.SRPArea          = 1;
EstSat.Id               = 'LEOSat';
EstSat.AddHardware      = {Transponder1, Antenna2};
EstSat.SolveFors        = {CartesianState};     

%
%   Error models
%

Create ErrorModel RangeModel;

RangeModel.Type               = 'Range';
RangeModel.NoiseSigma         = 0.010;
RangeModel.Bias               = 0.;
RangeModel.SolveFors          = {};

Create ErrorModel RangeRateModel;

RangeRateModel.Type           = 'RangeRate';
RangeRateModel.NoiseSigma     = 0.00005;
RangeRateModel.Bias           = 0.0;
RangeRateModel.SolveFors      = {};

%
%   Ground stations
%

Create GroundStation GDS;

GDS.CentralBody           = Earth;
GDS.StateType             = Cartesian;
GDS.HorizonReference      = Ellipsoid;
GDS.Location1             = -2353.621251;
GDS.Location2             = -4641.341542;
GDS.Location3             = 3677.052370;
GDS.Id                    = 'GDS';
GDS.AddHardware           = {Transmitter1, Receiver1, Antenna1};
GDS.MinimumElevationAngle = 10;
GDS.ErrorModels           = {RangeModel, RangeRateModel};

Create GroundStation CAN;

CAN.CentralBody           = Earth;
CAN.StateType             = Cartesian;
CAN.HorizonReference      = Ellipsoid;
CAN.Location1             = -4461.083514;
CAN.Location2             = 2682.281745;
CAN.Location3             = -3674.570392;
CAN.Id                    = 'CAN';
CAN.AddHardware           = {Transmitter1, Receiver1, Antenna1};
CAN.MinimumElevationAngle = 0;
CAN.ErrorModels           = {RangeModel, RangeRateModel};

Create GroundStation MAD;

MAD.CentralBody           = Earth;
MAD.StateType             = Cartesian;
MAD.HorizonReference      = Ellipsoid;
MAD.Location1             = 4849.519988;
MAD.Location2             = -360.641653;
MAD.Location3             = 4114.504590;
MAD.Id                    = 'MAD';
MAD.AddHardware           = {Transmitter1, Receiver1, Antenna1};
MAD.MinimumElevationAngle = 0;
MAD.ErrorModels           = {RangeModel, RangeRateModel};

%
%   Tracking file sets
%

Create TrackingFileSet simData;

simData.AddTrackingConfig       = {{GDS, SimSat, GDS}, 'Range', 'RangeRate'};
simData.AddTrackingConfig       = {{CAN, SimSat, CAN}, 'Range', 'RangeRate'};
simData.AddTrackingConfig       = {{MAD, SimSat, MAD}, 'Range', 'RangeRate'};
simData.FileName                = {'SimEst_RK4.gmd'};
simData.RampTable               = {};
simData.UseLightTime            = True;
simData.UseRelativityCorrection = False;
simData.UseETminusTAI           = False;
simData.SimRangeModuloConstant  = 67108864;
simData.SimDopplerCountInterval = 10;  
simData.DataFilters             = {};


Create TrackingFileSet estData;

estData.AddTrackingConfig       = {{GDS, EstSat, GDS}, 'Range', 'RangeRate'};
estData.AddTrackingConfig       = {{CAN, EstSat, CAN}, 'Range', 'RangeRate'};
estData.AddTrackingConfig       = {{MAD, EstSat, MAD}, 'Range', 'RangeRate'};
estData.FileName                = {'SimEst_RK4.gmd'};
estData.RampTable               = {};
estData.UseLightTime            = True;
estData.UseRelativityCorrection = False;
estData.UseETminusTAI           = False;
estData.DataFilters             = {};

%
%   Propagators
%

Create ForceModel ODProp_ForceModel;

ODProp_ForceModel.CentralBody  = Earth;
ODProp_ForceModel.PointMasses  = {Earth};
ODProp_ForceModel.Drag         = None;
ODProp_ForceModel.SRP          = Off;
ODProp_ForceModel.ErrorControl = None;

Create Propagator ODProp;

ODProp.FM                      = ODProp_ForceModel;
ODProp.Type                    = RungeKutta4;
ODProp.InitialStepSize         = 60;
ODProp.Accuracy                = 1e-13;
ODProp.MinStep                 = 0;
ODProp.MaxStep                 = 60;
ODProp.MaxStepAttempts         = 50;

%
%   Communications Hardware
%

Create Antenna Antenna1 Antenna2;
Create Transmitter Transmitter1;
Create Receiver Receiver1;

GMAT Receiver1.PrimaryAntenna    = Antenna1;
GMAT Transmitter1.PrimaryAntenna = Antenna1;
GMAT Transmitter1.Frequency      = 2067.5;

Create Transponder Transponder1;

GMAT Transponder1.PrimaryAntenna  = Antenna2;
GMAT Transponder1.HardwareDelay   = 0.0;
GMAT Transponder1.TurnAroundRatio = '240/221' 

%
%   Simulator
%

Create Simulator sim;

sim.AddData                     = {simData};
sim.EpochFormat                 = UTCGregorian;
sim.InitialEpoch                = '27 Feb 2005 00:00:00.000';
sim.FinalEpoch                  = '28 Feb 2005 00:00:00.000';
sim.MeasurementTimeStep         = 60;
sim.Propagator                  = ODProp;
sim.AddNoise                    = Off

%
%   BLS
%

Create BatchEstimator bat

bat.ShowProgress                = True;
bat.Measurements                = {estData}; 
bat.AbsoluteTol                 = 0.00001;
bat.RelativeTol                 = 0.01;
bat.MaximumIterations           = 1;
bat.MaxConsecutiveDivergences   = 10;
bat.Propagator                  = ODProp;
bat.ShowAllResiduals            = On;
bat.OLSEInitialRMSSigma         = 1000;
bat.OLSEMultiplicativeConstant  = 6;
bat.OLSEAdditiveConstant        = 0;
bat.InversionAlgorithm          = 'Internal';
bat.EstimationEpochFormat       = 'FromParticipants';
bat.EstimationEpoch             = 'FromParticipants'; 
bat.ReportStyle                 = 'Normal';
bat.ReportFile                  = 'SimEst_RK4.txt';

%
%   Mission Sequence
%

BeginMissionSequence

RunSimulator sim;
RunEstimator bat;