Revision f150aab5 server/include/ROS/AnimationCallbackWrapperROS.h

View differences:

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