DemoWhorl2.cpp

Go to the documentation of this file.

//////////////////////////////////////////////////////////////////////////////////////////////////
/*! \file DemoWhorl2.cpp
*  \brief Runs momentum wheels, thrusters and cmg on Whorl-II.
*  \author $Author: jayhawk_hokie $
*  \version $Revision: 1.1 $
*  \date    $Date: 2005/09/18 17:14:30 $
*//////////////////////////////////////////////////////////////////////////////////////////////////
/*!
*/
//////////////////////////////////////////////////////////////////////////////////////////////////

// include control devices
        #include <Actuators/MomentumWheel.h>
        #include <Actuators/Thruster.h>
        #include <Actuators/ControlMomentGyro.h>
// include time
        #include <utils/Time.h>
// include math
        #include <matrix/Matrix.h>
// include standard output
        #include <iostream.h>
        #include <unistd.h>
        #include <string.h>
        #include <fstream.h>
        #include <fstream>

using namespace std; // shortcut for std::cout, std::endl, etc

// The main routine
int main()
{

        // Initialize Momentum Wheels
        MomentumWheel WheelX;
        MomentumWheel WheelY;
        MomentumWheel WheelZ;
        WheelX.SetPort("USB4");
        WheelY.SetPort("USB5");
        WheelZ.SetPort("USB6");
        WheelX.Initialize();
        WheelY.Initialize();

        sleep(50); // pause for 50 seconds
        // Thrusters
        Thruster t1;
        Thruster t2;
        t1.StartFire(8); // fire thruster 1 for 8 seconds
        sleep(10); // pause for 10 seconds
        t1.StopFire();
        // Momentum Wheel Control
        WheelX.SetWheelSpeed(55); // rates (deg/s)
        sleep(45);
        WheelZ.SetWheelSpeed(20);
        WheelY.SetWheelSpeed(20);
        sleep(5);
        WheelX.SetWheelSpeed(0);
        sleep(10);
        //WheelY.SetWheelSpeed(20);
        sleep(10);
        //WheelX.SetWheelSpeed(-30);
        WheelZ.SetWheelSpeed(0);
        WheelY.SetWheelSpeed(0);
        sleep(15);
        //WheelX.SetWheelSpeed(0);
        
        WheelX.Stop();
        WheelY.Stop();
        WheelZ.Deinitialize();
        WheelX.Deinitialize();
        WheelY.Deinitialize();

        cout << "Whorl-II demo COMPLETE" << endl; // display to screen

        return 0; // terminate program

}

// Do not change the comments below - they will be added automatically by CVS
/*****************************************************************************
*       $Log: DemoWhorl2.cpp,v $
*       Revision 1.1  2005/09/18 17:14:30  jayhawk_hokie
*       Initial Addition of Test programs
*
*       Revision 1.1  2005/06/17 18:07:28  jayhawk_hokie
*       Initial submission.
*
*
******************************************************************************/

---