object_manipulator_node.cpp
Go to the documentation of this file.
00001 /*********************************************************************
00002 *
00003 *  Copyright (c) 2009, Willow Garage, Inc.
00004 *  All rights reserved.
00005 *
00006 *  Redistribution and use in source and binary forms, with or without
00007 *  modification, are permitted provided that the following conditions
00008 *  are met:
00009 *
00010 *   * Redistributions of source code must retain the above copyright
00011 *     notice, this list of conditions and the following disclaimer.
00012 *   * Redistributions in binary form must reproduce the above
00013 *     copyright notice, this list of conditions and the following
00014 *     disclaimer in the documentation and/or other materials provided
00015 *     with the distribution.
00016 *   * Neither the name of the Willow Garage nor the names of its
00017 *     contributors may be used to endorse or promote products derived
00018 *     from this software without specific prior written permission.
00019 *
00020 *  THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
00021 *  "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
00022 *  LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
00023 *  FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
00024 *  COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
00025 *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
00026 *  BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
00027 *  LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
00028 *  CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
00029 *  LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
00030 *  ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
00031 *  POSSIBILITY OF SUCH DAMAGE.
00032 *********************************************************************/
00033 
00034 // Author(s): Matei Ciocarlie
00035 
00036 #include "object_manipulator/object_manipulator.h"
00037 
00038 #include <ros/ros.h>
00039 
00040 #include <actionlib/server/simple_action_server.h>
00041 
00042 #include <object_manipulation_msgs/PickupAction.h>
00043 #include <object_manipulation_msgs/PlaceAction.h>
00044 
00045 namespace object_manipulator {
00046 
00047 static const std::string PICKUP_ACTION_NAME = "object_manipulator_pickup";
00048 static const std::string PLACE_ACTION_NAME = "object_manipulator_place";
00049 
00051 class ObjectManipulatorNode
00052 {
00053 private:
00055   ros::NodeHandle priv_nh_;  
00056 
00058   ObjectManipulator object_manipulator_;
00059 
00061   actionlib::SimpleActionServer<object_manipulation_msgs::PickupAction> pickup_action_server_;
00062 
00064   actionlib::SimpleActionServer<object_manipulation_msgs::PlaceAction> place_action_server_;
00065 
00067   void pickupCallback(const object_manipulation_msgs::PickupGoal::ConstPtr &goal)
00068   {
00069     object_manipulator_.pickup(goal, &pickup_action_server_);
00070   }
00071 
00073   void placeCallback(const object_manipulation_msgs::PlaceGoal::ConstPtr &goal)
00074   {
00075     object_manipulator_.place(goal, &place_action_server_);
00076   }
00077 
00078 public:
00079   ObjectManipulatorNode() : priv_nh_("~"),
00080                             pickup_action_server_( priv_nh_, PICKUP_ACTION_NAME, 
00081                                                    boost::bind(&ObjectManipulatorNode::pickupCallback, this, _1),
00082                                                    false),
00083                             place_action_server_( priv_nh_, PLACE_ACTION_NAME, 
00084                                                   boost::bind(&ObjectManipulatorNode::placeCallback, this, _1),
00085                                                   false)
00086   {
00087     pickup_action_server_.start();
00088     place_action_server_.start();
00089   }
00090 };
00091 
00092 } //namespace
00093 
00094 int main(int argc, char** argv)
00095 {
00096   ros::init(argc, argv, "object_manipulator");
00097   object_manipulator::ObjectManipulatorNode node;
00098   ros::spin();
00099   return 0;
00100 }


object_manipulator
Author(s): Matei Ciocarlie and Kaijen Hsiao
autogenerated on Thu Jan 2 2014 11:39:04