Go to the documentation of this file.00001
00002 #ifndef TREE_KINEMATICS_SERVICE_GET_TREE_POSITION_IK_H
00003 #define TREE_KINEMATICS_SERVICE_GET_TREE_POSITION_IK_H
00004 #include <string>
00005 #include <vector>
00006 #include <map>
00007 #include <ostream>
00008 #include "ros/serialization.h"
00009 #include "ros/builtin_message_traits.h"
00010 #include "ros/message_operations.h"
00011 #include "ros/time.h"
00012
00013 #include "ros/macros.h"
00014
00015 #include "ros/assert.h"
00016
00017 #include "ros/service_traits.h"
00018
00019 #include "kinematics_msgs/PositionIKRequest.h"
00020
00021
00022 #include "arm_navigation_msgs/RobotState.h"
00023 #include "arm_navigation_msgs/ArmNavigationErrorCodes.h"
00024
00025 namespace tree_kinematics
00026 {
00027 template <class ContainerAllocator>
00028 struct get_tree_position_ikRequest_ {
00029 typedef get_tree_position_ikRequest_<ContainerAllocator> Type;
00030
00031 get_tree_position_ikRequest_()
00032 : pos_ik_request()
00033 {
00034 }
00035
00036 get_tree_position_ikRequest_(const ContainerAllocator& _alloc)
00037 : pos_ik_request(_alloc)
00038 {
00039 }
00040
00041 typedef std::vector< ::kinematics_msgs::PositionIKRequest_<ContainerAllocator> , typename ContainerAllocator::template rebind< ::kinematics_msgs::PositionIKRequest_<ContainerAllocator> >::other > _pos_ik_request_type;
00042 std::vector< ::kinematics_msgs::PositionIKRequest_<ContainerAllocator> , typename ContainerAllocator::template rebind< ::kinematics_msgs::PositionIKRequest_<ContainerAllocator> >::other > pos_ik_request;
00043
00044
00045 typedef boost::shared_ptr< ::tree_kinematics::get_tree_position_ikRequest_<ContainerAllocator> > Ptr;
00046 typedef boost::shared_ptr< ::tree_kinematics::get_tree_position_ikRequest_<ContainerAllocator> const> ConstPtr;
00047 boost::shared_ptr<std::map<std::string, std::string> > __connection_header;
00048 };
00049 typedef ::tree_kinematics::get_tree_position_ikRequest_<std::allocator<void> > get_tree_position_ikRequest;
00050
00051 typedef boost::shared_ptr< ::tree_kinematics::get_tree_position_ikRequest> get_tree_position_ikRequestPtr;
00052 typedef boost::shared_ptr< ::tree_kinematics::get_tree_position_ikRequest const> get_tree_position_ikRequestConstPtr;
00053
00054
00055 template <class ContainerAllocator>
00056 struct get_tree_position_ikResponse_ {
00057 typedef get_tree_position_ikResponse_<ContainerAllocator> Type;
00058
00059 get_tree_position_ikResponse_()
00060 : solution()
00061 , error_code()
00062 {
00063 }
00064
00065 get_tree_position_ikResponse_(const ContainerAllocator& _alloc)
00066 : solution(_alloc)
00067 , error_code(_alloc)
00068 {
00069 }
00070
00071 typedef ::arm_navigation_msgs::RobotState_<ContainerAllocator> _solution_type;
00072 ::arm_navigation_msgs::RobotState_<ContainerAllocator> solution;
00073
00074 typedef ::arm_navigation_msgs::ArmNavigationErrorCodes_<ContainerAllocator> _error_code_type;
00075 ::arm_navigation_msgs::ArmNavigationErrorCodes_<ContainerAllocator> error_code;
00076
00077
00078 typedef boost::shared_ptr< ::tree_kinematics::get_tree_position_ikResponse_<ContainerAllocator> > Ptr;
00079 typedef boost::shared_ptr< ::tree_kinematics::get_tree_position_ikResponse_<ContainerAllocator> const> ConstPtr;
00080 boost::shared_ptr<std::map<std::string, std::string> > __connection_header;
00081 };
00082 typedef ::tree_kinematics::get_tree_position_ikResponse_<std::allocator<void> > get_tree_position_ikResponse;
00083
00084 typedef boost::shared_ptr< ::tree_kinematics::get_tree_position_ikResponse> get_tree_position_ikResponsePtr;
00085 typedef boost::shared_ptr< ::tree_kinematics::get_tree_position_ikResponse const> get_tree_position_ikResponseConstPtr;
00086
00087 struct get_tree_position_ik
00088 {
00089
00090 typedef get_tree_position_ikRequest Request;
00091 typedef get_tree_position_ikResponse Response;
00092 Request request;
00093 Response response;
00094
00095 typedef Request RequestType;
00096 typedef Response ResponseType;
00097 };
00098 }
00099
00100 namespace ros
00101 {
00102 namespace message_traits
00103 {
00104 template<class ContainerAllocator> struct IsMessage< ::tree_kinematics::get_tree_position_ikRequest_<ContainerAllocator> > : public TrueType {};
00105 template<class ContainerAllocator> struct IsMessage< ::tree_kinematics::get_tree_position_ikRequest_<ContainerAllocator> const> : public TrueType {};
00106 template<class ContainerAllocator>
00107 struct MD5Sum< ::tree_kinematics::get_tree_position_ikRequest_<ContainerAllocator> > {
00108 static const char* value()
00109 {
00110 return "ebff3a9548f87f46312b51a1358841ab";
00111 }
00112
00113 static const char* value(const ::tree_kinematics::get_tree_position_ikRequest_<ContainerAllocator> &) { return value(); }
00114 static const uint64_t static_value1 = 0xebff3a9548f87f46ULL;
00115 static const uint64_t static_value2 = 0x312b51a1358841abULL;
00116 };
00117
00118 template<class ContainerAllocator>
00119 struct DataType< ::tree_kinematics::get_tree_position_ikRequest_<ContainerAllocator> > {
00120 static const char* value()
00121 {
00122 return "tree_kinematics/get_tree_position_ikRequest";
00123 }
00124
00125 static const char* value(const ::tree_kinematics::get_tree_position_ikRequest_<ContainerAllocator> &) { return value(); }
00126 };
00127
00128 template<class ContainerAllocator>
00129 struct Definition< ::tree_kinematics::get_tree_position_ikRequest_<ContainerAllocator> > {
00130 static const char* value()
00131 {
00132 return "\n\
00133 \n\
00134 \n\
00135 \n\
00136 kinematics_msgs/PositionIKRequest[] pos_ik_request\n\
00137 \n\
00138 \n\
00139 ================================================================================\n\
00140 MSG: kinematics_msgs/PositionIKRequest\n\
00141 # A Position IK request message\n\
00142 # The name of the link for which we are computing IK\n\
00143 string ik_link_name\n\
00144 \n\
00145 # The (stamped) pose of the link\n\
00146 geometry_msgs/PoseStamped pose_stamped\n\
00147 \n\
00148 # A RobotState consisting of hint/seed positions for the IK computation. \n\
00149 # These may be used to seed the IK search. \n\
00150 # The seed state MUST contain state for all joints to be used by the IK solver\n\
00151 # to compute IK. The list of joints that the IK solver deals with can be found using\n\
00152 # the kinematics_msgs/GetKinematicSolverInfo\n\
00153 arm_navigation_msgs/RobotState ik_seed_state\n\
00154 \n\
00155 # Additional state information can be provided here to specify the starting positions \n\
00156 # of other joints/links on the robot.\n\
00157 arm_navigation_msgs/RobotState robot_state\n\
00158 \n\
00159 ================================================================================\n\
00160 MSG: geometry_msgs/PoseStamped\n\
00161 # A Pose with reference coordinate frame and timestamp\n\
00162 Header header\n\
00163 Pose pose\n\
00164 \n\
00165 ================================================================================\n\
00166 MSG: std_msgs/Header\n\
00167 # Standard metadata for higher-level stamped data types.\n\
00168 # This is generally used to communicate timestamped data \n\
00169 # in a particular coordinate frame.\n\
00170 # \n\
00171 # sequence ID: consecutively increasing ID \n\
00172 uint32 seq\n\
00173 #Two-integer timestamp that is expressed as:\n\
00174 # * stamp.secs: seconds (stamp_secs) since epoch\n\
00175 # * stamp.nsecs: nanoseconds since stamp_secs\n\
00176 # time-handling sugar is provided by the client library\n\
00177 time stamp\n\
00178 #Frame this data is associated with\n\
00179 # 0: no frame\n\
00180 # 1: global frame\n\
00181 string frame_id\n\
00182 \n\
00183 ================================================================================\n\
00184 MSG: geometry_msgs/Pose\n\
00185 # A representation of pose in free space, composed of postion and orientation. \n\
00186 Point position\n\
00187 Quaternion orientation\n\
00188 \n\
00189 ================================================================================\n\
00190 MSG: geometry_msgs/Point\n\
00191 # This contains the position of a point in free space\n\
00192 float64 x\n\
00193 float64 y\n\
00194 float64 z\n\
00195 \n\
00196 ================================================================================\n\
00197 MSG: geometry_msgs/Quaternion\n\
00198 # This represents an orientation in free space in quaternion form.\n\
00199 \n\
00200 float64 x\n\
00201 float64 y\n\
00202 float64 z\n\
00203 float64 w\n\
00204 \n\
00205 ================================================================================\n\
00206 MSG: arm_navigation_msgs/RobotState\n\
00207 # This message contains information about the robot state, i.e. the positions of its joints and links\n\
00208 sensor_msgs/JointState joint_state\n\
00209 arm_navigation_msgs/MultiDOFJointState multi_dof_joint_state\n\
00210 \n\
00211 ================================================================================\n\
00212 MSG: sensor_msgs/JointState\n\
00213 # This is a message that holds data to describe the state of a set of torque controlled joints. \n\
00214 #\n\
00215 # The state of each joint (revolute or prismatic) is defined by:\n\
00216 # * the position of the joint (rad or m),\n\
00217 # * the velocity of the joint (rad/s or m/s) and \n\
00218 # * the effort that is applied in the joint (Nm or N).\n\
00219 #\n\
00220 # Each joint is uniquely identified by its name\n\
00221 # The header specifies the time at which the joint states were recorded. All the joint states\n\
00222 # in one message have to be recorded at the same time.\n\
00223 #\n\
00224 # This message consists of a multiple arrays, one for each part of the joint state. \n\
00225 # The goal is to make each of the fields optional. When e.g. your joints have no\n\
00226 # effort associated with them, you can leave the effort array empty. \n\
00227 #\n\
00228 # All arrays in this message should have the same size, or be empty.\n\
00229 # This is the only way to uniquely associate the joint name with the correct\n\
00230 # states.\n\
00231 \n\
00232 \n\
00233 Header header\n\
00234 \n\
00235 string[] name\n\
00236 float64[] position\n\
00237 float64[] velocity\n\
00238 float64[] effort\n\
00239 \n\
00240 ================================================================================\n\
00241 MSG: arm_navigation_msgs/MultiDOFJointState\n\
00242 #A representation of a multi-dof joint state\n\
00243 time stamp\n\
00244 string[] joint_names\n\
00245 string[] frame_ids\n\
00246 string[] child_frame_ids\n\
00247 geometry_msgs/Pose[] poses\n\
00248 \n\
00249 ";
00250 }
00251
00252 static const char* value(const ::tree_kinematics::get_tree_position_ikRequest_<ContainerAllocator> &) { return value(); }
00253 };
00254
00255 }
00256 }
00257
00258
00259 namespace ros
00260 {
00261 namespace message_traits
00262 {
00263 template<class ContainerAllocator> struct IsMessage< ::tree_kinematics::get_tree_position_ikResponse_<ContainerAllocator> > : public TrueType {};
00264 template<class ContainerAllocator> struct IsMessage< ::tree_kinematics::get_tree_position_ikResponse_<ContainerAllocator> const> : public TrueType {};
00265 template<class ContainerAllocator>
00266 struct MD5Sum< ::tree_kinematics::get_tree_position_ikResponse_<ContainerAllocator> > {
00267 static const char* value()
00268 {
00269 return "5a8bbc4eb2775fe00cbd09858fd3dc65";
00270 }
00271
00272 static const char* value(const ::tree_kinematics::get_tree_position_ikResponse_<ContainerAllocator> &) { return value(); }
00273 static const uint64_t static_value1 = 0x5a8bbc4eb2775fe0ULL;
00274 static const uint64_t static_value2 = 0x0cbd09858fd3dc65ULL;
00275 };
00276
00277 template<class ContainerAllocator>
00278 struct DataType< ::tree_kinematics::get_tree_position_ikResponse_<ContainerAllocator> > {
00279 static const char* value()
00280 {
00281 return "tree_kinematics/get_tree_position_ikResponse";
00282 }
00283
00284 static const char* value(const ::tree_kinematics::get_tree_position_ikResponse_<ContainerAllocator> &) { return value(); }
00285 };
00286
00287 template<class ContainerAllocator>
00288 struct Definition< ::tree_kinematics::get_tree_position_ikResponse_<ContainerAllocator> > {
00289 static const char* value()
00290 {
00291 return "\n\
00292 \n\
00293 \n\
00294 arm_navigation_msgs/RobotState solution\n\
00295 \n\
00296 arm_navigation_msgs/ArmNavigationErrorCodes error_code\n\
00297 \n\
00298 \n\
00299 ================================================================================\n\
00300 MSG: arm_navigation_msgs/RobotState\n\
00301 # This message contains information about the robot state, i.e. the positions of its joints and links\n\
00302 sensor_msgs/JointState joint_state\n\
00303 arm_navigation_msgs/MultiDOFJointState multi_dof_joint_state\n\
00304 \n\
00305 ================================================================================\n\
00306 MSG: sensor_msgs/JointState\n\
00307 # This is a message that holds data to describe the state of a set of torque controlled joints. \n\
00308 #\n\
00309 # The state of each joint (revolute or prismatic) is defined by:\n\
00310 # * the position of the joint (rad or m),\n\
00311 # * the velocity of the joint (rad/s or m/s) and \n\
00312 # * the effort that is applied in the joint (Nm or N).\n\
00313 #\n\
00314 # Each joint is uniquely identified by its name\n\
00315 # The header specifies the time at which the joint states were recorded. All the joint states\n\
00316 # in one message have to be recorded at the same time.\n\
00317 #\n\
00318 # This message consists of a multiple arrays, one for each part of the joint state. \n\
00319 # The goal is to make each of the fields optional. When e.g. your joints have no\n\
00320 # effort associated with them, you can leave the effort array empty. \n\
00321 #\n\
00322 # All arrays in this message should have the same size, or be empty.\n\
00323 # This is the only way to uniquely associate the joint name with the correct\n\
00324 # states.\n\
00325 \n\
00326 \n\
00327 Header header\n\
00328 \n\
00329 string[] name\n\
00330 float64[] position\n\
00331 float64[] velocity\n\
00332 float64[] effort\n\
00333 \n\
00334 ================================================================================\n\
00335 MSG: std_msgs/Header\n\
00336 # Standard metadata for higher-level stamped data types.\n\
00337 # This is generally used to communicate timestamped data \n\
00338 # in a particular coordinate frame.\n\
00339 # \n\
00340 # sequence ID: consecutively increasing ID \n\
00341 uint32 seq\n\
00342 #Two-integer timestamp that is expressed as:\n\
00343 # * stamp.secs: seconds (stamp_secs) since epoch\n\
00344 # * stamp.nsecs: nanoseconds since stamp_secs\n\
00345 # time-handling sugar is provided by the client library\n\
00346 time stamp\n\
00347 #Frame this data is associated with\n\
00348 # 0: no frame\n\
00349 # 1: global frame\n\
00350 string frame_id\n\
00351 \n\
00352 ================================================================================\n\
00353 MSG: arm_navigation_msgs/MultiDOFJointState\n\
00354 #A representation of a multi-dof joint state\n\
00355 time stamp\n\
00356 string[] joint_names\n\
00357 string[] frame_ids\n\
00358 string[] child_frame_ids\n\
00359 geometry_msgs/Pose[] poses\n\
00360 \n\
00361 ================================================================================\n\
00362 MSG: geometry_msgs/Pose\n\
00363 # A representation of pose in free space, composed of postion and orientation. \n\
00364 Point position\n\
00365 Quaternion orientation\n\
00366 \n\
00367 ================================================================================\n\
00368 MSG: geometry_msgs/Point\n\
00369 # This contains the position of a point in free space\n\
00370 float64 x\n\
00371 float64 y\n\
00372 float64 z\n\
00373 \n\
00374 ================================================================================\n\
00375 MSG: geometry_msgs/Quaternion\n\
00376 # This represents an orientation in free space in quaternion form.\n\
00377 \n\
00378 float64 x\n\
00379 float64 y\n\
00380 float64 z\n\
00381 float64 w\n\
00382 \n\
00383 ================================================================================\n\
00384 MSG: arm_navigation_msgs/ArmNavigationErrorCodes\n\
00385 int32 val\n\
00386 \n\
00387 # overall behavior\n\
00388 int32 PLANNING_FAILED=-1\n\
00389 int32 SUCCESS=1\n\
00390 int32 TIMED_OUT=-2\n\
00391 \n\
00392 # start state errors\n\
00393 int32 START_STATE_IN_COLLISION=-3\n\
00394 int32 START_STATE_VIOLATES_PATH_CONSTRAINTS=-4\n\
00395 \n\
00396 # goal errors\n\
00397 int32 GOAL_IN_COLLISION=-5\n\
00398 int32 GOAL_VIOLATES_PATH_CONSTRAINTS=-6\n\
00399 \n\
00400 # robot state\n\
00401 int32 INVALID_ROBOT_STATE=-7\n\
00402 int32 INCOMPLETE_ROBOT_STATE=-8\n\
00403 \n\
00404 # planning request errors\n\
00405 int32 INVALID_PLANNER_ID=-9\n\
00406 int32 INVALID_NUM_PLANNING_ATTEMPTS=-10\n\
00407 int32 INVALID_ALLOWED_PLANNING_TIME=-11\n\
00408 int32 INVALID_GROUP_NAME=-12\n\
00409 int32 INVALID_GOAL_JOINT_CONSTRAINTS=-13\n\
00410 int32 INVALID_GOAL_POSITION_CONSTRAINTS=-14\n\
00411 int32 INVALID_GOAL_ORIENTATION_CONSTRAINTS=-15\n\
00412 int32 INVALID_PATH_JOINT_CONSTRAINTS=-16\n\
00413 int32 INVALID_PATH_POSITION_CONSTRAINTS=-17\n\
00414 int32 INVALID_PATH_ORIENTATION_CONSTRAINTS=-18\n\
00415 \n\
00416 # state/trajectory monitor errors\n\
00417 int32 INVALID_TRAJECTORY=-19\n\
00418 int32 INVALID_INDEX=-20\n\
00419 int32 JOINT_LIMITS_VIOLATED=-21\n\
00420 int32 PATH_CONSTRAINTS_VIOLATED=-22\n\
00421 int32 COLLISION_CONSTRAINTS_VIOLATED=-23\n\
00422 int32 GOAL_CONSTRAINTS_VIOLATED=-24\n\
00423 int32 JOINTS_NOT_MOVING=-25\n\
00424 int32 TRAJECTORY_CONTROLLER_FAILED=-26\n\
00425 \n\
00426 # system errors\n\
00427 int32 FRAME_TRANSFORM_FAILURE=-27\n\
00428 int32 COLLISION_CHECKING_UNAVAILABLE=-28\n\
00429 int32 ROBOT_STATE_STALE=-29\n\
00430 int32 SENSOR_INFO_STALE=-30\n\
00431 \n\
00432 # kinematics errors\n\
00433 int32 NO_IK_SOLUTION=-31\n\
00434 int32 INVALID_LINK_NAME=-32\n\
00435 int32 IK_LINK_IN_COLLISION=-33\n\
00436 int32 NO_FK_SOLUTION=-34\n\
00437 int32 KINEMATICS_STATE_IN_COLLISION=-35\n\
00438 \n\
00439 # general errors\n\
00440 int32 INVALID_TIMEOUT=-36\n\
00441 \n\
00442 \n\
00443 ";
00444 }
00445
00446 static const char* value(const ::tree_kinematics::get_tree_position_ikResponse_<ContainerAllocator> &) { return value(); }
00447 };
00448
00449 }
00450 }
00451
00452 namespace ros
00453 {
00454 namespace serialization
00455 {
00456
00457 template<class ContainerAllocator> struct Serializer< ::tree_kinematics::get_tree_position_ikRequest_<ContainerAllocator> >
00458 {
00459 template<typename Stream, typename T> inline static void allInOne(Stream& stream, T m)
00460 {
00461 stream.next(m.pos_ik_request);
00462 }
00463
00464 ROS_DECLARE_ALLINONE_SERIALIZER;
00465 };
00466 }
00467 }
00468
00469
00470 namespace ros
00471 {
00472 namespace serialization
00473 {
00474
00475 template<class ContainerAllocator> struct Serializer< ::tree_kinematics::get_tree_position_ikResponse_<ContainerAllocator> >
00476 {
00477 template<typename Stream, typename T> inline static void allInOne(Stream& stream, T m)
00478 {
00479 stream.next(m.solution);
00480 stream.next(m.error_code);
00481 }
00482
00483 ROS_DECLARE_ALLINONE_SERIALIZER;
00484 };
00485 }
00486 }
00487
00488 namespace ros
00489 {
00490 namespace service_traits
00491 {
00492 template<>
00493 struct MD5Sum<tree_kinematics::get_tree_position_ik> {
00494 static const char* value()
00495 {
00496 return "2f9c4754bd93d04c0256c3f144caddff";
00497 }
00498
00499 static const char* value(const tree_kinematics::get_tree_position_ik&) { return value(); }
00500 };
00501
00502 template<>
00503 struct DataType<tree_kinematics::get_tree_position_ik> {
00504 static const char* value()
00505 {
00506 return "tree_kinematics/get_tree_position_ik";
00507 }
00508
00509 static const char* value(const tree_kinematics::get_tree_position_ik&) { return value(); }
00510 };
00511
00512 template<class ContainerAllocator>
00513 struct MD5Sum<tree_kinematics::get_tree_position_ikRequest_<ContainerAllocator> > {
00514 static const char* value()
00515 {
00516 return "2f9c4754bd93d04c0256c3f144caddff";
00517 }
00518
00519 static const char* value(const tree_kinematics::get_tree_position_ikRequest_<ContainerAllocator> &) { return value(); }
00520 };
00521
00522 template<class ContainerAllocator>
00523 struct DataType<tree_kinematics::get_tree_position_ikRequest_<ContainerAllocator> > {
00524 static const char* value()
00525 {
00526 return "tree_kinematics/get_tree_position_ik";
00527 }
00528
00529 static const char* value(const tree_kinematics::get_tree_position_ikRequest_<ContainerAllocator> &) { return value(); }
00530 };
00531
00532 template<class ContainerAllocator>
00533 struct MD5Sum<tree_kinematics::get_tree_position_ikResponse_<ContainerAllocator> > {
00534 static const char* value()
00535 {
00536 return "2f9c4754bd93d04c0256c3f144caddff";
00537 }
00538
00539 static const char* value(const tree_kinematics::get_tree_position_ikResponse_<ContainerAllocator> &) { return value(); }
00540 };
00541
00542 template<class ContainerAllocator>
00543 struct DataType<tree_kinematics::get_tree_position_ikResponse_<ContainerAllocator> > {
00544 static const char* value()
00545 {
00546 return "tree_kinematics/get_tree_position_ik";
00547 }
00548
00549 static const char* value(const tree_kinematics::get_tree_position_ikResponse_<ContainerAllocator> &) { return value(); }
00550 };
00551
00552 }
00553 }
00554
00555 #endif // TREE_KINEMATICS_SERVICE_GET_TREE_POSITION_IK_H
00556