Project: engagement_recognition License: BSD Dependencies: engagement_msgs engagement_srvs roscpp Used by: None All Packages

engagement_recognition/src/recognition/recognizers/adjacency_pair/adjacency_pair_recognizer.cpp Go to the documentation of this file. /* * Software License Agreement (BSD License) * * Copyright (c) 2010, Worcester Polytechnic Institute * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * * * Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * * Redistributions in binary form must reproduce the above * copyright notice, this list of conditions and the following * disclaimer in the documentation and/or other materials provided * with the distribution. * * Neither the name of Worcester Polytechnic Institute. nor the names * of its contributors may be used to endorse or promote products * derived from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ // @author Brett Ponsler (bponsler (at) wpi (dot) edu) #include "adjacency_pair_recognizer.h" #include "../../events/event_factory.h" #include "../../lib/engagement_macros.h" AdjacencyPairRecognizer::AdjacencyPairRecognizer() : Recognizer(AdjacencyPairRecognizer::type(), NULL) { // Set the logger based on this type of recognizer this->setLogger(EngagementParams::getAPTag()); // Load the max delay parameter this->getMaxDelayParam(EngagementParams::getConfAdjacencyPairHandle(), 2.0); // Create the start state, and set the state to it this->setStartState(); // Grab the recognition/human NodeHandle ros::NodeHandle *recog_human = EngagementParams::getRecogHumanHandle(); // Advertise the human initiated topic hi_adjacency_pair_pub_ = recog_human->advertise<engagement_msgs::HumanAdjacencyPair>( engagement::RECOG_ADJACENCY_PAIR_TOPIC, MAX_BUFFER); this->warn("Initialized recognizer to an empty actor."); } AdjacencyPairRecognizer::AdjacencyPairRecognizer(std::string actor, EventSink *sink) : Recognizer(AdjacencyPairRecognizer::type(), sink) { // Set the logger based on this type of recognizer this->setLogger(sink->getLogger(), EngagementParams::getAPTag()); // Load the max delay parameter this->getMaxDelayParam(EngagementParams::getConfAdjacencyPairHandle(), 2.0); // Set the actor for this recognizer // Do this BEFORE setting the state setActor(actor); // Grab the recognition/human NodeHandle ros::NodeHandle *recog_human = EngagementParams::getRecogHumanHandle(); // Advertise the human initiated topic hi_adjacency_pair_pub_ = recog_human->advertise<engagement_msgs::HumanAdjacencyPair>( engagement::RECOG_ADJACENCY_PAIR_TOPIC, MAX_BUFFER); // Create the start state and set the state to it this->setStartState(); } void AdjacencyPairRecognizer::initialize(initiator::Initiator initiator) { Recognizer *rec = (Recognizer*)this; // If the human was the initiator, send a human initiated message if (initiator == initiator::HUMAN) { // Grab the internal node handle ros::NodeHandle *n = EngagementParams::getConfAdjacencyPairHandle(); // Grab the max delay from the parameter server double max_delay = this->getMaxDelayParam(n, 2.0); // Only send human initiated events if the recognizer is not degraded if (!EngagementParams::isDegraded()) { // Create the human initiated adjacency pair message engagement_msgs::HumanAdjacencyPair ap_msg; // Set the actor, the timeout duration, and the // human's utterance for this message ap_msg.actor.id = this->getActor()->getID(); ap_msg.timeout = max_delay; // Store the initial action and data ap_msg.action.value = this->initial_action_.value; ap_msg.action.data = this->initial_action_.data; this->debug(5, "Publishing human initiated event."); // Publish the message this->hi_adjacency_pair_pub_.publish(ap_msg); // Reset the initial action now that we've used it this->initial_action_ = engagement_msgs::APAction(); } } // Initialize this recognizer with the initiator rec->initialize(initiator); } void AdjacencyPairRecognizer::transition(Event event) { // Grab the name from the event std::string event_name = event.getName(); std::vector<std::string> additional = event.getAdditional(); // Keep track of what action was used to succeed the event Action action; std::string data; // Grab the action and data (should be two elements) if (additional.size() >= 1) { // Grab the action action = action.fromString(additional.at(0)); // Grab the data, if it exists if (additional.size() == 2) data = additional.at(1); } // Check the event cases if (EventFactory::isRobotInitiated(event)) { this->debug(8, "ROBOT INITIATED EVENT!"); // Unblock the semaphore using cycle status enter the robot floor state this->unblock(ServiceResponse::cycle(), Action::noAction()); this->setState(factory::AP_ROBOT_WAITING); // Initialize the connection event this->initialize(initiator::ROBOT); } else if (EventFactory::isHumanInitiated(event)) { this->debug(8, "HUMAN INITIATED EVENT"); // Reset the timer and enter the human floor state this->unblock(ServiceResponse::cycle(), Action::noAction()); this->setState(factory::AP_HUMAN_WAITING); // Store the additional data as the initial action Action act = Action::fromString(additional.at(0)); if (additional.size() == 2) { this->initial_action_.value = act.toValue(); this->initial_action_.data = additional.at(1); } else this->initial_action_ = engagement_msgs::APAction(); // Initialize the connection event this->initialize(initiator::HUMAN); } else if (EventFactory::isSuccess(event)) { this->debug(8, "SUCCESS EVENT"); // If we're in Robot Waiting go to Human Response, // if we're in Human Waiting go to Robot Response if (this->getStateName() == StateFactory::getType(factory::AP_ROBOT_WAITING)) this->setState(factory::AP_HUMAN_RESPONSE); else if (this->getStateName() == StateFactory::getType(factory::AP_HUMAN_WAITING)) this->setState(factory::AP_ROBOT_RESPONSE); // The connection event succeeds, and set the end delay this->succeed(action); this->end_delay_ = CURRENT_TIME; } else if (EventFactory::isCompleted(event)) { this->debug(8, "COMPLETED EVENT"); // Succeed if we're in the robot waiting state if (this->getStateName() == StateFactory::getType(factory::AP_ROBOT_WAITING) || this->getStateName() == StateFactory::getType(factory::AP_HUMAN_WAITING)) { this->succeed(action); } // Set the state to the start state this->setStartState(); // Complete the connection event successfully this->complete(true); } else if (EventFactory::isFailed(event)) { this->debug(8, "FAILED EVENT"); // Set the state to the start state this->setStartState(); // Complete the connection event unsuccessfully this->complete(false); } } std::string AdjacencyPairRecognizer::type() { return engagement::ADJACENCY_PAIR_TYPE; }

---

engagement_recognition
Author(s): Brett Ponsler (bponsler (at) wpi (dot) edu)
autogenerated on Fri Sep 9 10:35:48 2011