TimerComponent.hpp

#ifndef ORO_TIMER_COMPONENT_HPP
#define ORO_TIMER_COMPONENT_HPP


#include <rtt/os/TimeService.hpp>
#include <rtt/TaskContext.hpp>
#include <rtt/os/Timer.hpp>
#include <rtt/OutputPort.hpp>

#include <rtt/RTT.hpp>
#include <ocl/OCL.hpp>

namespace OCL
{
    class TimerComponent
        : public RTT::TaskContext
    {
    protected:
        struct TimeoutCatcher : public os::Timer {
            RTT::OutputPort<RTT::os::Timer::TimerId>& me;
            std::vector<RTT::OutputPort<RTT::os::Timer::TimerId>* >& m_port_timers;
            TimeoutCatcher(std::vector<RTT::OutputPort<RTT::os::Timer::TimerId>* >& port_timers, RTT::OutputPort<RTT::os::Timer::TimerId>&  op) :
                me(op),
                os::Timer(port_timers.size(), ORO_SCHED_RT, os::HighestPriority), m_port_timers(port_timers)
            {}
            virtual void timeout(os::Timer::TimerId id) {
                m_port_timers[id]->write(id);
                me.write(id);
            }
        };

        std::vector<OutputPort<RTT::os::Timer::TimerId>* > port_timers;
        OutputPort<RTT::os::Timer::TimerId> mtimeoutEvent;
        TimeoutCatcher mtimer;

        bool startHook();
        void updateHook();
        void stopHook();

        RTT::Operation<bool(RTT::os::Timer::TimerId)> waitForCommand;

        RTT::Operation<bool(RTT::os::Timer::TimerId, double)> waitCommand;

        bool waitFor(RTT::os::Timer::TimerId id);

        bool wait(RTT::os::Timer::TimerId id, double seconds);

        bool isTimerExpired(RTT::os::Timer::TimerId id) const;
    public:
        TimerComponent( std::string name = "os::Timer" );

        virtual ~TimerComponent();
    };

}

#endif