Revision f150aab5 server/include/ROS/CallbackWrapperROS.h
server/include/ROS/CallbackWrapperROS.h | ||
---|---|---|
1 | 1 |
/* |
2 |
* This file is part of hlrc_server |
|
3 |
* |
|
4 |
* Copyright(c) sschulz <AT> techfak.uni-bielefeld.de |
|
5 |
* http://opensource.cit-ec.de/projects/hlrc_server |
|
6 |
* |
|
7 |
* This file may be licensed under the terms of the |
|
8 |
* GNU General Public License Version 3 (the ``GPL''), |
|
9 |
* or (at your option) any later version. |
|
10 |
* |
|
11 |
* Software distributed under the License is distributed |
|
12 |
* on an ``AS IS'' basis, WITHOUT WARRANTY OF ANY KIND, either |
|
13 |
* express or implied. See the GPL for the specific language |
|
14 |
* governing rights and limitations. |
|
15 |
* |
|
16 |
* You should have received a copy of the GPL along with this |
|
17 |
* program. If not, go to http://www.gnu.org/licenses/gpl.html |
|
18 |
* or write to the Free Software Foundation, Inc., |
|
19 |
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. |
|
20 |
* |
|
21 |
* The development of this software was supported by the |
|
22 |
* Excellence Cluster EXC 277 Cognitive Interaction Technology. |
|
23 |
* The Excellence Cluster EXC 277 is a grant of the Deutsche |
|
24 |
* Forschungsgemeinschaft (DFG) in the context of the German |
|
25 |
* Excellence Initiative. |
|
26 |
* |
|
27 |
*/ |
|
2 |
* This file is part of hlrc_server
|
|
3 |
*
|
|
4 |
* Copyright(c) sschulz <AT> techfak.uni-bielefeld.de
|
|
5 |
* http://opensource.cit-ec.de/projects/hlrc_server
|
|
6 |
*
|
|
7 |
* This file may be licensed under the terms of the
|
|
8 |
* GNU General Public License Version 3 (the ``GPL''),
|
|
9 |
* or (at your option) any later version.
|
|
10 |
*
|
|
11 |
* Software distributed under the License is distributed
|
|
12 |
* on an ``AS IS'' basis, WITHOUT WARRANTY OF ANY KIND, either
|
|
13 |
* express or implied. See the GPL for the specific language
|
|
14 |
* governing rights and limitations.
|
|
15 |
*
|
|
16 |
* You should have received a copy of the GPL along with this
|
|
17 |
* program. If not, go to http://www.gnu.org/licenses/gpl.html
|
|
18 |
* or write to the Free Software Foundation, Inc.,
|
|
19 |
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
|
|
20 |
*
|
|
21 |
* The development of this software was supported by the
|
|
22 |
* Excellence Cluster EXC 277 Cognitive Interaction Technology.
|
|
23 |
* The Excellence Cluster EXC 277 is a grant of the Deutsche
|
|
24 |
* Forschungsgemeinschaft (DFG) in the context of the German
|
|
25 |
* Excellence Initiative.
|
|
26 |
*
|
|
27 |
*/
|
|
28 | 28 |
|
29 | 29 |
#pragma once |
30 | 30 |
#include "Middleware.h" |
... | ... | |
32 | 32 |
#include <actionlib/server/simple_action_server.h> |
33 | 33 |
#include <actionlib/action_definition.h> |
34 | 34 |
|
35 |
template <typename actionspec> class CallbackWrapper{ |
|
36 |
protected: |
|
37 |
//NODEHANDLE has to be created before evrything else, otherwise really strange things happen (really!) |
|
38 |
//ros::NodeHandle nh_; |
|
35 |
template <typename actionspec> |
|
36 |
class CallbackWrapper { |
|
37 |
protected: |
|
38 |
// NODEHANDLE has to be created before evrything else, otherwise really strange things happen (really!) |
|
39 |
// ros::NodeHandle nh_; |
|
39 | 40 |
|
40 |
public:
|
|
41 |
//get nice macros
|
|
42 |
ACTION_DEFINITION(actionspec);
|
|
41 |
public: |
|
42 |
// get nice macros
|
|
43 |
ACTION_DEFINITION(actionspec);
|
|
43 | 44 |
|
44 |
CallbackWrapper(Middleware *_mw, std::string scope, std::string _name, boost::function<void (const GoalConstPtr&)> cb = 0) : as_(scope + "/" + _name, cb, false){ |
|
45 |
name = _name; |
|
46 |
mw = _mw; |
|
47 |
as_.start(); |
|
48 |
} |
|
45 |
CallbackWrapper(Middleware* _mw, std::string scope, std::string _name, boost::function<void(const GoalConstPtr&)> cb = 0) |
|
46 |
: as_(scope + "/" + _name, cb, false) { |
|
47 |
name = _name; |
|
48 |
mw = _mw; |
|
49 |
as_.start(); |
|
50 |
} |
|
49 | 51 |
|
50 |
~CallbackWrapper(){} |
|
52 |
~CallbackWrapper() { |
|
53 |
} |
|
51 | 54 |
|
55 |
protected: |
|
56 |
double get_timestamp() { |
|
57 |
// fetch time |
|
58 |
struct timespec tp; |
|
59 |
clock_gettime(CLOCK_REALTIME, &tp); |
|
60 |
return tp.tv_sec + tp.tv_nsec / 1000000000.0; |
|
61 |
}; |
|
52 | 62 |
|
53 |
protected: |
|
54 |
double get_timestamp(){ |
|
55 |
//fetch time |
|
56 |
struct timespec tp; |
|
57 |
clock_gettime(CLOCK_REALTIME, &tp); |
|
58 |
return tp.tv_sec+tp.tv_nsec/1000000000.0; |
|
59 |
}; |
|
63 |
actionlib::SimpleActionServer<actionspec> as_; |
|
60 | 64 |
|
61 |
actionlib::SimpleActionServer<actionspec> as_; |
|
62 |
|
|
63 |
std::string name; |
|
64 |
Middleware *mw; |
|
65 |
std::string name; |
|
66 |
Middleware* mw; |
|
65 | 67 |
}; |
Also available in: Unified diff