Revision f150aab5 server/include/ROS/AnimationCallbackWrapperROS.h
server/include/ROS/AnimationCallbackWrapperROS.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 "hlrc_server/animationAction.h" |
31 | 31 |
#include "CallbackWrapperROS.h" |
32 | 32 |
|
33 |
//callback handler incoming gaze requests: |
|
34 |
class AnimationCallbackWrapper : CallbackWrapper<hlrc_server::animationAction>{ |
|
33 |
// callback handler incoming gaze requests:
|
|
34 |
class AnimationCallbackWrapper : CallbackWrapper<hlrc_server::animationAction> {
|
|
35 | 35 |
protected: |
36 |
hlrc_server::animationFeedback feedback;
|
|
37 |
hlrc_server::animationResult result;
|
|
36 |
hlrc_server::animationFeedback feedback;
|
|
37 |
hlrc_server::animationResult result;
|
|
38 | 38 |
|
39 | 39 |
public: |
40 |
AnimationCallbackWrapper(Middleware *mw, std::string scope, std::string name) : CallbackWrapper<hlrc_server::animationAction>(mw, scope, name, boost::bind(&AnimationCallbackWrapper::call, this, _1)){ |
|
41 |
// |
|
42 |
}; |
|
40 |
AnimationCallbackWrapper(Middleware* mw, std::string scope, std::string name) |
|
41 |
: CallbackWrapper<hlrc_server::animationAction>(mw, scope, name, |
|
42 |
boost::bind(&AnimationCallbackWrapper::call, this, _1)){ |
|
43 |
// |
|
44 |
}; |
|
43 | 45 |
|
44 |
void call(const GoalConstPtr &goal){
|
|
45 |
hlrc_server::animationGoalConstPtr request = goal;
|
|
46 |
printf("> incoming animation (%d)\n", (int)request->target);
|
|
46 |
void call(const GoalConstPtr& goal) {
|
|
47 |
hlrc_server::animationGoalConstPtr request = goal;
|
|
48 |
printf("> incoming animation (%d)\n", (int)request->target);
|
|
47 | 49 |
|
48 |
boost::shared_ptr<Animation> ani(new Animation());
|
|
50 |
boost::shared_ptr<Animation> ani(new Animation());
|
|
49 | 51 |
|
50 |
//everything is ok, will be cleared on failures
|
|
51 |
feedback.result = 1;
|
|
52 |
// everything is ok, will be cleared on failures
|
|
53 |
feedback.result = 1;
|
|
52 | 54 |
|
53 |
switch ((int) request->target){ |
|
54 |
case(hlrc_server::animationGoal::IDLE): ani->target = Animation::IDLE; break; |
|
55 |
case(hlrc_server::animationGoal::HEAD_NOD): ani->target = Animation::HEAD_NOD; break; |
|
56 |
case(hlrc_server::animationGoal::HEAD_SHAKE): ani->target = Animation::HEAD_SHAKE; break; |
|
57 |
case(hlrc_server::animationGoal::EYEBLINK_L): ani->target = Animation::EYEBLINK_L; break; |
|
58 |
case(hlrc_server::animationGoal::EYEBLINK_R): ani->target = Animation::EYEBLINK_R; break; |
|
59 |
case(hlrc_server::animationGoal::EYEBLINK_BOTH): ani->target = Animation::EYEBLINK_BOTH; break; |
|
60 |
case(hlrc_server::animationGoal::EYEBROWS_RAISE):ani->target = Animation::EYEBROWS_RAISE;break; |
|
61 |
case(hlrc_server::animationGoal::EYEBROWS_LOWER):ani->target = Animation::EYEBROWS_LOWER;break; |
|
62 |
default: |
|
63 |
ani->target = Animation::IDLE; |
|
64 |
printf("> unhandled animatin target %d\n",(int)request->target); |
|
65 |
//throw std::runtime_error("AnimationCallback: invalid animation id"); |
|
66 |
feedback.result = 0; |
|
67 |
} |
|
55 |
switch ((int)request->target) { |
|
56 |
case (hlrc_server::animationGoal::IDLE): |
|
57 |
ani->target = Animation::IDLE; |
|
58 |
break; |
|
59 |
case (hlrc_server::animationGoal::HEAD_NOD): |
|
60 |
ani->target = Animation::HEAD_NOD; |
|
61 |
break; |
|
62 |
case (hlrc_server::animationGoal::HEAD_SHAKE): |
|
63 |
ani->target = Animation::HEAD_SHAKE; |
|
64 |
break; |
|
65 |
case (hlrc_server::animationGoal::EYEBLINK_L): |
|
66 |
ani->target = Animation::EYEBLINK_L; |
|
67 |
break; |
|
68 |
case (hlrc_server::animationGoal::EYEBLINK_R): |
|
69 |
ani->target = Animation::EYEBLINK_R; |
|
70 |
break; |
|
71 |
case (hlrc_server::animationGoal::EYEBLINK_BOTH): |
|
72 |
ani->target = Animation::EYEBLINK_BOTH; |
|
73 |
break; |
|
74 |
case (hlrc_server::animationGoal::EYEBROWS_RAISE): |
|
75 |
ani->target = Animation::EYEBROWS_RAISE; |
|
76 |
break; |
|
77 |
case (hlrc_server::animationGoal::EYEBROWS_LOWER): |
|
78 |
ani->target = Animation::EYEBROWS_LOWER; |
|
79 |
break; |
|
80 |
default: |
|
81 |
ani->target = Animation::IDLE; |
|
82 |
printf("> unhandled animatin target %d\n", (int)request->target); |
|
83 |
// throw std::runtime_error("AnimationCallback: invalid animation id"); |
|
84 |
feedback.result = 0; |
|
85 |
} |
|
68 | 86 |
|
69 |
ani->repetitions = request->repetitions;
|
|
70 |
ani->duration_each = request->duration_each;
|
|
71 |
ani->scale = request->scale;
|
|
87 |
ani->repetitions = request->repetitions;
|
|
88 |
ani->duration_each = request->duration_each;
|
|
89 |
ani->scale = request->scale;
|
|
72 | 90 |
|
73 |
printf("> new Animation: %s\n", ani->as_string().c_str());
|
|
91 |
printf("> new Animation: %s\n", ani->as_string().c_str());
|
|
74 | 92 |
|
75 |
//send to application
|
|
76 |
mw->animation_callback(ani);
|
|
93 |
// send to application
|
|
94 |
mw->animation_callback(ani);
|
|
77 | 95 |
|
78 |
if (feedback.result){
|
|
79 |
result.result = 1;
|
|
80 |
as_.setSucceeded(result);
|
|
81 |
}else{
|
|
82 |
as_.setAborted(result);
|
|
83 |
}
|
|
84 |
|
|
85 |
}
|
|
96 |
if (feedback.result) {
|
|
97 |
result.result = 1;
|
|
98 |
as_.setSucceeded(result);
|
|
99 |
}
|
|
100 |
else {
|
|
101 |
as_.setAborted(result);
|
|
102 |
} |
|
103 |
}
|
|
86 | 104 |
}; |
87 |
|
|
88 |
|
Also available in: Unified diff