OrbitPropObserver.cpp

Go to the documentation of this file.

//////////////////////////////////////////////////////////////////////////////////////////////////
/*! \file OrbitPropObserver.cpp
*  \brief Orbit propagator observer class.
*  \author $Author: jayhawk_hokie $
*  \version $Revision: 1.1 $
*  \date    $Date: 2007/08/31 16:09:30 $
*//////////////////////////////////////////////////////////////////////////////////////////////////
/*!
*/
//////////////////////////////////////////////////////////////////////////////////////////////////


#include "OrbitPropObserver.h"

using namespace std;

/*! \brief Default Constructor */
OrbitPropObserver::OrbitPropObserver( )
{
        Initialize( );
}

/*! \brief Create a GPS observer from XML handle and whorl object
 *  @param handle XML handle with current whorl as starting node
 *  @param ptr_whorl Pointer to a whorl object
 */
OrbitPropObserver::OrbitPropObserver( TiXmlHandle handle, Whorl* ptr_whorl )
{
        m_whorl = ptr_whorl;

        Initialize( );

        // call parse function to get inertial measurement vectors
        Parse( handle );
}

/*! \brief DeConstructor for OrbitPropObserver object */
OrbitPropObserver::~OrbitPropObserver( )
{ }

/*! \brief Initialize GPS observer
*/
int OrbitPropObserver::Initialize( )
{

        /* Host name and port for communicating with the Numerical Propagator */
        static const char               HOST[]  = "severian.aoe.vt.edu"; //"128.173.191.9"; // severian.aoe.vt.edu
        static const unsigned short     PORT    = 30002; // Port specified by server program

        try
        {

        /* Create Client Socket to communicate with numerical propagator */
        m_clientSocket = new ClientSocket;
        m_clientSocket -> Connect( HOST, PORT );
        //m_clientSocket -> Connect( "128.173.191.9", 30002 );

        cerr << "Connected to Propagator Host. " << endl;

        }
        catch ( SocketException& e )
        {
                std::cout << "Exception was caught:" << e.description() << "\n";
        }

        m_ECIVector.initialize(6);

        /* Vehicle Id number */
        m_vehicleID = 1;
        
        /* Current time */
        m_currentTime = Now( );

        /* Radial, In-track, Cross-Track directions [m/s^2] */
        m_acceleration.initialize(3);        
        //m_controlTorque.initialize(3);
        //Vector m_acceleration;

        /* Space Vehicle mass [kg] */
        m_mass = 100;
 
        return( 0 );
}

/*! \brief Parse inertial measurement vectors from configuration file
        * @param handle XML handle with current whorl as starting node
        */
void OrbitPropObserver::Parse( TiXmlHandle handle )
{

}

/*! \brief Take measurements and update state vector in whorl object */
int OrbitPropObserver::Run( )
{
        m_currentTime = Now( );

        /* Get Current Position ECI [km, km/s] */
        m_ECIVector = GetState( m_clientSocket, m_vehicleID, m_currentTime.GetSeconds( ), m_acceleration, m_mass );
        
        /* Determine Osculating Orbital Elements */
        m_SpaceVehicleOsculatingCOE.SetOsculatingOrbitalElements( m_ECIVector/1000 );

        /* Determine Mean Orbital Elements */
        m_SpaceVehicleMeanCOE = m_SpaceVehicleOsculatingCOE.GetMeanOrbitalElements( ) ;

        /* Set ECI */
        m_whorl->SetECI( m_ECIVector );
        
        /* Set Osculating Orbital Elements */
        m_whorl->SetOscCOE( m_SpaceVehicleOsculatingCOE.GetOsculatingOrbitalElements( ) );
        
        /* Set Mean Classical Orbital Elements */
        m_whorl->SetCOE( m_SpaceVehicleMeanCOE );

        return( 0 );
}

Vector OrbitPropObserver::GetState( ClientSocket *_clientSocket, int _vehicleID, double _currentTime, CAMdoubleVector _acceleration, double _newMass )
{
        ostringstream dataOut;
        dataOut.precision( 18 );
        dataOut << "SC" << _vehicleID << " " << "GET_STATE" << " " << _currentTime << " " << _acceleration(1)
                << " " << _acceleration(2) << " " << _acceleration(3) << " " << _newMass << endl;

        //cout << dataOut.str( ) << endl;
        string reply;
        try
        {
                /* Send string */
                *_clientSocket << dataOut.str( );
                /* Receive string */
                *_clientSocket >> reply;
        }
        catch ( SocketException& e )
        {
                std::cout << "Exception was caught:" << e.description() << "\n";
        }

        return ( ParseState( reply ) );
}

Vector OrbitPropObserver::ParseState( string _reply )
{
        stringstream parseString;
        parseString.str( _reply );

        string command;
        CAMdoubleVector ECIVector(6);

        parseString >> command;

        if( command =="Failure" )
        {
                cerr << "BAD RESPONSE from SERVER " << endl;
        }
        if( command == "STATE" )
        {
                for ( int iterator = 1; iterator < 7; iterator++ )
                {
                        parseString >> ECIVector( iterator );
                }
        }
        else
        {
                cerr << "ERROR in Parsing LOOP" << endl;
        }

        return ( ECIVector );
};


// Do not change the comments below - they will be added automatically by CVS
/*****************************************************************************
*       $Log: OrbitPropObserver.cpp,v $
*       Revision 1.1  2007/08/31 16:09:30  jayhawk_hokie
*       Initial Submission.
*
*
*
******************************************************************************/

---