robot2d/hwthread.h

/*
 * Orca-Robotics Project: Components for robotics 
 *               http://orca-robotics.sf.net/
 * Copyright (c) 2004-2009 Alex Brooks, Alexei Makarenko, Tobias Kaupp
 *
 * This copy of Orca is licensed to you under the terms described in
 * the LICENSE file included in this distribution.
 *
 */

#ifndef ROBOT2D_HARDWARE_THREAD_H
#define ROBOT2D_HARDWARE_THREAD_H

#include <memory>
#include <orcaice/subsystemthread.h>
#include <orcaice/context.h>
#include <hydrointerfaces/robot2d.h>
#include <hydrodll/dynamicload.h>
#include <gbxsickacfr/gbxiceutilacfr/store.h>
#include <hydrorobotdriverutil/statemachine.h>

namespace robot2d {

//
// @brief The thread that runs the driver
//
// @author Alex Brooks
//
class HwThread : public orcaice::SubsystemThread
{

public: 

    HwThread( const orcaice::Context &context );

    // local interface, used by NetThread

    void setCommand( const hydrointerfaces::Robot2d::Command &command );

    // Return valus same as gbxiceutilacfr::Store.
    int getData( hydrointerfaces::Robot2d::Data &data, int timeoutMs )
        {
            return dataStore_.getNext( data, timeoutMs );
        }

private: 
    // from SubsystemThread
    virtual void work();

    // Keeps trying until success or isStopping()
    void enableDriver();

    // Faults can be detected in either read or write threads: have to be careful.
    hydrorobotdriverutil::StateMachine stateMachine_;

    // Stores the data most recently received from the hardware
    gbxiceutilacfr::Store<hydrointerfaces::Robot2d::Data>    dataStore_;
    // Stores incoming commands
    gbxiceutilacfr::Store<hydrointerfaces::Robot2d::Command> commandStore_;

    bool isMotionEnabled_;

    // The library that contains the driver factory (must be declared first so it's destructed last!!!)
    std::auto_ptr<hydrodll::DynamicallyLoadedLibrary> driverLib_;
    // Generic driver for the hardware
    std::auto_ptr<hydrointerfaces::Robot2d> driver_;

    orcaice::Context context_;
};

} // namespace

#endif