/home/fwph/code/wurde/rde/core/capabilities/Egomotion.H

Go to the documentation of this file.

#ifndef _EGOMOTION_H
#define _EGOMOTION_H
#include <WritableType.H>
#include <Capability.H>
#include <COMObject.H>
#include <queue>
#include <vector>

// $Id: Type.H 66 2007-01-23 20:53:23Z fwph $

#define EGOMOTION "Egomotion"
// IDNUMBER is used to identify data events . IDNUMBER+1 is the info event. this
// system will probably go away soon...
//#define EGOMOTIONIDNUMBER 4

namespace WURDE {
        class Capability;
        class CommsManager;
        class Logger;

        

        
        class EgomotionInfoStruct {
        public:         std::string source;
                std::string target;
                Time timestamp;
                MessageType mType;
        };

        
        class EgomotionDataStruct {
        public:         float angularVelocity;
                std::string source;
                float angularAccel;
                float transAccel;
                Pose location;
                Time timestamp;
                float transVelocity;
        };
  
        class Egomotion : virtual public Capability {

        public:
               explicit Egomotion(const std::string & streamname);             

               Egomotion(const ConnectionStrategy & strategy,const std::string & gblName);

               Egomotion(const std::string & streamname,const std::string & gblName);
               
               ~Egomotion();


               void init(const std::string & streamname,const ConnectionStrategy & strategy, const std::string & gblName);

               
               EgomotionDataStruct data;    
               
               EgomotionInfoStruct info;
               
               EgomotionInfoStruct requests;
               
               //RobotObject imps
               void runUpdate();
               void setManager(CommsManager *myManager_);
               void setCOMObject(COMBase *object){ myCOMObject = dynamic_cast<COMObject<EgomotionInfoStruct,EgomotionDataStruct> *> (object);}
               void disconnect(){if(myCOMObject){myCOMObject->disconnect();}}
               void activateSupplier();
               void activateConsumer();
               std::string getInterfaceName(){ return EGOMOTION;}
               void setStreamName(const std::string & name);
               void setGlobalName(const std::string & name);
               bool newData();
               bool newInfo();
               void setAutoPing(const bool & val);
               void doPing();
               //              int getID(){return EGOMOTIONIDNUMBER;}

               bool getQueueMode(){return m_queue;};

               void setQueueMode(const bool & val);
               
               EgomotionDataStruct getNextData();
               
               EgomotionInfoStruct getNextInfo();

               EgomotionInfoStruct getNextRequest(){return getNextInfo();}

               void publishData();
               void publishInfo();
               //void publishRequest();
               
        protected:
               COMObject<EgomotionInfoStruct, EgomotionDataStruct> *myCOMObject;

               bool m_queue;

               //notes that the object should be initialized as soon as a streamname is received
               bool m_initialize;
               std::queue<EgomotionDataStruct> m_dataVector;
               std::queue<EgomotionInfoStruct> m_infoVector;
               std::queue<EgomotionInfoStruct> m_requestVector;
        
        };

}


#endif

---