$search
00001 /* 00002 * Software License Agreement (Modified BSD License) 00003 * 00004 * Copyright (c) 2012, PAL Robotics, S.L. 00005 * All rights reserved. 00006 * 00007 * Redistribution and use in source and binary forms, with or without 00008 * modification, are permitted provided that the following conditions 00009 * are met: 00010 * 00011 * * Redistributions of source code must retain the above copyright 00012 * notice, this list of conditions and the following disclaimer. 00013 * * Redistributions in binary form must reproduce the above 00014 * copyright notice, this list of conditions and the following 00015 * disclaimer in the documentation and/or other materials provided 00016 * with the distribution. 00017 * * Neither the name of PAL Robotics, S.L. nor the names of its 00018 * contributors may be used to endorse or promote products derived 00019 * from this software without specific prior written permission. 00020 * 00021 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 00022 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 00023 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 00024 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE 00025 * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 00026 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 00027 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 00028 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER 00029 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 00030 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 00031 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 00032 * POSSIBILITY OF SUCH DAMAGE. 00033 */ 00034 00035 #ifndef GAZEBO_ROS_BUMPER_CONTROLLER_HH 00036 #define GAZEBO_ROS_BUMPER_CONTROLLER_HH 00037 00038 #define USE_CBQ 00039 #ifdef USE_CBQ 00040 #include <ros/callback_queue.h> 00041 #include <ros/advertise_options.h> 00042 #endif 00043 00044 #include <sys/time.h> 00045 #include <std_msgs/Bool.h> 00046 00047 #include <gazebo/Controller.hh> 00048 #include <gazebo/Entity.hh> 00049 #include <gazebo/Param.hh> 00050 00051 // ros messages 00052 #include <ros/ros.h> 00053 #include "boost/thread/mutex.hpp" 00054 #include <std_msgs/String.h> 00055 00056 #include <gazebo_msgs/ContactState.h> 00057 #include <gazebo_msgs/ContactsState.h> 00058 00059 namespace gazebo 00060 { 00061 class ContactSensor; 00062 00063 00065 class My_Generic_Bumper : public Controller 00066 { 00068 public: My_Generic_Bumper(Entity *parent ); 00069 00071 public: virtual ~My_Generic_Bumper(); 00072 00075 protected: virtual void LoadChild(XMLConfigNode *node); 00076 00078 protected: virtual void InitChild(); 00079 00081 protected: virtual void UpdateChild(); 00082 00084 protected: virtual void FiniChild(); 00085 00087 private: ContactSensor *myParent; 00088 00091 private: Body *myFrame; 00092 00094 private: ros::NodeHandle* rosnode_; 00095 private: ros::Publisher contact_pub_; 00096 00098 private: ParamT<std::string> *bumperTopicNameP; 00099 private: std::string bumperTopicName; 00100 00101 private: ParamT<std::string> *frameNameP; 00102 private: std::string frameName; 00103 00104 private: ParamT<std::string> *frameIdP; 00105 private: std::string frameId; 00106 00108 private: boost::mutex lock; 00109 00111 private: gazebo_msgs::ContactsState contactsStateMsg; 00112 private: std_msgs::Bool boolMsg; 00113 00115 private: ParamT<std::string> *robotNamespaceP; 00116 private: std::string robotNamespace; 00117 00119 private: int contactConnectCount; 00120 private: void ContactConnect(); 00121 private: void ContactDisconnect(); 00122 00123 #ifdef USE_CBQ 00124 private: ros::CallbackQueue contact_queue_; 00125 private: void ContactQueueThread(); 00126 private: boost::thread callback_queue_thread_; 00127 #endif 00128 00129 }; 00130 00132 00133 00134 } 00135 00136 #endif