00001
00002 #ifndef OBJECT_MANIPULATION_MSGS_MESSAGE_PLACEGOAL_H
00003 #define OBJECT_MANIPULATION_MSGS_MESSAGE_PLACEGOAL_H
00004 #include <string>
00005 #include <vector>
00006 #include <ostream>
00007 #include "ros/serialization.h"
00008 #include "ros/builtin_message_traits.h"
00009 #include "ros/message_operations.h"
00010 #include "ros/message.h"
00011 #include "ros/time.h"
00012
00013 #include "geometry_msgs/PoseStamped.h"
00014 #include "object_manipulation_msgs/Grasp.h"
00015 #include "object_manipulation_msgs/GripperTranslation.h"
00016 #include "motion_planning_msgs/Constraints.h"
00017 #include "motion_planning_msgs/OrderedCollisionOperations.h"
00018 #include "motion_planning_msgs/LinkPadding.h"
00019
00020 namespace object_manipulation_msgs
00021 {
00022 template <class ContainerAllocator>
00023 struct PlaceGoal_ : public ros::Message
00024 {
00025 typedef PlaceGoal_<ContainerAllocator> Type;
00026
00027 PlaceGoal_()
00028 : arm_name()
00029 , place_locations()
00030 , grasp()
00031 , desired_retreat_distance(0.0)
00032 , min_retreat_distance(0.0)
00033 , approach()
00034 , collision_object_name()
00035 , collision_support_surface_name()
00036 , allow_gripper_support_collision(false)
00037 , use_reactive_place(false)
00038 , place_padding(0.0)
00039 , path_constraints()
00040 , additional_collision_operations()
00041 , additional_link_padding()
00042 {
00043 }
00044
00045 PlaceGoal_(const ContainerAllocator& _alloc)
00046 : arm_name(_alloc)
00047 , place_locations(_alloc)
00048 , grasp(_alloc)
00049 , desired_retreat_distance(0.0)
00050 , min_retreat_distance(0.0)
00051 , approach(_alloc)
00052 , collision_object_name(_alloc)
00053 , collision_support_surface_name(_alloc)
00054 , allow_gripper_support_collision(false)
00055 , use_reactive_place(false)
00056 , place_padding(0.0)
00057 , path_constraints(_alloc)
00058 , additional_collision_operations(_alloc)
00059 , additional_link_padding(_alloc)
00060 {
00061 }
00062
00063 typedef std::basic_string<char, std::char_traits<char>, typename ContainerAllocator::template rebind<char>::other > _arm_name_type;
00064 std::basic_string<char, std::char_traits<char>, typename ContainerAllocator::template rebind<char>::other > arm_name;
00065
00066 typedef std::vector< ::geometry_msgs::PoseStamped_<ContainerAllocator> , typename ContainerAllocator::template rebind< ::geometry_msgs::PoseStamped_<ContainerAllocator> >::other > _place_locations_type;
00067 std::vector< ::geometry_msgs::PoseStamped_<ContainerAllocator> , typename ContainerAllocator::template rebind< ::geometry_msgs::PoseStamped_<ContainerAllocator> >::other > place_locations;
00068
00069 typedef ::object_manipulation_msgs::Grasp_<ContainerAllocator> _grasp_type;
00070 ::object_manipulation_msgs::Grasp_<ContainerAllocator> grasp;
00071
00072 typedef float _desired_retreat_distance_type;
00073 float desired_retreat_distance;
00074
00075 typedef float _min_retreat_distance_type;
00076 float min_retreat_distance;
00077
00078 typedef ::object_manipulation_msgs::GripperTranslation_<ContainerAllocator> _approach_type;
00079 ::object_manipulation_msgs::GripperTranslation_<ContainerAllocator> approach;
00080
00081 typedef std::basic_string<char, std::char_traits<char>, typename ContainerAllocator::template rebind<char>::other > _collision_object_name_type;
00082 std::basic_string<char, std::char_traits<char>, typename ContainerAllocator::template rebind<char>::other > collision_object_name;
00083
00084 typedef std::basic_string<char, std::char_traits<char>, typename ContainerAllocator::template rebind<char>::other > _collision_support_surface_name_type;
00085 std::basic_string<char, std::char_traits<char>, typename ContainerAllocator::template rebind<char>::other > collision_support_surface_name;
00086
00087 typedef uint8_t _allow_gripper_support_collision_type;
00088 uint8_t allow_gripper_support_collision;
00089
00090 typedef uint8_t _use_reactive_place_type;
00091 uint8_t use_reactive_place;
00092
00093 typedef double _place_padding_type;
00094 double place_padding;
00095
00096 typedef ::motion_planning_msgs::Constraints_<ContainerAllocator> _path_constraints_type;
00097 ::motion_planning_msgs::Constraints_<ContainerAllocator> path_constraints;
00098
00099 typedef ::motion_planning_msgs::OrderedCollisionOperations_<ContainerAllocator> _additional_collision_operations_type;
00100 ::motion_planning_msgs::OrderedCollisionOperations_<ContainerAllocator> additional_collision_operations;
00101
00102 typedef std::vector< ::motion_planning_msgs::LinkPadding_<ContainerAllocator> , typename ContainerAllocator::template rebind< ::motion_planning_msgs::LinkPadding_<ContainerAllocator> >::other > _additional_link_padding_type;
00103 std::vector< ::motion_planning_msgs::LinkPadding_<ContainerAllocator> , typename ContainerAllocator::template rebind< ::motion_planning_msgs::LinkPadding_<ContainerAllocator> >::other > additional_link_padding;
00104
00105
00106 ROS_DEPRECATED uint32_t get_place_locations_size() const { return (uint32_t)place_locations.size(); }
00107 ROS_DEPRECATED void set_place_locations_size(uint32_t size) { place_locations.resize((size_t)size); }
00108 ROS_DEPRECATED void get_place_locations_vec(std::vector< ::geometry_msgs::PoseStamped_<ContainerAllocator> , typename ContainerAllocator::template rebind< ::geometry_msgs::PoseStamped_<ContainerAllocator> >::other > & vec) const { vec = this->place_locations; }
00109 ROS_DEPRECATED void set_place_locations_vec(const std::vector< ::geometry_msgs::PoseStamped_<ContainerAllocator> , typename ContainerAllocator::template rebind< ::geometry_msgs::PoseStamped_<ContainerAllocator> >::other > & vec) { this->place_locations = vec; }
00110 ROS_DEPRECATED uint32_t get_additional_link_padding_size() const { return (uint32_t)additional_link_padding.size(); }
00111 ROS_DEPRECATED void set_additional_link_padding_size(uint32_t size) { additional_link_padding.resize((size_t)size); }
00112 ROS_DEPRECATED void get_additional_link_padding_vec(std::vector< ::motion_planning_msgs::LinkPadding_<ContainerAllocator> , typename ContainerAllocator::template rebind< ::motion_planning_msgs::LinkPadding_<ContainerAllocator> >::other > & vec) const { vec = this->additional_link_padding; }
00113 ROS_DEPRECATED void set_additional_link_padding_vec(const std::vector< ::motion_planning_msgs::LinkPadding_<ContainerAllocator> , typename ContainerAllocator::template rebind< ::motion_planning_msgs::LinkPadding_<ContainerAllocator> >::other > & vec) { this->additional_link_padding = vec; }
00114 private:
00115 static const char* __s_getDataType_() { return "object_manipulation_msgs/PlaceGoal"; }
00116 public:
00117 ROS_DEPRECATED static const std::string __s_getDataType() { return __s_getDataType_(); }
00118
00119 ROS_DEPRECATED const std::string __getDataType() const { return __s_getDataType_(); }
00120
00121 private:
00122 static const char* __s_getMD5Sum_() { return "82feafa522a7074652d42edb22b56d8e"; }
00123 public:
00124 ROS_DEPRECATED static const std::string __s_getMD5Sum() { return __s_getMD5Sum_(); }
00125
00126 ROS_DEPRECATED const std::string __getMD5Sum() const { return __s_getMD5Sum_(); }
00127
00128 private:
00129 static const char* __s_getMessageDefinition_() { return "\n\
00130 # An action for placing an object\n\
00131 \n\
00132 # which arm to be used for grasping\n\
00133 string arm_name\n\
00134 \n\
00135 # a list of possible desired poses of the object once it's been placed\n\
00136 geometry_msgs/PoseStamped[] place_locations\n\
00137 \n\
00138 # the grasp that has been executed on this object\n\
00139 Grasp grasp\n\
00140 \n\
00141 # how far the retreat should ideally be away from the place location\n\
00142 float32 desired_retreat_distance\n\
00143 \n\
00144 # the min distance between the retreat and the place location that must actually be feasible \n\
00145 # for the place not to be rejected\n\
00146 float32 min_retreat_distance\n\
00147 \n\
00148 # how the place location should be approached\n\
00149 # the frame_id that this lift is specified in MUST be either the robot_frame \n\
00150 # or the gripper_frame specified in your hand description file\n\
00151 GripperTranslation approach\n\
00152 \n\
00153 # the name that the target object has in the collision map\n\
00154 # can be left empty if no name is available\n\
00155 string collision_object_name\n\
00156 \n\
00157 # the name that the support surface (e.g. table) has in the collision map\n\
00158 # can be left empty if no name is available\n\
00159 string collision_support_surface_name\n\
00160 \n\
00161 # whether collisions between the gripper and the support surface should be acceptable\n\
00162 # during move from pre-place to place and during retreat. Collisions when moving to the\n\
00163 # pre-place location are still not allowed even if this is set to true.\n\
00164 bool allow_gripper_support_collision\n\
00165 \n\
00166 # whether reactive placing based on tactile sensors should be used\n\
00167 bool use_reactive_place\n\
00168 \n\
00169 # how much the object should be padded by when deciding if the grasp\n\
00170 # location is freasible or not\n\
00171 float64 place_padding\n\
00172 \n\
00173 # OPTIONAL (These will not have to be filled out most of the time)\n\
00174 # constraints to be imposed on every point in the motion of the arm\n\
00175 motion_planning_msgs/Constraints path_constraints\n\
00176 \n\
00177 # OPTIONAL (These will not have to be filled out most of the time)\n\
00178 # additional collision operations to be used for every arm movement performed\n\
00179 # during placing. Note that these will be added on top of (and thus overide) other \n\
00180 # collision operations that the grasping pipeline deems necessary. Should be used\n\
00181 # with care and only if special behaviors are desired.\n\
00182 motion_planning_msgs/OrderedCollisionOperations additional_collision_operations\n\
00183 \n\
00184 # OPTIONAL (These will not have to be filled out most of the time)\n\
00185 # additional link paddings to be used for every arm movement performed\n\
00186 # during placing. Note that these will be added on top of (and thus overide) other \n\
00187 # link paddings that the grasping pipeline deems necessary. Should be used\n\
00188 # with care and only if special behaviors are desired.\n\
00189 motion_planning_msgs/LinkPadding[] additional_link_padding\n\
00190 \n\
00191 ================================================================================\n\
00192 MSG: geometry_msgs/PoseStamped\n\
00193 # A Pose with reference coordinate frame and timestamp\n\
00194 Header header\n\
00195 Pose pose\n\
00196 \n\
00197 ================================================================================\n\
00198 MSG: std_msgs/Header\n\
00199 # Standard metadata for higher-level stamped data types.\n\
00200 # This is generally used to communicate timestamped data \n\
00201 # in a particular coordinate frame.\n\
00202 # \n\
00203 # sequence ID: consecutively increasing ID \n\
00204 uint32 seq\n\
00205 #Two-integer timestamp that is expressed as:\n\
00206 # * stamp.secs: seconds (stamp_secs) since epoch\n\
00207 # * stamp.nsecs: nanoseconds since stamp_secs\n\
00208 # time-handling sugar is provided by the client library\n\
00209 time stamp\n\
00210 #Frame this data is associated with\n\
00211 # 0: no frame\n\
00212 # 1: global frame\n\
00213 string frame_id\n\
00214 \n\
00215 ================================================================================\n\
00216 MSG: geometry_msgs/Pose\n\
00217 # A representation of pose in free space, composed of postion and orientation. \n\
00218 Point position\n\
00219 Quaternion orientation\n\
00220 \n\
00221 ================================================================================\n\
00222 MSG: geometry_msgs/Point\n\
00223 # This contains the position of a point in free space\n\
00224 float64 x\n\
00225 float64 y\n\
00226 float64 z\n\
00227 \n\
00228 ================================================================================\n\
00229 MSG: geometry_msgs/Quaternion\n\
00230 # This represents an orientation in free space in quaternion form.\n\
00231 \n\
00232 float64 x\n\
00233 float64 y\n\
00234 float64 z\n\
00235 float64 w\n\
00236 \n\
00237 ================================================================================\n\
00238 MSG: object_manipulation_msgs/Grasp\n\
00239 \n\
00240 # The internal posture of the hand for the pre-grasp\n\
00241 # only positions are used\n\
00242 sensor_msgs/JointState pre_grasp_posture\n\
00243 \n\
00244 # The internal posture of the hand for the grasp\n\
00245 # positions and efforts are used\n\
00246 sensor_msgs/JointState grasp_posture\n\
00247 \n\
00248 # The position of the end-effector for the grasp relative to the object\n\
00249 geometry_msgs/Pose grasp_pose\n\
00250 \n\
00251 # The estimated probability of success for this grasp\n\
00252 float64 success_probability\n\
00253 \n\
00254 # Debug flag to indicate that this grasp would be the best in its cluster\n\
00255 bool cluster_rep\n\
00256 ================================================================================\n\
00257 MSG: sensor_msgs/JointState\n\
00258 # This is a message that holds data to describe the state of a set of torque controlled joints. \n\
00259 #\n\
00260 # The state of each joint (revolute or prismatic) is defined by:\n\
00261 # * the position of the joint (rad or m),\n\
00262 # * the velocity of the joint (rad/s or m/s) and \n\
00263 # * the effort that is applied in the joint (Nm or N).\n\
00264 #\n\
00265 # Each joint is uniquely identified by its name\n\
00266 # The header specifies the time at which the joint states were recorded. All the joint states\n\
00267 # in one message have to be recorded at the same time.\n\
00268 #\n\
00269 # This message consists of a multiple arrays, one for each part of the joint state. \n\
00270 # The goal is to make each of the fields optional. When e.g. your joints have no\n\
00271 # effort associated with them, you can leave the effort array empty. \n\
00272 #\n\
00273 # All arrays in this message should have the same size, or be empty.\n\
00274 # This is the only way to uniquely associate the joint name with the correct\n\
00275 # states.\n\
00276 \n\
00277 \n\
00278 Header header\n\
00279 \n\
00280 string[] name\n\
00281 float64[] position\n\
00282 float64[] velocity\n\
00283 float64[] effort\n\
00284 \n\
00285 ================================================================================\n\
00286 MSG: object_manipulation_msgs/GripperTranslation\n\
00287 # defines a translation for the gripper, used in pickup or place tasks\n\
00288 # for example for lifting an object off a table or approaching the table for placing\n\
00289 \n\
00290 # the direction of the translation\n\
00291 geometry_msgs/Vector3Stamped direction\n\
00292 \n\
00293 # the desired translation distance\n\
00294 float32 desired_distance\n\
00295 \n\
00296 # the min distance that must be considered feasible before the\n\
00297 # grasp is even attempted\n\
00298 float32 min_distance\n\
00299 ================================================================================\n\
00300 MSG: geometry_msgs/Vector3Stamped\n\
00301 # This represents a Vector3 with reference coordinate frame and timestamp\n\
00302 Header header\n\
00303 Vector3 vector\n\
00304 \n\
00305 ================================================================================\n\
00306 MSG: geometry_msgs/Vector3\n\
00307 # This represents a vector in free space. \n\
00308 \n\
00309 float64 x\n\
00310 float64 y\n\
00311 float64 z\n\
00312 ================================================================================\n\
00313 MSG: motion_planning_msgs/Constraints\n\
00314 # This message contains a list of motion planning constraints.\n\
00315 \n\
00316 motion_planning_msgs/JointConstraint[] joint_constraints\n\
00317 motion_planning_msgs/PositionConstraint[] position_constraints\n\
00318 motion_planning_msgs/OrientationConstraint[] orientation_constraints\n\
00319 motion_planning_msgs/VisibilityConstraint[] visibility_constraints\n\
00320 \n\
00321 ================================================================================\n\
00322 MSG: motion_planning_msgs/JointConstraint\n\
00323 # Constrain the position of a joint to be within a certain bound\n\
00324 string joint_name\n\
00325 \n\
00326 # the bound to be achieved is [position - tolerance_below, position + tolerance_above]\n\
00327 float64 position\n\
00328 float64 tolerance_above\n\
00329 float64 tolerance_below\n\
00330 \n\
00331 # A weighting factor for this constraint\n\
00332 float64 weight\n\
00333 ================================================================================\n\
00334 MSG: motion_planning_msgs/PositionConstraint\n\
00335 # This message contains the definition of a position constraint.\n\
00336 Header header\n\
00337 \n\
00338 # The robot link this constraint refers to\n\
00339 string link_name\n\
00340 \n\
00341 # The offset (in the link frame) for the target point on the link we are planning for\n\
00342 geometry_msgs/Point target_point_offset\n\
00343 \n\
00344 # The nominal/target position for the point we are planning for\n\
00345 geometry_msgs/Point position\n\
00346 \n\
00347 # The shape of the bounded region that constrains the position of the end-effector\n\
00348 # This region is always centered at the position defined above\n\
00349 geometric_shapes_msgs/Shape constraint_region_shape\n\
00350 \n\
00351 # The orientation of the bounded region that constrains the position of the end-effector. \n\
00352 # This allows the specification of non-axis aligned constraints\n\
00353 geometry_msgs/Quaternion constraint_region_orientation\n\
00354 \n\
00355 # Constraint weighting factor - a weight for this constraint\n\
00356 float64 weight\n\
00357 ================================================================================\n\
00358 MSG: geometric_shapes_msgs/Shape\n\
00359 byte SPHERE=0\n\
00360 byte BOX=1\n\
00361 byte CYLINDER=2\n\
00362 byte MESH=3\n\
00363 \n\
00364 byte type\n\
00365 \n\
00366 \n\
00367 #### define sphere, box, cylinder ####\n\
00368 # the origin of each shape is considered at the shape's center\n\
00369 \n\
00370 # for sphere\n\
00371 # radius := dimensions[0]\n\
00372 \n\
00373 # for cylinder\n\
00374 # radius := dimensions[0]\n\
00375 # length := dimensions[1]\n\
00376 # the length is along the Z axis\n\
00377 \n\
00378 # for box\n\
00379 # size_x := dimensions[0]\n\
00380 # size_y := dimensions[1]\n\
00381 # size_z := dimensions[2]\n\
00382 float64[] dimensions\n\
00383 \n\
00384 \n\
00385 #### define mesh ####\n\
00386 \n\
00387 # list of triangles; triangle k is defined by tre vertices located\n\
00388 # at indices triangles[3k], triangles[3k+1], triangles[3k+2]\n\
00389 int32[] triangles\n\
00390 geometry_msgs/Point[] vertices\n\
00391 \n\
00392 ================================================================================\n\
00393 MSG: motion_planning_msgs/OrientationConstraint\n\
00394 # This message contains the definition of an orientation constraint.\n\
00395 Header header\n\
00396 \n\
00397 # The robot link this constraint refers to\n\
00398 string link_name\n\
00399 \n\
00400 # The type of the constraint\n\
00401 int32 type\n\
00402 int32 LINK_FRAME=0\n\
00403 int32 HEADER_FRAME=1\n\
00404 \n\
00405 # The desired orientation of the robot link specified as a quaternion\n\
00406 geometry_msgs/Quaternion orientation\n\
00407 \n\
00408 # optional RPY error tolerances specified if \n\
00409 float64 absolute_roll_tolerance\n\
00410 float64 absolute_pitch_tolerance\n\
00411 float64 absolute_yaw_tolerance\n\
00412 \n\
00413 # Constraint weighting factor - a weight for this constraint\n\
00414 float64 weight\n\
00415 \n\
00416 ================================================================================\n\
00417 MSG: motion_planning_msgs/VisibilityConstraint\n\
00418 # This message contains the definition of a visibility constraint.\n\
00419 Header header\n\
00420 \n\
00421 # The point stamped target that needs to be kept within view of the sensor\n\
00422 geometry_msgs/PointStamped target\n\
00423 \n\
00424 # The local pose of the frame in which visibility is to be maintained\n\
00425 # The frame id should represent the robot link to which the sensor is attached\n\
00426 # The visual axis of the sensor is assumed to be along the X axis of this frame\n\
00427 geometry_msgs/PoseStamped sensor_pose\n\
00428 \n\
00429 # The deviation (in radians) that will be tolerated\n\
00430 # Constraint error will be measured as the solid angle between the \n\
00431 # X axis of the frame defined above and the vector between the origin \n\
00432 # of the frame defined above and the target location\n\
00433 float64 absolute_tolerance\n\
00434 \n\
00435 \n\
00436 ================================================================================\n\
00437 MSG: geometry_msgs/PointStamped\n\
00438 # This represents a Point with reference coordinate frame and timestamp\n\
00439 Header header\n\
00440 Point point\n\
00441 \n\
00442 ================================================================================\n\
00443 MSG: motion_planning_msgs/OrderedCollisionOperations\n\
00444 # A set of collision operations that will be performed in the order they are specified\n\
00445 CollisionOperation[] collision_operations\n\
00446 ================================================================================\n\
00447 MSG: motion_planning_msgs/CollisionOperation\n\
00448 # A definition of a collision operation\n\
00449 # E.g. (\"gripper\",COLLISION_SET_ALL,ENABLE) will enable collisions \n\
00450 # between the gripper and all objects in the collision space\n\
00451 \n\
00452 string object1\n\
00453 string object2\n\
00454 string COLLISION_SET_ALL=\"all\"\n\
00455 string COLLISION_SET_OBJECTS=\"objects\"\n\
00456 string COLLISION_SET_ATTACHED_OBJECTS=\"attached\"\n\
00457 \n\
00458 # The penetration distance to which collisions are allowed. This is 0.0 by default.\n\
00459 float64 penetration_distance\n\
00460 \n\
00461 # Flag that determines whether collisions will be enabled or disabled for the pair of objects specified above\n\
00462 int32 operation\n\
00463 int32 DISABLE=0\n\
00464 int32 ENABLE=1\n\
00465 \n\
00466 ================================================================================\n\
00467 MSG: motion_planning_msgs/LinkPadding\n\
00468 #name for the link\n\
00469 string link_name\n\
00470 \n\
00471 # padding to apply to the link\n\
00472 float64 padding\n\
00473 \n\
00474 "; }
00475 public:
00476 ROS_DEPRECATED static const std::string __s_getMessageDefinition() { return __s_getMessageDefinition_(); }
00477
00478 ROS_DEPRECATED const std::string __getMessageDefinition() const { return __s_getMessageDefinition_(); }
00479
00480 ROS_DEPRECATED virtual uint8_t *serialize(uint8_t *write_ptr, uint32_t seq) const
00481 {
00482 ros::serialization::OStream stream(write_ptr, 1000000000);
00483 ros::serialization::serialize(stream, arm_name);
00484 ros::serialization::serialize(stream, place_locations);
00485 ros::serialization::serialize(stream, grasp);
00486 ros::serialization::serialize(stream, desired_retreat_distance);
00487 ros::serialization::serialize(stream, min_retreat_distance);
00488 ros::serialization::serialize(stream, approach);
00489 ros::serialization::serialize(stream, collision_object_name);
00490 ros::serialization::serialize(stream, collision_support_surface_name);
00491 ros::serialization::serialize(stream, allow_gripper_support_collision);
00492 ros::serialization::serialize(stream, use_reactive_place);
00493 ros::serialization::serialize(stream, place_padding);
00494 ros::serialization::serialize(stream, path_constraints);
00495 ros::serialization::serialize(stream, additional_collision_operations);
00496 ros::serialization::serialize(stream, additional_link_padding);
00497 return stream.getData();
00498 }
00499
00500 ROS_DEPRECATED virtual uint8_t *deserialize(uint8_t *read_ptr)
00501 {
00502 ros::serialization::IStream stream(read_ptr, 1000000000);
00503 ros::serialization::deserialize(stream, arm_name);
00504 ros::serialization::deserialize(stream, place_locations);
00505 ros::serialization::deserialize(stream, grasp);
00506 ros::serialization::deserialize(stream, desired_retreat_distance);
00507 ros::serialization::deserialize(stream, min_retreat_distance);
00508 ros::serialization::deserialize(stream, approach);
00509 ros::serialization::deserialize(stream, collision_object_name);
00510 ros::serialization::deserialize(stream, collision_support_surface_name);
00511 ros::serialization::deserialize(stream, allow_gripper_support_collision);
00512 ros::serialization::deserialize(stream, use_reactive_place);
00513 ros::serialization::deserialize(stream, place_padding);
00514 ros::serialization::deserialize(stream, path_constraints);
00515 ros::serialization::deserialize(stream, additional_collision_operations);
00516 ros::serialization::deserialize(stream, additional_link_padding);
00517 return stream.getData();
00518 }
00519
00520 ROS_DEPRECATED virtual uint32_t serializationLength() const
00521 {
00522 uint32_t size = 0;
00523 size += ros::serialization::serializationLength(arm_name);
00524 size += ros::serialization::serializationLength(place_locations);
00525 size += ros::serialization::serializationLength(grasp);
00526 size += ros::serialization::serializationLength(desired_retreat_distance);
00527 size += ros::serialization::serializationLength(min_retreat_distance);
00528 size += ros::serialization::serializationLength(approach);
00529 size += ros::serialization::serializationLength(collision_object_name);
00530 size += ros::serialization::serializationLength(collision_support_surface_name);
00531 size += ros::serialization::serializationLength(allow_gripper_support_collision);
00532 size += ros::serialization::serializationLength(use_reactive_place);
00533 size += ros::serialization::serializationLength(place_padding);
00534 size += ros::serialization::serializationLength(path_constraints);
00535 size += ros::serialization::serializationLength(additional_collision_operations);
00536 size += ros::serialization::serializationLength(additional_link_padding);
00537 return size;
00538 }
00539
00540 typedef boost::shared_ptr< ::object_manipulation_msgs::PlaceGoal_<ContainerAllocator> > Ptr;
00541 typedef boost::shared_ptr< ::object_manipulation_msgs::PlaceGoal_<ContainerAllocator> const> ConstPtr;
00542 };
00543 typedef ::object_manipulation_msgs::PlaceGoal_<std::allocator<void> > PlaceGoal;
00544
00545 typedef boost::shared_ptr< ::object_manipulation_msgs::PlaceGoal> PlaceGoalPtr;
00546 typedef boost::shared_ptr< ::object_manipulation_msgs::PlaceGoal const> PlaceGoalConstPtr;
00547
00548
00549 template<typename ContainerAllocator>
00550 std::ostream& operator<<(std::ostream& s, const ::object_manipulation_msgs::PlaceGoal_<ContainerAllocator> & v)
00551 {
00552 ros::message_operations::Printer< ::object_manipulation_msgs::PlaceGoal_<ContainerAllocator> >::stream(s, "", v);
00553 return s;}
00554
00555 }
00556
00557 namespace ros
00558 {
00559 namespace message_traits
00560 {
00561 template<class ContainerAllocator>
00562 struct MD5Sum< ::object_manipulation_msgs::PlaceGoal_<ContainerAllocator> > {
00563 static const char* value()
00564 {
00565 return "82feafa522a7074652d42edb22b56d8e";
00566 }
00567
00568 static const char* value(const ::object_manipulation_msgs::PlaceGoal_<ContainerAllocator> &) { return value(); }
00569 static const uint64_t static_value1 = 0x82feafa522a70746ULL;
00570 static const uint64_t static_value2 = 0x52d42edb22b56d8eULL;
00571 };
00572
00573 template<class ContainerAllocator>
00574 struct DataType< ::object_manipulation_msgs::PlaceGoal_<ContainerAllocator> > {
00575 static const char* value()
00576 {
00577 return "object_manipulation_msgs/PlaceGoal";
00578 }
00579
00580 static const char* value(const ::object_manipulation_msgs::PlaceGoal_<ContainerAllocator> &) { return value(); }
00581 };
00582
00583 template<class ContainerAllocator>
00584 struct Definition< ::object_manipulation_msgs::PlaceGoal_<ContainerAllocator> > {
00585 static const char* value()
00586 {
00587 return "\n\
00588 # An action for placing an object\n\
00589 \n\
00590 # which arm to be used for grasping\n\
00591 string arm_name\n\
00592 \n\
00593 # a list of possible desired poses of the object once it's been placed\n\
00594 geometry_msgs/PoseStamped[] place_locations\n\
00595 \n\
00596 # the grasp that has been executed on this object\n\
00597 Grasp grasp\n\
00598 \n\
00599 # how far the retreat should ideally be away from the place location\n\
00600 float32 desired_retreat_distance\n\
00601 \n\
00602 # the min distance between the retreat and the place location that must actually be feasible \n\
00603 # for the place not to be rejected\n\
00604 float32 min_retreat_distance\n\
00605 \n\
00606 # how the place location should be approached\n\
00607 # the frame_id that this lift is specified in MUST be either the robot_frame \n\
00608 # or the gripper_frame specified in your hand description file\n\
00609 GripperTranslation approach\n\
00610 \n\
00611 # the name that the target object has in the collision map\n\
00612 # can be left empty if no name is available\n\
00613 string collision_object_name\n\
00614 \n\
00615 # the name that the support surface (e.g. table) has in the collision map\n\
00616 # can be left empty if no name is available\n\
00617 string collision_support_surface_name\n\
00618 \n\
00619 # whether collisions between the gripper and the support surface should be acceptable\n\
00620 # during move from pre-place to place and during retreat. Collisions when moving to the\n\
00621 # pre-place location are still not allowed even if this is set to true.\n\
00622 bool allow_gripper_support_collision\n\
00623 \n\
00624 # whether reactive placing based on tactile sensors should be used\n\
00625 bool use_reactive_place\n\
00626 \n\
00627 # how much the object should be padded by when deciding if the grasp\n\
00628 # location is freasible or not\n\
00629 float64 place_padding\n\
00630 \n\
00631 # OPTIONAL (These will not have to be filled out most of the time)\n\
00632 # constraints to be imposed on every point in the motion of the arm\n\
00633 motion_planning_msgs/Constraints path_constraints\n\
00634 \n\
00635 # OPTIONAL (These will not have to be filled out most of the time)\n\
00636 # additional collision operations to be used for every arm movement performed\n\
00637 # during placing. Note that these will be added on top of (and thus overide) other \n\
00638 # collision operations that the grasping pipeline deems necessary. Should be used\n\
00639 # with care and only if special behaviors are desired.\n\
00640 motion_planning_msgs/OrderedCollisionOperations additional_collision_operations\n\
00641 \n\
00642 # OPTIONAL (These will not have to be filled out most of the time)\n\
00643 # additional link paddings to be used for every arm movement performed\n\
00644 # during placing. Note that these will be added on top of (and thus overide) other \n\
00645 # link paddings that the grasping pipeline deems necessary. Should be used\n\
00646 # with care and only if special behaviors are desired.\n\
00647 motion_planning_msgs/LinkPadding[] additional_link_padding\n\
00648 \n\
00649 ================================================================================\n\
00650 MSG: geometry_msgs/PoseStamped\n\
00651 # A Pose with reference coordinate frame and timestamp\n\
00652 Header header\n\
00653 Pose pose\n\
00654 \n\
00655 ================================================================================\n\
00656 MSG: std_msgs/Header\n\
00657 # Standard metadata for higher-level stamped data types.\n\
00658 # This is generally used to communicate timestamped data \n\
00659 # in a particular coordinate frame.\n\
00660 # \n\
00661 # sequence ID: consecutively increasing ID \n\
00662 uint32 seq\n\
00663 #Two-integer timestamp that is expressed as:\n\
00664 # * stamp.secs: seconds (stamp_secs) since epoch\n\
00665 # * stamp.nsecs: nanoseconds since stamp_secs\n\
00666 # time-handling sugar is provided by the client library\n\
00667 time stamp\n\
00668 #Frame this data is associated with\n\
00669 # 0: no frame\n\
00670 # 1: global frame\n\
00671 string frame_id\n\
00672 \n\
00673 ================================================================================\n\
00674 MSG: geometry_msgs/Pose\n\
00675 # A representation of pose in free space, composed of postion and orientation. \n\
00676 Point position\n\
00677 Quaternion orientation\n\
00678 \n\
00679 ================================================================================\n\
00680 MSG: geometry_msgs/Point\n\
00681 # This contains the position of a point in free space\n\
00682 float64 x\n\
00683 float64 y\n\
00684 float64 z\n\
00685 \n\
00686 ================================================================================\n\
00687 MSG: geometry_msgs/Quaternion\n\
00688 # This represents an orientation in free space in quaternion form.\n\
00689 \n\
00690 float64 x\n\
00691 float64 y\n\
00692 float64 z\n\
00693 float64 w\n\
00694 \n\
00695 ================================================================================\n\
00696 MSG: object_manipulation_msgs/Grasp\n\
00697 \n\
00698 # The internal posture of the hand for the pre-grasp\n\
00699 # only positions are used\n\
00700 sensor_msgs/JointState pre_grasp_posture\n\
00701 \n\
00702 # The internal posture of the hand for the grasp\n\
00703 # positions and efforts are used\n\
00704 sensor_msgs/JointState grasp_posture\n\
00705 \n\
00706 # The position of the end-effector for the grasp relative to the object\n\
00707 geometry_msgs/Pose grasp_pose\n\
00708 \n\
00709 # The estimated probability of success for this grasp\n\
00710 float64 success_probability\n\
00711 \n\
00712 # Debug flag to indicate that this grasp would be the best in its cluster\n\
00713 bool cluster_rep\n\
00714 ================================================================================\n\
00715 MSG: sensor_msgs/JointState\n\
00716 # This is a message that holds data to describe the state of a set of torque controlled joints. \n\
00717 #\n\
00718 # The state of each joint (revolute or prismatic) is defined by:\n\
00719 # * the position of the joint (rad or m),\n\
00720 # * the velocity of the joint (rad/s or m/s) and \n\
00721 # * the effort that is applied in the joint (Nm or N).\n\
00722 #\n\
00723 # Each joint is uniquely identified by its name\n\
00724 # The header specifies the time at which the joint states were recorded. All the joint states\n\
00725 # in one message have to be recorded at the same time.\n\
00726 #\n\
00727 # This message consists of a multiple arrays, one for each part of the joint state. \n\
00728 # The goal is to make each of the fields optional. When e.g. your joints have no\n\
00729 # effort associated with them, you can leave the effort array empty. \n\
00730 #\n\
00731 # All arrays in this message should have the same size, or be empty.\n\
00732 # This is the only way to uniquely associate the joint name with the correct\n\
00733 # states.\n\
00734 \n\
00735 \n\
00736 Header header\n\
00737 \n\
00738 string[] name\n\
00739 float64[] position\n\
00740 float64[] velocity\n\
00741 float64[] effort\n\
00742 \n\
00743 ================================================================================\n\
00744 MSG: object_manipulation_msgs/GripperTranslation\n\
00745 # defines a translation for the gripper, used in pickup or place tasks\n\
00746 # for example for lifting an object off a table or approaching the table for placing\n\
00747 \n\
00748 # the direction of the translation\n\
00749 geometry_msgs/Vector3Stamped direction\n\
00750 \n\
00751 # the desired translation distance\n\
00752 float32 desired_distance\n\
00753 \n\
00754 # the min distance that must be considered feasible before the\n\
00755 # grasp is even attempted\n\
00756 float32 min_distance\n\
00757 ================================================================================\n\
00758 MSG: geometry_msgs/Vector3Stamped\n\
00759 # This represents a Vector3 with reference coordinate frame and timestamp\n\
00760 Header header\n\
00761 Vector3 vector\n\
00762 \n\
00763 ================================================================================\n\
00764 MSG: geometry_msgs/Vector3\n\
00765 # This represents a vector in free space. \n\
00766 \n\
00767 float64 x\n\
00768 float64 y\n\
00769 float64 z\n\
00770 ================================================================================\n\
00771 MSG: motion_planning_msgs/Constraints\n\
00772 # This message contains a list of motion planning constraints.\n\
00773 \n\
00774 motion_planning_msgs/JointConstraint[] joint_constraints\n\
00775 motion_planning_msgs/PositionConstraint[] position_constraints\n\
00776 motion_planning_msgs/OrientationConstraint[] orientation_constraints\n\
00777 motion_planning_msgs/VisibilityConstraint[] visibility_constraints\n\
00778 \n\
00779 ================================================================================\n\
00780 MSG: motion_planning_msgs/JointConstraint\n\
00781 # Constrain the position of a joint to be within a certain bound\n\
00782 string joint_name\n\
00783 \n\
00784 # the bound to be achieved is [position - tolerance_below, position + tolerance_above]\n\
00785 float64 position\n\
00786 float64 tolerance_above\n\
00787 float64 tolerance_below\n\
00788 \n\
00789 # A weighting factor for this constraint\n\
00790 float64 weight\n\
00791 ================================================================================\n\
00792 MSG: motion_planning_msgs/PositionConstraint\n\
00793 # This message contains the definition of a position constraint.\n\
00794 Header header\n\
00795 \n\
00796 # The robot link this constraint refers to\n\
00797 string link_name\n\
00798 \n\
00799 # The offset (in the link frame) for the target point on the link we are planning for\n\
00800 geometry_msgs/Point target_point_offset\n\
00801 \n\
00802 # The nominal/target position for the point we are planning for\n\
00803 geometry_msgs/Point position\n\
00804 \n\
00805 # The shape of the bounded region that constrains the position of the end-effector\n\
00806 # This region is always centered at the position defined above\n\
00807 geometric_shapes_msgs/Shape constraint_region_shape\n\
00808 \n\
00809 # The orientation of the bounded region that constrains the position of the end-effector. \n\
00810 # This allows the specification of non-axis aligned constraints\n\
00811 geometry_msgs/Quaternion constraint_region_orientation\n\
00812 \n\
00813 # Constraint weighting factor - a weight for this constraint\n\
00814 float64 weight\n\
00815 ================================================================================\n\
00816 MSG: geometric_shapes_msgs/Shape\n\
00817 byte SPHERE=0\n\
00818 byte BOX=1\n\
00819 byte CYLINDER=2\n\
00820 byte MESH=3\n\
00821 \n\
00822 byte type\n\
00823 \n\
00824 \n\
00825 #### define sphere, box, cylinder ####\n\
00826 # the origin of each shape is considered at the shape's center\n\
00827 \n\
00828 # for sphere\n\
00829 # radius := dimensions[0]\n\
00830 \n\
00831 # for cylinder\n\
00832 # radius := dimensions[0]\n\
00833 # length := dimensions[1]\n\
00834 # the length is along the Z axis\n\
00835 \n\
00836 # for box\n\
00837 # size_x := dimensions[0]\n\
00838 # size_y := dimensions[1]\n\
00839 # size_z := dimensions[2]\n\
00840 float64[] dimensions\n\
00841 \n\
00842 \n\
00843 #### define mesh ####\n\
00844 \n\
00845 # list of triangles; triangle k is defined by tre vertices located\n\
00846 # at indices triangles[3k], triangles[3k+1], triangles[3k+2]\n\
00847 int32[] triangles\n\
00848 geometry_msgs/Point[] vertices\n\
00849 \n\
00850 ================================================================================\n\
00851 MSG: motion_planning_msgs/OrientationConstraint\n\
00852 # This message contains the definition of an orientation constraint.\n\
00853 Header header\n\
00854 \n\
00855 # The robot link this constraint refers to\n\
00856 string link_name\n\
00857 \n\
00858 # The type of the constraint\n\
00859 int32 type\n\
00860 int32 LINK_FRAME=0\n\
00861 int32 HEADER_FRAME=1\n\
00862 \n\
00863 # The desired orientation of the robot link specified as a quaternion\n\
00864 geometry_msgs/Quaternion orientation\n\
00865 \n\
00866 # optional RPY error tolerances specified if \n\
00867 float64 absolute_roll_tolerance\n\
00868 float64 absolute_pitch_tolerance\n\
00869 float64 absolute_yaw_tolerance\n\
00870 \n\
00871 # Constraint weighting factor - a weight for this constraint\n\
00872 float64 weight\n\
00873 \n\
00874 ================================================================================\n\
00875 MSG: motion_planning_msgs/VisibilityConstraint\n\
00876 # This message contains the definition of a visibility constraint.\n\
00877 Header header\n\
00878 \n\
00879 # The point stamped target that needs to be kept within view of the sensor\n\
00880 geometry_msgs/PointStamped target\n\
00881 \n\
00882 # The local pose of the frame in which visibility is to be maintained\n\
00883 # The frame id should represent the robot link to which the sensor is attached\n\
00884 # The visual axis of the sensor is assumed to be along the X axis of this frame\n\
00885 geometry_msgs/PoseStamped sensor_pose\n\
00886 \n\
00887 # The deviation (in radians) that will be tolerated\n\
00888 # Constraint error will be measured as the solid angle between the \n\
00889 # X axis of the frame defined above and the vector between the origin \n\
00890 # of the frame defined above and the target location\n\
00891 float64 absolute_tolerance\n\
00892 \n\
00893 \n\
00894 ================================================================================\n\
00895 MSG: geometry_msgs/PointStamped\n\
00896 # This represents a Point with reference coordinate frame and timestamp\n\
00897 Header header\n\
00898 Point point\n\
00899 \n\
00900 ================================================================================\n\
00901 MSG: motion_planning_msgs/OrderedCollisionOperations\n\
00902 # A set of collision operations that will be performed in the order they are specified\n\
00903 CollisionOperation[] collision_operations\n\
00904 ================================================================================\n\
00905 MSG: motion_planning_msgs/CollisionOperation\n\
00906 # A definition of a collision operation\n\
00907 # E.g. (\"gripper\",COLLISION_SET_ALL,ENABLE) will enable collisions \n\
00908 # between the gripper and all objects in the collision space\n\
00909 \n\
00910 string object1\n\
00911 string object2\n\
00912 string COLLISION_SET_ALL=\"all\"\n\
00913 string COLLISION_SET_OBJECTS=\"objects\"\n\
00914 string COLLISION_SET_ATTACHED_OBJECTS=\"attached\"\n\
00915 \n\
00916 # The penetration distance to which collisions are allowed. This is 0.0 by default.\n\
00917 float64 penetration_distance\n\
00918 \n\
00919 # Flag that determines whether collisions will be enabled or disabled for the pair of objects specified above\n\
00920 int32 operation\n\
00921 int32 DISABLE=0\n\
00922 int32 ENABLE=1\n\
00923 \n\
00924 ================================================================================\n\
00925 MSG: motion_planning_msgs/LinkPadding\n\
00926 #name for the link\n\
00927 string link_name\n\
00928 \n\
00929 # padding to apply to the link\n\
00930 float64 padding\n\
00931 \n\
00932 ";
00933 }
00934
00935 static const char* value(const ::object_manipulation_msgs::PlaceGoal_<ContainerAllocator> &) { return value(); }
00936 };
00937
00938 }
00939 }
00940
00941 namespace ros
00942 {
00943 namespace serialization
00944 {
00945
00946 template<class ContainerAllocator> struct Serializer< ::object_manipulation_msgs::PlaceGoal_<ContainerAllocator> >
00947 {
00948 template<typename Stream, typename T> inline static void allInOne(Stream& stream, T m)
00949 {
00950 stream.next(m.arm_name);
00951 stream.next(m.place_locations);
00952 stream.next(m.grasp);
00953 stream.next(m.desired_retreat_distance);
00954 stream.next(m.min_retreat_distance);
00955 stream.next(m.approach);
00956 stream.next(m.collision_object_name);
00957 stream.next(m.collision_support_surface_name);
00958 stream.next(m.allow_gripper_support_collision);
00959 stream.next(m.use_reactive_place);
00960 stream.next(m.place_padding);
00961 stream.next(m.path_constraints);
00962 stream.next(m.additional_collision_operations);
00963 stream.next(m.additional_link_padding);
00964 }
00965
00966 ROS_DECLARE_ALLINONE_SERIALIZER;
00967 };
00968 }
00969 }
00970
00971 namespace ros
00972 {
00973 namespace message_operations
00974 {
00975
00976 template<class ContainerAllocator>
00977 struct Printer< ::object_manipulation_msgs::PlaceGoal_<ContainerAllocator> >
00978 {
00979 template<typename Stream> static void stream(Stream& s, const std::string& indent, const ::object_manipulation_msgs::PlaceGoal_<ContainerAllocator> & v)
00980 {
00981 s << indent << "arm_name: ";
00982 Printer<std::basic_string<char, std::char_traits<char>, typename ContainerAllocator::template rebind<char>::other > >::stream(s, indent + " ", v.arm_name);
00983 s << indent << "place_locations[]" << std::endl;
00984 for (size_t i = 0; i < v.place_locations.size(); ++i)
00985 {
00986 s << indent << " place_locations[" << i << "]: ";
00987 s << std::endl;
00988 s << indent;
00989 Printer< ::geometry_msgs::PoseStamped_<ContainerAllocator> >::stream(s, indent + " ", v.place_locations[i]);
00990 }
00991 s << indent << "grasp: ";
00992 s << std::endl;
00993 Printer< ::object_manipulation_msgs::Grasp_<ContainerAllocator> >::stream(s, indent + " ", v.grasp);
00994 s << indent << "desired_retreat_distance: ";
00995 Printer<float>::stream(s, indent + " ", v.desired_retreat_distance);
00996 s << indent << "min_retreat_distance: ";
00997 Printer<float>::stream(s, indent + " ", v.min_retreat_distance);
00998 s << indent << "approach: ";
00999 s << std::endl;
01000 Printer< ::object_manipulation_msgs::GripperTranslation_<ContainerAllocator> >::stream(s, indent + " ", v.approach);
01001 s << indent << "collision_object_name: ";
01002 Printer<std::basic_string<char, std::char_traits<char>, typename ContainerAllocator::template rebind<char>::other > >::stream(s, indent + " ", v.collision_object_name);
01003 s << indent << "collision_support_surface_name: ";
01004 Printer<std::basic_string<char, std::char_traits<char>, typename ContainerAllocator::template rebind<char>::other > >::stream(s, indent + " ", v.collision_support_surface_name);
01005 s << indent << "allow_gripper_support_collision: ";
01006 Printer<uint8_t>::stream(s, indent + " ", v.allow_gripper_support_collision);
01007 s << indent << "use_reactive_place: ";
01008 Printer<uint8_t>::stream(s, indent + " ", v.use_reactive_place);
01009 s << indent << "place_padding: ";
01010 Printer<double>::stream(s, indent + " ", v.place_padding);
01011 s << indent << "path_constraints: ";
01012 s << std::endl;
01013 Printer< ::motion_planning_msgs::Constraints_<ContainerAllocator> >::stream(s, indent + " ", v.path_constraints);
01014 s << indent << "additional_collision_operations: ";
01015 s << std::endl;
01016 Printer< ::motion_planning_msgs::OrderedCollisionOperations_<ContainerAllocator> >::stream(s, indent + " ", v.additional_collision_operations);
01017 s << indent << "additional_link_padding[]" << std::endl;
01018 for (size_t i = 0; i < v.additional_link_padding.size(); ++i)
01019 {
01020 s << indent << " additional_link_padding[" << i << "]: ";
01021 s << std::endl;
01022 s << indent;
01023 Printer< ::motion_planning_msgs::LinkPadding_<ContainerAllocator> >::stream(s, indent + " ", v.additional_link_padding[i]);
01024 }
01025 }
01026 };
01027
01028
01029 }
01030 }
01031
01032 #endif // OBJECT_MANIPULATION_MSGS_MESSAGE_PLACEGOAL_H
01033