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

Go to the documentation of this file.

#ifndef _BUMPER_H
#define _BUMPER_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 BUMPER "Bumper"
// IDNUMBER is used to identify data events . IDNUMBER+1 is the info event. this
// system will probably go away soon...
//#define BUMPERIDNUMBER 2

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

        

        
        class BumperInfoStruct {
        public:         Writable< float  > x_offset;
                std::string source;
                Writable< float  > y_offset;
                Writable< float  > phi_separation;
                std::string target;
                Writable< float  > psi_offset;
                Time timestamp;
                Writable< float  > x_separation;
                Writable< float  > phi_offset;
                Writable< float  > theta_separation;
                Writable< float  > psi_separation;
                Writable< std::vector< Pose3D > > sensor_positions;
                Writable< float  > y_separation;
                MessageType mType;
                Writable< bool  > uniform;
                Writable< float  > theta_offset;
                Writable< float  > z_separation;
                Writable< float  > z_offset;
        };

        
        class BumperDataStruct {
        public:         std::string source;
                Time timestamp;
                std::vector< bool > bumpers;
                bool bumped;
        };
  
        class Bumper : virtual public Capability {

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

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

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


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

               
               BumperDataStruct data;    
               
               BumperInfoStruct info;
               
               BumperInfoStruct requests;
               
               //RobotObject imps
               void runUpdate();
               void setManager(CommsManager *myManager_);
               void setCOMObject(COMBase *object){ myCOMObject = dynamic_cast<COMObject<BumperInfoStruct,BumperDataStruct> *> (object);}
               void disconnect(){if(myCOMObject){myCOMObject->disconnect();}}
               void activateSupplier();
               void activateConsumer();
               std::string getInterfaceName(){ return BUMPER;}
               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 BUMPERIDNUMBER;}

               bool getQueueMode(){return m_queue;};

               void setQueueMode(const bool & val);
               
               BumperDataStruct getNextData();
               
               BumperInfoStruct getNextInfo();

               BumperInfoStruct getNextRequest(){return getNextInfo();}

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

               bool m_queue;

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

}


#endif

---