root / quad2 / arduino / src / ros_lib / ros / subscriber.h @ c1426757
History | View | Annotate | Download (2.83 KB)
1 |
/*
|
---|---|
2 |
* Software License Agreement (BSD License)
|
3 |
*
|
4 |
* Copyright (c) 2011, Willow Garage, Inc.
|
5 |
* All rights reserved.
|
6 |
*
|
7 |
* Redistribution and use in source and binary forms, with or without
|
8 |
* modification, are permitted provided that the following conditions
|
9 |
* are met:
|
10 |
*
|
11 |
* * Redistributions of source code must retain the above copyright
|
12 |
* notice, this list of conditions and the following disclaimer.
|
13 |
* * Redistributions in binary form must reproduce the above
|
14 |
* copyright notice, this list of conditions and the following
|
15 |
* disclaimer in the documentation and/or other materials provided
|
16 |
* with the distribution.
|
17 |
* * Neither the name of Willow Garage, Inc. nor the names of its
|
18 |
* contributors may be used to endorse or promote prducts derived
|
19 |
* from this software without specific prior written permission.
|
20 |
*
|
21 |
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
22 |
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
23 |
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
24 |
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
25 |
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
26 |
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
27 |
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
28 |
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
|
29 |
* CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
30 |
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
|
31 |
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
32 |
* POSSIBILITY OF SUCH DAMAGE.
|
33 |
*/
|
34 |
|
35 |
#ifndef ROS_SUBSCRIBER_H_
|
36 |
#define ROS_SUBSCRIBER_H_
|
37 |
|
38 |
#include "rosserial_msgs/TopicInfo.h" |
39 |
|
40 |
namespace ros { |
41 |
|
42 |
/* Base class for objects subscribers. */
|
43 |
class Subscriber_ |
44 |
{ |
45 |
public:
|
46 |
virtual void callback(unsigned char *data)=0; |
47 |
virtual int getEndpointType()=0; |
48 |
|
49 |
// id_ is set by NodeHandle when we advertise
|
50 |
int id_;
|
51 |
|
52 |
virtual const char * getMsgType()=0; |
53 |
virtual const char * getMsgMD5()=0; |
54 |
const char * topic_; |
55 |
}; |
56 |
|
57 |
|
58 |
/* Actual subscriber, templated on message type. */
|
59 |
template<typename MsgT> |
60 |
class Subscriber: public Subscriber_{ |
61 |
public:
|
62 |
typedef void(*CallbackT)(const MsgT&); |
63 |
MsgT msg; |
64 |
|
65 |
Subscriber(const char * topic_name, CallbackT cb, int endpoint=rosserial_msgs::TopicInfo::ID_SUBSCRIBER) : |
66 |
cb_(cb), |
67 |
endpoint_(endpoint) |
68 |
{ |
69 |
topic_ = topic_name; |
70 |
}; |
71 |
|
72 |
virtual void callback(unsigned char* data){ |
73 |
msg.deserialize(data); |
74 |
this->cb_(msg); |
75 |
} |
76 |
|
77 |
virtual const char * getMsgType(){ return this->msg.getType(); } |
78 |
virtual const char * getMsgMD5(){ return this->msg.getMD5(); } |
79 |
virtual int getEndpointType(){ return endpoint_; } |
80 |
|
81 |
private:
|
82 |
CallbackT cb_; |
83 |
int endpoint_;
|
84 |
}; |
85 |
|
86 |
} |
87 |
|
88 |
#endif
|