Project: engagement_recognition License: BSD Dependencies:
Used by:
None |
engagement_recognition/src/recognition/recognizers/backchannel/bc_robot_floor_state.cppGo to the documentation of this file.00001 /* 00002 * Software License Agreement (BSD License) 00003 * 00004 * Copyright (c) 2010, Worcester Polytechnic Institute 00005 * All rights reserved. 00006 * 00007 * Redistribution and use in source and binary forms, with or without 00008 * modification, are permitted provided that the following conditions 00009 * are met: 00010 * 00011 * * Redistributions of source code must retain the above copyright 00012 * notice, this list of conditions and the following disclaimer. 00013 * * Redistributions in binary form must reproduce the above 00014 * copyright notice, this list of conditions and the following 00015 * disclaimer in the documentation and/or other materials provided 00016 * with the distribution. 00017 * * Neither the name of Worcester Polytechnic Institute. nor the names 00018 * of its contributors may be used to endorse or promote products 00019 * derived from this software without specific prior written permission. 00020 * 00021 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 00022 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 00023 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 00024 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE 00025 * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 00026 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 00027 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 00028 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER 00029 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 00030 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 00031 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 00032 * POSSIBILITY OF SUCH DAMAGE. 00033 */ 00034 // @author Brett Ponsler (bponsler (at) wpi (dot) edu) 00035 #include "bc_robot_floor_state.h" 00036 00037 #include "../../events/event_factory.h" 00038 #include "../../lib/engagement_params.h" 00039 00040 BCRobotFloorState::BCRobotFloorState() : 00041 State(BCRobotFloorState::type(), "", NULL) 00042 { 00043 // Set the logger based on this type of recognizer 00044 this->setLogger(EngagementParams::getStateTag(BCRobotFloorState::type())); 00045 00046 this->warn("[%s] state initialized with an invalid actor, and EventSink."); 00047 } 00048 00049 BCRobotFloorState::BCRobotFloorState(std::string actor, EventSink *sink) : 00050 State(BCRobotFloorState::type(), actor, sink) 00051 { 00052 // Set the logger based on this type of recognizer 00053 this->setLogger(sink->getLogger(), 00054 EngagementParams::getStateTag(BCRobotFloorState::type())); 00055 } 00056 00057 BCRobotFloorState::~BCRobotFloorState() 00058 { 00059 } 00060 00061 Event BCRobotFloorState::received(std::string topic, engagement_msgs::Performance *message) 00062 { 00063 if (topic == engagement::VISION_NAMESPACE + "/" + engagement::PERFORMING_NOD_TOPIC) 00064 return this->visionNodCallback(message); 00065 else if (topic == engagement::VISION_NAMESPACE + "/" + engagement::PERFORMING_SHAKE_TOPIC) 00066 return this->visionShakeCallback(message); 00067 00068 return Event(); 00069 } 00070 00071 Event BCRobotFloorState::received(std::string topic, engagement_msgs::Speech *message) 00072 { 00073 if (topic == engagement::PERFORMING_NAMESPACE + "/" + engagement::PERFORMING_UTTERANCE_TOPIC) 00074 return this->performingUtteranceCallback(message); 00075 00076 return Event(); 00077 } 00078 00079 Event BCRobotFloorState::performingUtteranceCallback(const engagement_msgs::Speech *msg) 00080 { 00081 this->debug(25, "Entered %s %s", 00082 engagement::PERFORMING_NAMESPACE.c_str(), 00083 engagement::PERFORMING_UTTERANCE_TOPIC.c_str()); 00084 00085 // Make sure we have a valid message 00086 if (msg) 00087 { 00088 // Grab the message type from the constant pointer 00089 engagement_msgs::Speech temp_msg = *msg; 00090 00091 // Cast ourselves into a State 00092 State *state = (State*)this; 00093 00094 // Grab the actor from the state 00095 Actor *actor = state->getActor(); 00096 00097 // If the actor is starting an utterance we issue a human init event 00098 if (actor != NULL && temp_msg.actor.id == actor->getID() && 00099 temp_msg.begin.value == bml_msgs::Flag::BEGIN) 00100 { 00101 this->debug(7, "Received [%s] start %s message.", 00102 actor->getID().c_str(), 00103 engagement::PERFORMING_UTTERANCE_TOPIC.c_str()); 00104 00105 // Create the human initiated event 00106 return EventFactory::humanInitiated(); 00107 } 00108 // If the actor is doing a verbal backchannel issue a success 00109 else if (actor != NULL && temp_msg.actor.id == actor->getID() && 00110 temp_msg.begin.value == bml_msgs::Flag::BACKCHANNEL) 00111 { 00112 this->debug(7, "Received [%s] backchannel %s message.", 00113 actor->getID().c_str(), 00114 engagement::PERFORMING_UTTERANCE_TOPIC.c_str()); 00115 00116 // Create the human initiated event 00117 return EventFactory::success(); 00118 } 00119 else if (temp_msg.actor.id == temp_msg.actor.ROBOT && 00120 temp_msg.begin.value == bml_msgs::Flag::END) 00121 { 00122 this->debug(7, "Received ROBOT END %s message.", 00123 actor->getID().c_str(), 00124 engagement::PERFORMING_UTTERANCE_TOPIC.c_str()); 00125 00126 // If robot stops talking 00127 // Transition to start state 00128 return EventFactory::cycle(); 00129 } 00130 } 00131 00132 return Event(); 00133 } 00134 00135 Event BCRobotFloorState::visionShakeCallback(const engagement_msgs::Performance *msg) 00136 { 00137 this->debug(25, "Entered %s %s", 00138 engagement::VISION_NAMESPACE.c_str(), 00139 engagement::PERFORMING_SHAKE_TOPIC.c_str()); 00140 00141 // Make sure we have a valid message 00142 if (msg) 00143 { 00144 // Grab the message type from the constant pointer 00145 engagement_msgs::Performance temp_msg = *msg; 00146 00147 // Cast ourselves into a State 00148 State *state = (State*)this; 00149 00150 // Grab the actor from the state 00151 Actor *actor = state->getActor(); 00152 00153 // Make sure the actors are the same and that the 00154 // begin flag is BEGIN (begin look) 00155 if (actor != NULL && temp_msg.actor.id == actor->getID() && 00156 temp_msg.begin.value == bml_msgs::Flag::BEGIN) 00157 { 00158 this->debug(7, "Received begin %s %s message.", 00159 engagement::VISION_NAMESPACE.c_str(), 00160 engagement::PERFORMING_SHAKE_TOPIC.c_str()); 00161 00162 // Create the success event 00163 return EventFactory::success(); 00164 } 00165 } 00166 00167 return Event(); 00168 } 00169 00170 Event BCRobotFloorState::visionNodCallback(const engagement_msgs::Performance *msg) 00171 { 00172 this->debug(25, "Entered %s %s", 00173 engagement::VISION_NAMESPACE.c_str(), 00174 engagement::PERFORMING_NOD_TOPIC.c_str()); 00175 00176 // Make sure we have a valid message 00177 if (msg) 00178 { 00179 // Grab the message type from the constant pointer 00180 engagement_msgs::Performance temp_msg = *msg; 00181 00182 // Cast ourselves into a State 00183 State *state = (State*)this; 00184 00185 // Grab the actor from the state 00186 Actor *actor = state->getActor(); 00187 00188 // Make sure the actors are the same and that the begin flag is BEGIN (begin look) 00189 if (actor != NULL && temp_msg.actor.id == actor->getID() && 00190 temp_msg.begin.value == bml_msgs::Flag::BEGIN) 00191 { 00192 this->debug(7, "Received begin %s %s message.", 00193 engagement::VISION_NAMESPACE.c_str(), 00194 engagement::PERFORMING_NOD_TOPIC.c_str()); 00195 00196 // Create the success event 00197 return EventFactory::success(); 00198 } 00199 } 00200 00201 return Event(); 00202 } 00203 00204 std::string BCRobotFloorState::type() 00205 { 00206 return "bc_robot_floor"; 00207 } |