00001
00002 #ifndef ARM_NAVIGATION_MSGS_MESSAGE_MOTIONPLANREQUEST_H
00003 #define ARM_NAVIGATION_MSGS_MESSAGE_MOTIONPLANREQUEST_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 "arm_navigation_msgs/WorkspaceParameters.h"
00018 #include "arm_navigation_msgs/RobotState.h"
00019 #include "arm_navigation_msgs/Constraints.h"
00020 #include "arm_navigation_msgs/Constraints.h"
00021
00022 namespace arm_navigation_msgs
00023 {
00024 template <class ContainerAllocator>
00025 struct MotionPlanRequest_ {
00026 typedef MotionPlanRequest_<ContainerAllocator> Type;
00027
00028 MotionPlanRequest_()
00029 : workspace_parameters()
00030 , start_state()
00031 , goal_constraints()
00032 , path_constraints()
00033 , planner_id()
00034 , group_name()
00035 , num_planning_attempts(0)
00036 , allowed_planning_time()
00037 , expected_path_duration()
00038 , expected_path_dt()
00039 {
00040 }
00041
00042 MotionPlanRequest_(const ContainerAllocator& _alloc)
00043 : workspace_parameters(_alloc)
00044 , start_state(_alloc)
00045 , goal_constraints(_alloc)
00046 , path_constraints(_alloc)
00047 , planner_id(_alloc)
00048 , group_name(_alloc)
00049 , num_planning_attempts(0)
00050 , allowed_planning_time()
00051 , expected_path_duration()
00052 , expected_path_dt()
00053 {
00054 }
00055
00056 typedef ::arm_navigation_msgs::WorkspaceParameters_<ContainerAllocator> _workspace_parameters_type;
00057 ::arm_navigation_msgs::WorkspaceParameters_<ContainerAllocator> workspace_parameters;
00058
00059 typedef ::arm_navigation_msgs::RobotState_<ContainerAllocator> _start_state_type;
00060 ::arm_navigation_msgs::RobotState_<ContainerAllocator> start_state;
00061
00062 typedef ::arm_navigation_msgs::Constraints_<ContainerAllocator> _goal_constraints_type;
00063 ::arm_navigation_msgs::Constraints_<ContainerAllocator> goal_constraints;
00064
00065 typedef ::arm_navigation_msgs::Constraints_<ContainerAllocator> _path_constraints_type;
00066 ::arm_navigation_msgs::Constraints_<ContainerAllocator> path_constraints;
00067
00068 typedef std::basic_string<char, std::char_traits<char>, typename ContainerAllocator::template rebind<char>::other > _planner_id_type;
00069 std::basic_string<char, std::char_traits<char>, typename ContainerAllocator::template rebind<char>::other > planner_id;
00070
00071 typedef std::basic_string<char, std::char_traits<char>, typename ContainerAllocator::template rebind<char>::other > _group_name_type;
00072 std::basic_string<char, std::char_traits<char>, typename ContainerAllocator::template rebind<char>::other > group_name;
00073
00074 typedef int32_t _num_planning_attempts_type;
00075 int32_t num_planning_attempts;
00076
00077 typedef ros::Duration _allowed_planning_time_type;
00078 ros::Duration allowed_planning_time;
00079
00080 typedef ros::Duration _expected_path_duration_type;
00081 ros::Duration expected_path_duration;
00082
00083 typedef ros::Duration _expected_path_dt_type;
00084 ros::Duration expected_path_dt;
00085
00086
00087 typedef boost::shared_ptr< ::arm_navigation_msgs::MotionPlanRequest_<ContainerAllocator> > Ptr;
00088 typedef boost::shared_ptr< ::arm_navigation_msgs::MotionPlanRequest_<ContainerAllocator> const> ConstPtr;
00089 boost::shared_ptr<std::map<std::string, std::string> > __connection_header;
00090 };
00091 typedef ::arm_navigation_msgs::MotionPlanRequest_<std::allocator<void> > MotionPlanRequest;
00092
00093 typedef boost::shared_ptr< ::arm_navigation_msgs::MotionPlanRequest> MotionPlanRequestPtr;
00094 typedef boost::shared_ptr< ::arm_navigation_msgs::MotionPlanRequest const> MotionPlanRequestConstPtr;
00095
00096
00097 template<typename ContainerAllocator>
00098 std::ostream& operator<<(std::ostream& s, const ::arm_navigation_msgs::MotionPlanRequest_<ContainerAllocator> & v)
00099 {
00100 ros::message_operations::Printer< ::arm_navigation_msgs::MotionPlanRequest_<ContainerAllocator> >::stream(s, "", v);
00101 return s;}
00102
00103 }
00104
00105 namespace ros
00106 {
00107 namespace message_traits
00108 {
00109 template<class ContainerAllocator> struct IsMessage< ::arm_navigation_msgs::MotionPlanRequest_<ContainerAllocator> > : public TrueType {};
00110 template<class ContainerAllocator> struct IsMessage< ::arm_navigation_msgs::MotionPlanRequest_<ContainerAllocator> const> : public TrueType {};
00111 template<class ContainerAllocator>
00112 struct MD5Sum< ::arm_navigation_msgs::MotionPlanRequest_<ContainerAllocator> > {
00113 static const char* value()
00114 {
00115 return "75408e881303c6ad5069bd5df65ecb00";
00116 }
00117
00118 static const char* value(const ::arm_navigation_msgs::MotionPlanRequest_<ContainerAllocator> &) { return value(); }
00119 static const uint64_t static_value1 = 0x75408e881303c6adULL;
00120 static const uint64_t static_value2 = 0x5069bd5df65ecb00ULL;
00121 };
00122
00123 template<class ContainerAllocator>
00124 struct DataType< ::arm_navigation_msgs::MotionPlanRequest_<ContainerAllocator> > {
00125 static const char* value()
00126 {
00127 return "arm_navigation_msgs/MotionPlanRequest";
00128 }
00129
00130 static const char* value(const ::arm_navigation_msgs::MotionPlanRequest_<ContainerAllocator> &) { return value(); }
00131 };
00132
00133 template<class ContainerAllocator>
00134 struct Definition< ::arm_navigation_msgs::MotionPlanRequest_<ContainerAllocator> > {
00135 static const char* value()
00136 {
00137 return "# This service contains the definition for a request to the motion\n\
00138 # planner and the output it provides\n\
00139 \n\
00140 # Parameters for the workspace that the planner should work inside\n\
00141 arm_navigation_msgs/WorkspaceParameters workspace_parameters\n\
00142 \n\
00143 # Starting state updates. If certain joints should be considered\n\
00144 # at positions other than the current ones, these positions should\n\
00145 # be set here\n\
00146 arm_navigation_msgs/RobotState start_state\n\
00147 \n\
00148 # The goal state for the model to plan for. The goal is achieved\n\
00149 # if all constraints are satisfied\n\
00150 arm_navigation_msgs/Constraints goal_constraints\n\
00151 \n\
00152 # No state at any point along the path in the produced motion plan will violate these constraints\n\
00153 arm_navigation_msgs/Constraints path_constraints\n\
00154 \n\
00155 # The name of the motion planner to use. If no name is specified,\n\
00156 # a default motion planner will be used\n\
00157 string planner_id\n\
00158 \n\
00159 # The name of the group of joints on which this planner is operating\n\
00160 string group_name\n\
00161 \n\
00162 # The number of times this plan is to be computed. Shortest solution\n\
00163 # will be reported.\n\
00164 int32 num_planning_attempts\n\
00165 \n\
00166 # The maximum amount of time the motion planner is allowed to plan for\n\
00167 duration allowed_planning_time\n\
00168 \n\
00169 # An expected path duration (in seconds) along with an expected discretization of the path allows the planner to determine the discretization of the trajectory that it returns\n\
00170 duration expected_path_duration\n\
00171 duration expected_path_dt\n\
00172 \n\
00173 ================================================================================\n\
00174 MSG: arm_navigation_msgs/WorkspaceParameters\n\
00175 # This message contains a set of parameters useful in\n\
00176 # setting up the workspace for planning\n\
00177 arm_navigation_msgs/Shape workspace_region_shape\n\
00178 geometry_msgs/PoseStamped workspace_region_pose\n\
00179 \n\
00180 \n\
00181 ================================================================================\n\
00182 MSG: arm_navigation_msgs/Shape\n\
00183 byte SPHERE=0\n\
00184 byte BOX=1\n\
00185 byte CYLINDER=2\n\
00186 byte MESH=3\n\
00187 \n\
00188 byte type\n\
00189 \n\
00190 \n\
00191 #### define sphere, box, cylinder ####\n\
00192 # the origin of each shape is considered at the shape's center\n\
00193 \n\
00194 # for sphere\n\
00195 # radius := dimensions[0]\n\
00196 \n\
00197 # for cylinder\n\
00198 # radius := dimensions[0]\n\
00199 # length := dimensions[1]\n\
00200 # the length is along the Z axis\n\
00201 \n\
00202 # for box\n\
00203 # size_x := dimensions[0]\n\
00204 # size_y := dimensions[1]\n\
00205 # size_z := dimensions[2]\n\
00206 float64[] dimensions\n\
00207 \n\
00208 \n\
00209 #### define mesh ####\n\
00210 \n\
00211 # list of triangles; triangle k is defined by tre vertices located\n\
00212 # at indices triangles[3k], triangles[3k+1], triangles[3k+2]\n\
00213 int32[] triangles\n\
00214 geometry_msgs/Point[] vertices\n\
00215 \n\
00216 ================================================================================\n\
00217 MSG: geometry_msgs/Point\n\
00218 # This contains the position of a point in free space\n\
00219 float64 x\n\
00220 float64 y\n\
00221 float64 z\n\
00222 \n\
00223 ================================================================================\n\
00224 MSG: geometry_msgs/PoseStamped\n\
00225 # A Pose with reference coordinate frame and timestamp\n\
00226 Header header\n\
00227 Pose pose\n\
00228 \n\
00229 ================================================================================\n\
00230 MSG: std_msgs/Header\n\
00231 # Standard metadata for higher-level stamped data types.\n\
00232 # This is generally used to communicate timestamped data \n\
00233 # in a particular coordinate frame.\n\
00234 # \n\
00235 # sequence ID: consecutively increasing ID \n\
00236 uint32 seq\n\
00237 #Two-integer timestamp that is expressed as:\n\
00238 # * stamp.secs: seconds (stamp_secs) since epoch\n\
00239 # * stamp.nsecs: nanoseconds since stamp_secs\n\
00240 # time-handling sugar is provided by the client library\n\
00241 time stamp\n\
00242 #Frame this data is associated with\n\
00243 # 0: no frame\n\
00244 # 1: global frame\n\
00245 string frame_id\n\
00246 \n\
00247 ================================================================================\n\
00248 MSG: geometry_msgs/Pose\n\
00249 # A representation of pose in free space, composed of postion and orientation. \n\
00250 Point position\n\
00251 Quaternion orientation\n\
00252 \n\
00253 ================================================================================\n\
00254 MSG: geometry_msgs/Quaternion\n\
00255 # This represents an orientation in free space in quaternion form.\n\
00256 \n\
00257 float64 x\n\
00258 float64 y\n\
00259 float64 z\n\
00260 float64 w\n\
00261 \n\
00262 ================================================================================\n\
00263 MSG: arm_navigation_msgs/RobotState\n\
00264 # This message contains information about the robot state, i.e. the positions of its joints and links\n\
00265 sensor_msgs/JointState joint_state\n\
00266 arm_navigation_msgs/MultiDOFJointState multi_dof_joint_state\n\
00267 \n\
00268 ================================================================================\n\
00269 MSG: sensor_msgs/JointState\n\
00270 # This is a message that holds data to describe the state of a set of torque controlled joints. \n\
00271 #\n\
00272 # The state of each joint (revolute or prismatic) is defined by:\n\
00273 # * the position of the joint (rad or m),\n\
00274 # * the velocity of the joint (rad/s or m/s) and \n\
00275 # * the effort that is applied in the joint (Nm or N).\n\
00276 #\n\
00277 # Each joint is uniquely identified by its name\n\
00278 # The header specifies the time at which the joint states were recorded. All the joint states\n\
00279 # in one message have to be recorded at the same time.\n\
00280 #\n\
00281 # This message consists of a multiple arrays, one for each part of the joint state. \n\
00282 # The goal is to make each of the fields optional. When e.g. your joints have no\n\
00283 # effort associated with them, you can leave the effort array empty. \n\
00284 #\n\
00285 # All arrays in this message should have the same size, or be empty.\n\
00286 # This is the only way to uniquely associate the joint name with the correct\n\
00287 # states.\n\
00288 \n\
00289 \n\
00290 Header header\n\
00291 \n\
00292 string[] name\n\
00293 float64[] position\n\
00294 float64[] velocity\n\
00295 float64[] effort\n\
00296 \n\
00297 ================================================================================\n\
00298 MSG: arm_navigation_msgs/MultiDOFJointState\n\
00299 #A representation of a multi-dof joint state\n\
00300 time stamp\n\
00301 string[] joint_names\n\
00302 string[] frame_ids\n\
00303 string[] child_frame_ids\n\
00304 geometry_msgs/Pose[] poses\n\
00305 \n\
00306 ================================================================================\n\
00307 MSG: arm_navigation_msgs/Constraints\n\
00308 # This message contains a list of motion planning constraints.\n\
00309 \n\
00310 arm_navigation_msgs/JointConstraint[] joint_constraints\n\
00311 arm_navigation_msgs/PositionConstraint[] position_constraints\n\
00312 arm_navigation_msgs/OrientationConstraint[] orientation_constraints\n\
00313 arm_navigation_msgs/VisibilityConstraint[] visibility_constraints\n\
00314 \n\
00315 ================================================================================\n\
00316 MSG: arm_navigation_msgs/JointConstraint\n\
00317 # Constrain the position of a joint to be within a certain bound\n\
00318 string joint_name\n\
00319 \n\
00320 # the bound to be achieved is [position - tolerance_below, position + tolerance_above]\n\
00321 float64 position\n\
00322 float64 tolerance_above\n\
00323 float64 tolerance_below\n\
00324 \n\
00325 # A weighting factor for this constraint\n\
00326 float64 weight\n\
00327 ================================================================================\n\
00328 MSG: arm_navigation_msgs/PositionConstraint\n\
00329 # This message contains the definition of a position constraint.\n\
00330 Header header\n\
00331 \n\
00332 # The robot link this constraint refers to\n\
00333 string link_name\n\
00334 \n\
00335 # The offset (in the link frame) for the target point on the link we are planning for\n\
00336 geometry_msgs/Point target_point_offset\n\
00337 \n\
00338 # The nominal/target position for the point we are planning for\n\
00339 geometry_msgs/Point position\n\
00340 \n\
00341 # The shape of the bounded region that constrains the position of the end-effector\n\
00342 # This region is always centered at the position defined above\n\
00343 arm_navigation_msgs/Shape constraint_region_shape\n\
00344 \n\
00345 # The orientation of the bounded region that constrains the position of the end-effector. \n\
00346 # This allows the specification of non-axis aligned constraints\n\
00347 geometry_msgs/Quaternion constraint_region_orientation\n\
00348 \n\
00349 # Constraint weighting factor - a weight for this constraint\n\
00350 float64 weight\n\
00351 \n\
00352 ================================================================================\n\
00353 MSG: arm_navigation_msgs/OrientationConstraint\n\
00354 # This message contains the definition of an orientation constraint.\n\
00355 Header header\n\
00356 \n\
00357 # The robot link this constraint refers to\n\
00358 string link_name\n\
00359 \n\
00360 # The type of the constraint\n\
00361 int32 type\n\
00362 int32 LINK_FRAME=0\n\
00363 int32 HEADER_FRAME=1\n\
00364 \n\
00365 # The desired orientation of the robot link specified as a quaternion\n\
00366 geometry_msgs/Quaternion orientation\n\
00367 \n\
00368 # optional RPY error tolerances specified if \n\
00369 float64 absolute_roll_tolerance\n\
00370 float64 absolute_pitch_tolerance\n\
00371 float64 absolute_yaw_tolerance\n\
00372 \n\
00373 # Constraint weighting factor - a weight for this constraint\n\
00374 float64 weight\n\
00375 \n\
00376 ================================================================================\n\
00377 MSG: arm_navigation_msgs/VisibilityConstraint\n\
00378 # This message contains the definition of a visibility constraint.\n\
00379 Header header\n\
00380 \n\
00381 # The point stamped target that needs to be kept within view of the sensor\n\
00382 geometry_msgs/PointStamped target\n\
00383 \n\
00384 # The local pose of the frame in which visibility is to be maintained\n\
00385 # The frame id should represent the robot link to which the sensor is attached\n\
00386 # The visual axis of the sensor is assumed to be along the X axis of this frame\n\
00387 geometry_msgs/PoseStamped sensor_pose\n\
00388 \n\
00389 # The deviation (in radians) that will be tolerated\n\
00390 # Constraint error will be measured as the solid angle between the \n\
00391 # X axis of the frame defined above and the vector between the origin \n\
00392 # of the frame defined above and the target location\n\
00393 float64 absolute_tolerance\n\
00394 \n\
00395 \n\
00396 ================================================================================\n\
00397 MSG: geometry_msgs/PointStamped\n\
00398 # This represents a Point with reference coordinate frame and timestamp\n\
00399 Header header\n\
00400 Point point\n\
00401 \n\
00402 ";
00403 }
00404
00405 static const char* value(const ::arm_navigation_msgs::MotionPlanRequest_<ContainerAllocator> &) { return value(); }
00406 };
00407
00408 }
00409 }
00410
00411 namespace ros
00412 {
00413 namespace serialization
00414 {
00415
00416 template<class ContainerAllocator> struct Serializer< ::arm_navigation_msgs::MotionPlanRequest_<ContainerAllocator> >
00417 {
00418 template<typename Stream, typename T> inline static void allInOne(Stream& stream, T m)
00419 {
00420 stream.next(m.workspace_parameters);
00421 stream.next(m.start_state);
00422 stream.next(m.goal_constraints);
00423 stream.next(m.path_constraints);
00424 stream.next(m.planner_id);
00425 stream.next(m.group_name);
00426 stream.next(m.num_planning_attempts);
00427 stream.next(m.allowed_planning_time);
00428 stream.next(m.expected_path_duration);
00429 stream.next(m.expected_path_dt);
00430 }
00431
00432 ROS_DECLARE_ALLINONE_SERIALIZER;
00433 };
00434 }
00435 }
00436
00437 namespace ros
00438 {
00439 namespace message_operations
00440 {
00441
00442 template<class ContainerAllocator>
00443 struct Printer< ::arm_navigation_msgs::MotionPlanRequest_<ContainerAllocator> >
00444 {
00445 template<typename Stream> static void stream(Stream& s, const std::string& indent, const ::arm_navigation_msgs::MotionPlanRequest_<ContainerAllocator> & v)
00446 {
00447 s << indent << "workspace_parameters: ";
00448 s << std::endl;
00449 Printer< ::arm_navigation_msgs::WorkspaceParameters_<ContainerAllocator> >::stream(s, indent + " ", v.workspace_parameters);
00450 s << indent << "start_state: ";
00451 s << std::endl;
00452 Printer< ::arm_navigation_msgs::RobotState_<ContainerAllocator> >::stream(s, indent + " ", v.start_state);
00453 s << indent << "goal_constraints: ";
00454 s << std::endl;
00455 Printer< ::arm_navigation_msgs::Constraints_<ContainerAllocator> >::stream(s, indent + " ", v.goal_constraints);
00456 s << indent << "path_constraints: ";
00457 s << std::endl;
00458 Printer< ::arm_navigation_msgs::Constraints_<ContainerAllocator> >::stream(s, indent + " ", v.path_constraints);
00459 s << indent << "planner_id: ";
00460 Printer<std::basic_string<char, std::char_traits<char>, typename ContainerAllocator::template rebind<char>::other > >::stream(s, indent + " ", v.planner_id);
00461 s << indent << "group_name: ";
00462 Printer<std::basic_string<char, std::char_traits<char>, typename ContainerAllocator::template rebind<char>::other > >::stream(s, indent + " ", v.group_name);
00463 s << indent << "num_planning_attempts: ";
00464 Printer<int32_t>::stream(s, indent + " ", v.num_planning_attempts);
00465 s << indent << "allowed_planning_time: ";
00466 Printer<ros::Duration>::stream(s, indent + " ", v.allowed_planning_time);
00467 s << indent << "expected_path_duration: ";
00468 Printer<ros::Duration>::stream(s, indent + " ", v.expected_path_duration);
00469 s << indent << "expected_path_dt: ";
00470 Printer<ros::Duration>::stream(s, indent + " ", v.expected_path_dt);
00471 }
00472 };
00473
00474
00475 }
00476 }
00477
00478 #endif // ARM_NAVIGATION_MSGS_MESSAGE_MOTIONPLANREQUEST_H
00479