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