Revision f150aab5 server/include/ROS/EmotionCallbackWrapperROS.h
| server/include/ROS/EmotionCallbackWrapperROS.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/emotionstateAction.h" |
| 31 | 31 |
#include "CallbackWrapperROS.h" |
| 32 | 32 |
|
| 33 |
//callback handler incoming gaze requests: |
|
| 34 |
class EmotionCallbackWrapper : CallbackWrapper<hlrc_server::emotionstateAction>{
|
|
| 33 |
// callback handler incoming gaze requests:
|
|
| 34 |
class EmotionCallbackWrapper : CallbackWrapper<hlrc_server::emotionstateAction> {
|
|
| 35 | 35 |
protected: |
| 36 |
hlrc_server::emotionstateFeedback feedback; |
|
| 37 |
hlrc_server::emotionstateResult result; |
|
| 38 |
|
|
| 36 |
hlrc_server::emotionstateFeedback feedback; |
|
| 37 |
hlrc_server::emotionstateResult result; |
|
| 39 | 38 |
|
| 40 | 39 |
public: |
| 40 |
EmotionCallbackWrapper(Middleware* mw, std::string scope, std::string name) |
|
| 41 |
: CallbackWrapper<hlrc_server::emotionstateAction>(mw, scope, name, |
|
| 42 |
boost::bind(&EmotionCallbackWrapper::call, this, _1)){
|
|
| 43 |
// |
|
| 44 |
}; |
|
| 41 | 45 |
|
| 42 |
EmotionCallbackWrapper(Middleware *mw, std::string scope, std::string name) : CallbackWrapper<hlrc_server::emotionstateAction>(mw, scope, name, boost::bind(&EmotionCallbackWrapper::call, this, _1)){
|
|
| 43 |
// |
|
| 44 |
}; |
|
| 45 |
|
|
| 46 |
void call(const GoalConstPtr &goal){
|
|
| 47 |
hlrc_server::emotionstateGoalConstPtr request = goal; |
|
| 48 |
printf("> incoming emotion (%s = %d)\n", name.c_str(), (int)request->value);
|
|
| 49 |
feedback.result = 1; |
|
| 50 |
|
|
| 51 |
EmotionState emotion_state; |
|
| 46 |
void call(const GoalConstPtr& goal) {
|
|
| 47 |
hlrc_server::emotionstateGoalConstPtr request = goal; |
|
| 48 |
printf("> incoming emotion (%s = %d)\n", name.c_str(), (int)request->value);
|
|
| 49 |
feedback.result = 1; |
|
| 52 | 50 |
|
| 53 |
//extract data & copy it to our datatype (might be good when we allow multiple middlewares in the feature) |
|
| 54 |
switch ((int)request->value){
|
|
| 55 |
case(hlrc_server::emotionstateGoal::NEUTRAL): emotion_state.value = EmotionConfig::NEUTRAL; break; |
|
| 56 |
case(hlrc_server::emotionstateGoal::HAPPY): emotion_state.value = EmotionConfig::HAPPY; break; |
|
| 57 |
case(hlrc_server::emotionstateGoal::SAD): emotion_state.value = EmotionConfig::SAD; break; |
|
| 58 |
case(hlrc_server::emotionstateGoal::ANGRY): emotion_state.value = EmotionConfig::ANGRY; break; |
|
| 59 |
case(hlrc_server::emotionstateGoal::SURPRISED): emotion_state.value = EmotionConfig::SURPRISED; break; |
|
| 60 |
case(hlrc_server::emotionstateGoal::FEAR): emotion_state.value = EmotionConfig::FEAR; break; |
|
| 61 |
default: |
|
| 62 |
printf("> invalid EmotionState value. exiting\n");
|
|
| 63 |
feedback.result = 0; |
|
| 64 |
return; |
|
| 65 |
} |
|
| 51 |
EmotionState emotion_state; |
|
| 66 | 52 |
|
| 67 |
emotion_state.duration = request->duration; |
|
| 53 |
// extract data & copy it to our datatype (might be good when we allow multiple middlewares in the feature) |
|
| 54 |
switch ((int)request->value) {
|
|
| 55 |
case (hlrc_server::emotionstateGoal::NEUTRAL): |
|
| 56 |
emotion_state.value = EmotionConfig::NEUTRAL; |
|
| 57 |
break; |
|
| 58 |
case (hlrc_server::emotionstateGoal::HAPPY): |
|
| 59 |
emotion_state.value = EmotionConfig::HAPPY; |
|
| 60 |
break; |
|
| 61 |
case (hlrc_server::emotionstateGoal::SAD): |
|
| 62 |
emotion_state.value = EmotionConfig::SAD; |
|
| 63 |
break; |
|
| 64 |
case (hlrc_server::emotionstateGoal::ANGRY): |
|
| 65 |
emotion_state.value = EmotionConfig::ANGRY; |
|
| 66 |
break; |
|
| 67 |
case (hlrc_server::emotionstateGoal::SURPRISED): |
|
| 68 |
emotion_state.value = EmotionConfig::SURPRISED; |
|
| 69 |
break; |
|
| 70 |
case (hlrc_server::emotionstateGoal::FEAR): |
|
| 71 |
emotion_state.value = EmotionConfig::FEAR; |
|
| 72 |
break; |
|
| 73 |
default: |
|
| 74 |
printf("> invalid EmotionState value. exiting\n");
|
|
| 75 |
feedback.result = 0; |
|
| 76 |
return; |
|
| 77 |
} |
|
| 68 | 78 |
|
| 69 |
//send to application |
|
| 70 |
if (name == "defaultEmotion"){
|
|
| 71 |
//set default emotion: |
|
| 72 |
mw->default_emotion_callback(emotion_state); |
|
| 73 |
}else if (name == "currentEmotion"){
|
|
| 74 |
//set current emotion: |
|
| 75 |
mw->current_emotion_callback(emotion_state); |
|
| 76 |
}else{
|
|
| 77 |
printf("> invalid method called '%s'\n",name.c_str());
|
|
| 78 |
return; |
|
| 79 |
} |
|
| 79 |
emotion_state.duration = request->duration; |
|
| 80 | 80 |
|
| 81 |
if (feedback.result){
|
|
| 82 |
result.result = 1; |
|
| 83 |
as_.setSucceeded(result); |
|
| 84 |
}else{
|
|
| 85 |
as_.setAborted(result); |
|
| 86 |
} |
|
| 81 |
// send to application |
|
| 82 |
if (name == "defaultEmotion") {
|
|
| 83 |
// set default emotion: |
|
| 84 |
mw->default_emotion_callback(emotion_state); |
|
| 85 |
} |
|
| 86 |
else if (name == "currentEmotion") {
|
|
| 87 |
// set current emotion: |
|
| 88 |
mw->current_emotion_callback(emotion_state); |
|
| 89 |
} |
|
| 90 |
else {
|
|
| 91 |
printf("> invalid method called '%s'\n", name.c_str());
|
|
| 92 |
return; |
|
| 93 |
} |
|
| 87 | 94 |
|
| 88 |
} |
|
| 95 |
if (feedback.result) {
|
|
| 96 |
result.result = 1; |
|
| 97 |
as_.setSucceeded(result); |
|
| 98 |
} |
|
| 99 |
else {
|
|
| 100 |
as_.setAborted(result); |
|
| 101 |
} |
|
| 102 |
} |
|
| 89 | 103 |
}; |
| 90 |
|
|
| 91 |
|
|
Also available in: Unified diff