00001 """autogenerated by genpy from tidyup_msgs/GraspObjectResult.msg. Do not edit."""
00002 import sys
00003 python3 = True if sys.hexversion > 0x03000000 else False
00004 import genpy
00005 import struct
00006
00007 import arm_navigation_msgs.msg
00008 import geometry_msgs.msg
00009 import std_msgs.msg
00010
00011 class GraspObjectResult(genpy.Message):
00012 _md5sum = "31092179077a179da9598ff7caa77928"
00013 _type = "tidyup_msgs/GraspObjectResult"
00014 _has_header = False
00015 _full_text = """# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ======
00016 # the new pose of the object
00017 geometry_msgs/PoseStamped grasp
00018 arm_navigation_msgs/ArmNavigationErrorCodes error_code
00019
00020 ================================================================================
00021 MSG: geometry_msgs/PoseStamped
00022 # A Pose with reference coordinate frame and timestamp
00023 Header header
00024 Pose pose
00025
00026 ================================================================================
00027 MSG: std_msgs/Header
00028 # Standard metadata for higher-level stamped data types.
00029 # This is generally used to communicate timestamped data
00030 # in a particular coordinate frame.
00031 #
00032 # sequence ID: consecutively increasing ID
00033 uint32 seq
00034 #Two-integer timestamp that is expressed as:
00035 # * stamp.secs: seconds (stamp_secs) since epoch
00036 # * stamp.nsecs: nanoseconds since stamp_secs
00037 # time-handling sugar is provided by the client library
00038 time stamp
00039 #Frame this data is associated with
00040 # 0: no frame
00041 # 1: global frame
00042 string frame_id
00043
00044 ================================================================================
00045 MSG: geometry_msgs/Pose
00046 # A representation of pose in free space, composed of postion and orientation.
00047 Point position
00048 Quaternion orientation
00049
00050 ================================================================================
00051 MSG: geometry_msgs/Point
00052 # This contains the position of a point in free space
00053 float64 x
00054 float64 y
00055 float64 z
00056
00057 ================================================================================
00058 MSG: geometry_msgs/Quaternion
00059 # This represents an orientation in free space in quaternion form.
00060
00061 float64 x
00062 float64 y
00063 float64 z
00064 float64 w
00065
00066 ================================================================================
00067 MSG: arm_navigation_msgs/ArmNavigationErrorCodes
00068 int32 val
00069
00070 # overall behavior
00071 int32 PLANNING_FAILED=-1
00072 int32 SUCCESS=1
00073 int32 TIMED_OUT=-2
00074
00075 # start state errors
00076 int32 START_STATE_IN_COLLISION=-3
00077 int32 START_STATE_VIOLATES_PATH_CONSTRAINTS=-4
00078
00079 # goal errors
00080 int32 GOAL_IN_COLLISION=-5
00081 int32 GOAL_VIOLATES_PATH_CONSTRAINTS=-6
00082
00083 # robot state
00084 int32 INVALID_ROBOT_STATE=-7
00085 int32 INCOMPLETE_ROBOT_STATE=-8
00086
00087 # planning request errors
00088 int32 INVALID_PLANNER_ID=-9
00089 int32 INVALID_NUM_PLANNING_ATTEMPTS=-10
00090 int32 INVALID_ALLOWED_PLANNING_TIME=-11
00091 int32 INVALID_GROUP_NAME=-12
00092 int32 INVALID_GOAL_JOINT_CONSTRAINTS=-13
00093 int32 INVALID_GOAL_POSITION_CONSTRAINTS=-14
00094 int32 INVALID_GOAL_ORIENTATION_CONSTRAINTS=-15
00095 int32 INVALID_PATH_JOINT_CONSTRAINTS=-16
00096 int32 INVALID_PATH_POSITION_CONSTRAINTS=-17
00097 int32 INVALID_PATH_ORIENTATION_CONSTRAINTS=-18
00098
00099 # state/trajectory monitor errors
00100 int32 INVALID_TRAJECTORY=-19
00101 int32 INVALID_INDEX=-20
00102 int32 JOINT_LIMITS_VIOLATED=-21
00103 int32 PATH_CONSTRAINTS_VIOLATED=-22
00104 int32 COLLISION_CONSTRAINTS_VIOLATED=-23
00105 int32 GOAL_CONSTRAINTS_VIOLATED=-24
00106 int32 JOINTS_NOT_MOVING=-25
00107 int32 TRAJECTORY_CONTROLLER_FAILED=-26
00108
00109 # system errors
00110 int32 FRAME_TRANSFORM_FAILURE=-27
00111 int32 COLLISION_CHECKING_UNAVAILABLE=-28
00112 int32 ROBOT_STATE_STALE=-29
00113 int32 SENSOR_INFO_STALE=-30
00114
00115 # kinematics errors
00116 int32 NO_IK_SOLUTION=-31
00117 int32 INVALID_LINK_NAME=-32
00118 int32 IK_LINK_IN_COLLISION=-33
00119 int32 NO_FK_SOLUTION=-34
00120 int32 KINEMATICS_STATE_IN_COLLISION=-35
00121
00122 # general errors
00123 int32 INVALID_TIMEOUT=-36
00124
00125
00126 """
00127 __slots__ = ['grasp','error_code']
00128 _slot_types = ['geometry_msgs/PoseStamped','arm_navigation_msgs/ArmNavigationErrorCodes']
00129
00130 def __init__(self, *args, **kwds):
00131 """
00132 Constructor. Any message fields that are implicitly/explicitly
00133 set to None will be assigned a default value. The recommend
00134 use is keyword arguments as this is more robust to future message
00135 changes. You cannot mix in-order arguments and keyword arguments.
00136
00137 The available fields are:
00138 grasp,error_code
00139
00140 :param args: complete set of field values, in .msg order
00141 :param kwds: use keyword arguments corresponding to message field names
00142 to set specific fields.
00143 """
00144 if args or kwds:
00145 super(GraspObjectResult, self).__init__(*args, **kwds)
00146
00147 if self.grasp is None:
00148 self.grasp = geometry_msgs.msg.PoseStamped()
00149 if self.error_code is None:
00150 self.error_code = arm_navigation_msgs.msg.ArmNavigationErrorCodes()
00151 else:
00152 self.grasp = geometry_msgs.msg.PoseStamped()
00153 self.error_code = arm_navigation_msgs.msg.ArmNavigationErrorCodes()
00154
00155 def _get_types(self):
00156 """
00157 internal API method
00158 """
00159 return self._slot_types
00160
00161 def serialize(self, buff):
00162 """
00163 serialize message into buffer
00164 :param buff: buffer, ``StringIO``
00165 """
00166 try:
00167 _x = self
00168 buff.write(_struct_3I.pack(_x.grasp.header.seq, _x.grasp.header.stamp.secs, _x.grasp.header.stamp.nsecs))
00169 _x = self.grasp.header.frame_id
00170 length = len(_x)
00171 if python3 or type(_x) == unicode:
00172 _x = _x.encode('utf-8')
00173 length = len(_x)
00174 buff.write(struct.pack('<I%ss'%length, length, _x))
00175 _x = self
00176 buff.write(_struct_7di.pack(_x.grasp.pose.position.x, _x.grasp.pose.position.y, _x.grasp.pose.position.z, _x.grasp.pose.orientation.x, _x.grasp.pose.orientation.y, _x.grasp.pose.orientation.z, _x.grasp.pose.orientation.w, _x.error_code.val))
00177 except struct.error as se: self._check_types(se)
00178 except TypeError as te: self._check_types(te)
00179
00180 def deserialize(self, str):
00181 """
00182 unpack serialized message in str into this message instance
00183 :param str: byte array of serialized message, ``str``
00184 """
00185 try:
00186 if self.grasp is None:
00187 self.grasp = geometry_msgs.msg.PoseStamped()
00188 if self.error_code is None:
00189 self.error_code = arm_navigation_msgs.msg.ArmNavigationErrorCodes()
00190 end = 0
00191 _x = self
00192 start = end
00193 end += 12
00194 (_x.grasp.header.seq, _x.grasp.header.stamp.secs, _x.grasp.header.stamp.nsecs,) = _struct_3I.unpack(str[start:end])
00195 start = end
00196 end += 4
00197 (length,) = _struct_I.unpack(str[start:end])
00198 start = end
00199 end += length
00200 if python3:
00201 self.grasp.header.frame_id = str[start:end].decode('utf-8')
00202 else:
00203 self.grasp.header.frame_id = str[start:end]
00204 _x = self
00205 start = end
00206 end += 60
00207 (_x.grasp.pose.position.x, _x.grasp.pose.position.y, _x.grasp.pose.position.z, _x.grasp.pose.orientation.x, _x.grasp.pose.orientation.y, _x.grasp.pose.orientation.z, _x.grasp.pose.orientation.w, _x.error_code.val,) = _struct_7di.unpack(str[start:end])
00208 return self
00209 except struct.error as e:
00210 raise genpy.DeserializationError(e)
00211
00212
00213 def serialize_numpy(self, buff, numpy):
00214 """
00215 serialize message with numpy array types into buffer
00216 :param buff: buffer, ``StringIO``
00217 :param numpy: numpy python module
00218 """
00219 try:
00220 _x = self
00221 buff.write(_struct_3I.pack(_x.grasp.header.seq, _x.grasp.header.stamp.secs, _x.grasp.header.stamp.nsecs))
00222 _x = self.grasp.header.frame_id
00223 length = len(_x)
00224 if python3 or type(_x) == unicode:
00225 _x = _x.encode('utf-8')
00226 length = len(_x)
00227 buff.write(struct.pack('<I%ss'%length, length, _x))
00228 _x = self
00229 buff.write(_struct_7di.pack(_x.grasp.pose.position.x, _x.grasp.pose.position.y, _x.grasp.pose.position.z, _x.grasp.pose.orientation.x, _x.grasp.pose.orientation.y, _x.grasp.pose.orientation.z, _x.grasp.pose.orientation.w, _x.error_code.val))
00230 except struct.error as se: self._check_types(se)
00231 except TypeError as te: self._check_types(te)
00232
00233 def deserialize_numpy(self, str, numpy):
00234 """
00235 unpack serialized message in str into this message instance using numpy for array types
00236 :param str: byte array of serialized message, ``str``
00237 :param numpy: numpy python module
00238 """
00239 try:
00240 if self.grasp is None:
00241 self.grasp = geometry_msgs.msg.PoseStamped()
00242 if self.error_code is None:
00243 self.error_code = arm_navigation_msgs.msg.ArmNavigationErrorCodes()
00244 end = 0
00245 _x = self
00246 start = end
00247 end += 12
00248 (_x.grasp.header.seq, _x.grasp.header.stamp.secs, _x.grasp.header.stamp.nsecs,) = _struct_3I.unpack(str[start:end])
00249 start = end
00250 end += 4
00251 (length,) = _struct_I.unpack(str[start:end])
00252 start = end
00253 end += length
00254 if python3:
00255 self.grasp.header.frame_id = str[start:end].decode('utf-8')
00256 else:
00257 self.grasp.header.frame_id = str[start:end]
00258 _x = self
00259 start = end
00260 end += 60
00261 (_x.grasp.pose.position.x, _x.grasp.pose.position.y, _x.grasp.pose.position.z, _x.grasp.pose.orientation.x, _x.grasp.pose.orientation.y, _x.grasp.pose.orientation.z, _x.grasp.pose.orientation.w, _x.error_code.val,) = _struct_7di.unpack(str[start:end])
00262 return self
00263 except struct.error as e:
00264 raise genpy.DeserializationError(e)
00265
00266 _struct_I = genpy.struct_I
00267 _struct_7di = struct.Struct("<7di")
00268 _struct_3I = struct.Struct("<3I")