TwoBodyDynamics.h

Go to the documentation of this file.

/* 
*/

#ifndef __OSESSAME_TWOBODYDYNAMICS_H__
#define __OSESSAME_TWOBODYDYNAMICS_H__
#include "matrix/Matrix.h"
#include "Integrator.h"
#include "Time.h"
#include "Orbit.h"
#include "OrbitState.h"
#include "Attitude.h"
#include <vector.h>
using namespace std;
using namespace O_SESSAME;

static void PositionVelocityConvFunc(const Matrix &_meshPoint, OrbitState &_convertedOrbitState)
{
    static Vector tempPosVelVector(_meshPoint[MatrixColsIndex].getIndexBound() - 1);
    tempPosVelVector(_) = ~_meshPoint(_,_(MatrixIndexBase+1, _meshPoint[MatrixColsIndex].getIndexBound()));
    _convertedOrbitState.GetStateRepresentation()->SetPositionVelocity(tempPosVelVector);
    return;
}

static Vector TwoBodyDynamics(const ssfTime &_time, const Vector& _integratingState, Orbit *_pOrbit, Attitude *_pAttitude, const Matrix &_parameters, const Functor &_forceFunctorPtr)
{
//    _Orbit->SetStateObject(OrbitState(new PositionVelocity(_integratingState)));
    static Vector Forces(3);
    static Vector Velocity(3);
    static Vector stateDot(6);
    static AttitudeState tempAttState; // don't need this except to pass an empty one if there is no attitude
    static OrbitState orbState(new PositionVelocity);

    orbState.GetStateRepresentation()->SetPositionVelocity(_integratingState);

    if(_pAttitude)
        Forces = _forceFunctorPtr.Call(_time, orbState, _pAttitude->GetStateObject());
    else 
        Forces = _forceFunctorPtr.Call(_time, orbState, tempAttState);

    Velocity(_) = _integratingState(_(VectorIndexBase+3,VectorIndexBase+5));
    

    stateDot(_(VectorIndexBase, VectorIndexBase+2)) = Velocity(_);
    stateDot(_(VectorIndexBase+3, VectorIndexBase+5)) = Forces(_);
    return stateDot;
}

#endif
// Do not change the comments below - they will be added automatically by CVS
/*****************************************************************************
*       $Log: TwoBodyDynamics.h,v $
*       Revision 1.7  2003/06/12 18:02:37  nilspace
*       Fixed evaluation.
*       
*       Revision 1.6  2003/05/22 21:03:26  nilspace
*       Fixed to run faster with static variables.
*       
*       Revision 1.5  2003/05/20 17:47:59  nilspace
*       Updated comments.
*       
*       Revision 1.4  2003/05/13 18:49:41  nilspace
*       Fixed to get the StateObjects.
*       
*       Revision 1.3  2003/05/10 00:43:13  nilspace
*       Updated the includes for Orbit.h and Attitude.h
*       
*       Revision 1.2  2003/04/22 20:25:44  simpliciter
*       Updated LaTeX formulas for \ddot{r} and \dot{state vector} for
*       proper display.
*       
*       Revision 1.1  2003/04/08 22:48:29  nilspace
*       Initial Submission.
*       
*
******************************************************************************/

---