$search
00001 """autogenerated by genmsg_py from HeadMonitorActionFeedback.msg. Do not edit.""" 00002 import roslib.message 00003 import struct 00004 00005 import arm_navigation_msgs.msg 00006 import roslib.rostime 00007 import actionlib_msgs.msg 00008 import geometry_msgs.msg 00009 import head_monitor_msgs.msg 00010 import sensor_msgs.msg 00011 import std_msgs.msg 00012 00013 class HeadMonitorActionFeedback(roslib.message.Message): 00014 _md5sum = "1145699f06665025be6a400f94f4440d" 00015 _type = "head_monitor_msgs/HeadMonitorActionFeedback" 00016 _has_header = True #flag to mark the presence of a Header object 00017 _full_text = """# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ====== 00018 00019 Header header 00020 actionlib_msgs/GoalStatus status 00021 HeadMonitorFeedback feedback 00022 00023 ================================================================================ 00024 MSG: std_msgs/Header 00025 # Standard metadata for higher-level stamped data types. 00026 # This is generally used to communicate timestamped data 00027 # in a particular coordinate frame. 00028 # 00029 # sequence ID: consecutively increasing ID 00030 uint32 seq 00031 #Two-integer timestamp that is expressed as: 00032 # * stamp.secs: seconds (stamp_secs) since epoch 00033 # * stamp.nsecs: nanoseconds since stamp_secs 00034 # time-handling sugar is provided by the client library 00035 time stamp 00036 #Frame this data is associated with 00037 # 0: no frame 00038 # 1: global frame 00039 string frame_id 00040 00041 ================================================================================ 00042 MSG: actionlib_msgs/GoalStatus 00043 GoalID goal_id 00044 uint8 status 00045 uint8 PENDING = 0 # The goal has yet to be processed by the action server 00046 uint8 ACTIVE = 1 # The goal is currently being processed by the action server 00047 uint8 PREEMPTED = 2 # The goal received a cancel request after it started executing 00048 # and has since completed its execution (Terminal State) 00049 uint8 SUCCEEDED = 3 # The goal was achieved successfully by the action server (Terminal State) 00050 uint8 ABORTED = 4 # The goal was aborted during execution by the action server due 00051 # to some failure (Terminal State) 00052 uint8 REJECTED = 5 # The goal was rejected by the action server without being processed, 00053 # because the goal was unattainable or invalid (Terminal State) 00054 uint8 PREEMPTING = 6 # The goal received a cancel request after it started executing 00055 # and has not yet completed execution 00056 uint8 RECALLING = 7 # The goal received a cancel request before it started executing, 00057 # but the action server has not yet confirmed that the goal is canceled 00058 uint8 RECALLED = 8 # The goal received a cancel request before it started executing 00059 # and was successfully cancelled (Terminal State) 00060 uint8 LOST = 9 # An action client can determine that a goal is LOST. This should not be 00061 # sent over the wire by an action server 00062 00063 #Allow for the user to associate a string with GoalStatus for debugging 00064 string text 00065 00066 00067 ================================================================================ 00068 MSG: actionlib_msgs/GoalID 00069 # The stamp should store the time at which this goal was requested. 00070 # It is used by an action server when it tries to preempt all 00071 # goals that were requested before a certain time 00072 time stamp 00073 00074 # The id provides a way to associate feedback and 00075 # result message with specific goal requests. The id 00076 # specified must be unique. 00077 string id 00078 00079 00080 ================================================================================ 00081 MSG: head_monitor_msgs/HeadMonitorFeedback 00082 # ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ====== 00083 arm_navigation_msgs/RobotState current_state 00084 arm_navigation_msgs/RobotState paused_trajectory_state 00085 arm_navigation_msgs/CollisionObject paused_collision_map 00086 00087 00088 00089 ================================================================================ 00090 MSG: arm_navigation_msgs/RobotState 00091 # This message contains information about the robot state, i.e. the positions of its joints and links 00092 sensor_msgs/JointState joint_state 00093 arm_navigation_msgs/MultiDOFJointState multi_dof_joint_state 00094 00095 ================================================================================ 00096 MSG: sensor_msgs/JointState 00097 # This is a message that holds data to describe the state of a set of torque controlled joints. 00098 # 00099 # The state of each joint (revolute or prismatic) is defined by: 00100 # * the position of the joint (rad or m), 00101 # * the velocity of the joint (rad/s or m/s) and 00102 # * the effort that is applied in the joint (Nm or N). 00103 # 00104 # Each joint is uniquely identified by its name 00105 # The header specifies the time at which the joint states were recorded. All the joint states 00106 # in one message have to be recorded at the same time. 00107 # 00108 # This message consists of a multiple arrays, one for each part of the joint state. 00109 # The goal is to make each of the fields optional. When e.g. your joints have no 00110 # effort associated with them, you can leave the effort array empty. 00111 # 00112 # All arrays in this message should have the same size, or be empty. 00113 # This is the only way to uniquely associate the joint name with the correct 00114 # states. 00115 00116 00117 Header header 00118 00119 string[] name 00120 float64[] position 00121 float64[] velocity 00122 float64[] effort 00123 00124 ================================================================================ 00125 MSG: arm_navigation_msgs/MultiDOFJointState 00126 #A representation of a multi-dof joint state 00127 time stamp 00128 string[] joint_names 00129 string[] frame_ids 00130 string[] child_frame_ids 00131 geometry_msgs/Pose[] poses 00132 00133 ================================================================================ 00134 MSG: geometry_msgs/Pose 00135 # A representation of pose in free space, composed of postion and orientation. 00136 Point position 00137 Quaternion orientation 00138 00139 ================================================================================ 00140 MSG: geometry_msgs/Point 00141 # This contains the position of a point in free space 00142 float64 x 00143 float64 y 00144 float64 z 00145 00146 ================================================================================ 00147 MSG: geometry_msgs/Quaternion 00148 # This represents an orientation in free space in quaternion form. 00149 00150 float64 x 00151 float64 y 00152 float64 z 00153 float64 w 00154 00155 ================================================================================ 00156 MSG: arm_navigation_msgs/CollisionObject 00157 # a header, used for interpreting the poses 00158 Header header 00159 00160 # the id of the object 00161 string id 00162 00163 # The padding used for filtering points near the object. 00164 # This does not affect collision checking for the object. 00165 # Set to negative to get zero padding. 00166 float32 padding 00167 00168 #This contains what is to be done with the object 00169 CollisionObjectOperation operation 00170 00171 #the shapes associated with the object 00172 arm_navigation_msgs/Shape[] shapes 00173 00174 #the poses associated with the shapes - will be transformed using the header 00175 geometry_msgs/Pose[] poses 00176 00177 ================================================================================ 00178 MSG: arm_navigation_msgs/CollisionObjectOperation 00179 #Puts the object into the environment 00180 #or updates the object if already added 00181 byte ADD=0 00182 00183 #Removes the object from the environment entirely 00184 byte REMOVE=1 00185 00186 #Only valid within the context of a CollisionAttachedObject message 00187 #Will be ignored if sent with an CollisionObject message 00188 #Takes an attached object, detaches from the attached link 00189 #But adds back in as regular object 00190 byte DETACH_AND_ADD_AS_OBJECT=2 00191 00192 #Only valid within the context of a CollisionAttachedObject message 00193 #Will be ignored if sent with an CollisionObject message 00194 #Takes current object in the environment and removes it as 00195 #a regular object 00196 byte ATTACH_AND_REMOVE_AS_OBJECT=3 00197 00198 # Byte code for operation 00199 byte operation 00200 00201 ================================================================================ 00202 MSG: arm_navigation_msgs/Shape 00203 byte SPHERE=0 00204 byte BOX=1 00205 byte CYLINDER=2 00206 byte MESH=3 00207 00208 byte type 00209 00210 00211 #### define sphere, box, cylinder #### 00212 # the origin of each shape is considered at the shape's center 00213 00214 # for sphere 00215 # radius := dimensions[0] 00216 00217 # for cylinder 00218 # radius := dimensions[0] 00219 # length := dimensions[1] 00220 # the length is along the Z axis 00221 00222 # for box 00223 # size_x := dimensions[0] 00224 # size_y := dimensions[1] 00225 # size_z := dimensions[2] 00226 float64[] dimensions 00227 00228 00229 #### define mesh #### 00230 00231 # list of triangles; triangle k is defined by tre vertices located 00232 # at indices triangles[3k], triangles[3k+1], triangles[3k+2] 00233 int32[] triangles 00234 geometry_msgs/Point[] vertices 00235 00236 """ 00237 __slots__ = ['header','status','feedback'] 00238 _slot_types = ['Header','actionlib_msgs/GoalStatus','head_monitor_msgs/HeadMonitorFeedback'] 00239 00240 def __init__(self, *args, **kwds): 00241 """ 00242 Constructor. Any message fields that are implicitly/explicitly 00243 set to None will be assigned a default value. The recommend 00244 use is keyword arguments as this is more robust to future message 00245 changes. You cannot mix in-order arguments and keyword arguments. 00246 00247 The available fields are: 00248 header,status,feedback 00249 00250 @param args: complete set of field values, in .msg order 00251 @param kwds: use keyword arguments corresponding to message field names 00252 to set specific fields. 00253 """ 00254 if args or kwds: 00255 super(HeadMonitorActionFeedback, self).__init__(*args, **kwds) 00256 #message fields cannot be None, assign default values for those that are 00257 if self.header is None: 00258 self.header = std_msgs.msg._Header.Header() 00259 if self.status is None: 00260 self.status = actionlib_msgs.msg.GoalStatus() 00261 if self.feedback is None: 00262 self.feedback = head_monitor_msgs.msg.HeadMonitorFeedback() 00263 else: 00264 self.header = std_msgs.msg._Header.Header() 00265 self.status = actionlib_msgs.msg.GoalStatus() 00266 self.feedback = head_monitor_msgs.msg.HeadMonitorFeedback() 00267 00268 def _get_types(self): 00269 """ 00270 internal API method 00271 """ 00272 return self._slot_types 00273 00274 def serialize(self, buff): 00275 """ 00276 serialize message into buffer 00277 @param buff: buffer 00278 @type buff: StringIO 00279 """ 00280 try: 00281 _x = self 00282 buff.write(_struct_3I.pack(_x.header.seq, _x.header.stamp.secs, _x.header.stamp.nsecs)) 00283 _x = self.header.frame_id 00284 length = len(_x) 00285 buff.write(struct.pack('<I%ss'%length, length, _x)) 00286 _x = self 00287 buff.write(_struct_2I.pack(_x.status.goal_id.stamp.secs, _x.status.goal_id.stamp.nsecs)) 00288 _x = self.status.goal_id.id 00289 length = len(_x) 00290 buff.write(struct.pack('<I%ss'%length, length, _x)) 00291 buff.write(_struct_B.pack(self.status.status)) 00292 _x = self.status.text 00293 length = len(_x) 00294 buff.write(struct.pack('<I%ss'%length, length, _x)) 00295 _x = self 00296 buff.write(_struct_3I.pack(_x.feedback.current_state.joint_state.header.seq, _x.feedback.current_state.joint_state.header.stamp.secs, _x.feedback.current_state.joint_state.header.stamp.nsecs)) 00297 _x = self.feedback.current_state.joint_state.header.frame_id 00298 length = len(_x) 00299 buff.write(struct.pack('<I%ss'%length, length, _x)) 00300 length = len(self.feedback.current_state.joint_state.name) 00301 buff.write(_struct_I.pack(length)) 00302 for val1 in self.feedback.current_state.joint_state.name: 00303 length = len(val1) 00304 buff.write(struct.pack('<I%ss'%length, length, val1)) 00305 length = len(self.feedback.current_state.joint_state.position) 00306 buff.write(_struct_I.pack(length)) 00307 pattern = '<%sd'%length 00308 buff.write(struct.pack(pattern, *self.feedback.current_state.joint_state.position)) 00309 length = len(self.feedback.current_state.joint_state.velocity) 00310 buff.write(_struct_I.pack(length)) 00311 pattern = '<%sd'%length 00312 buff.write(struct.pack(pattern, *self.feedback.current_state.joint_state.velocity)) 00313 length = len(self.feedback.current_state.joint_state.effort) 00314 buff.write(_struct_I.pack(length)) 00315 pattern = '<%sd'%length 00316 buff.write(struct.pack(pattern, *self.feedback.current_state.joint_state.effort)) 00317 _x = self 00318 buff.write(_struct_2I.pack(_x.feedback.current_state.multi_dof_joint_state.stamp.secs, _x.feedback.current_state.multi_dof_joint_state.stamp.nsecs)) 00319 length = len(self.feedback.current_state.multi_dof_joint_state.joint_names) 00320 buff.write(_struct_I.pack(length)) 00321 for val1 in self.feedback.current_state.multi_dof_joint_state.joint_names: 00322 length = len(val1) 00323 buff.write(struct.pack('<I%ss'%length, length, val1)) 00324 length = len(self.feedback.current_state.multi_dof_joint_state.frame_ids) 00325 buff.write(_struct_I.pack(length)) 00326 for val1 in self.feedback.current_state.multi_dof_joint_state.frame_ids: 00327 length = len(val1) 00328 buff.write(struct.pack('<I%ss'%length, length, val1)) 00329 length = len(self.feedback.current_state.multi_dof_joint_state.child_frame_ids) 00330 buff.write(_struct_I.pack(length)) 00331 for val1 in self.feedback.current_state.multi_dof_joint_state.child_frame_ids: 00332 length = len(val1) 00333 buff.write(struct.pack('<I%ss'%length, length, val1)) 00334 length = len(self.feedback.current_state.multi_dof_joint_state.poses) 00335 buff.write(_struct_I.pack(length)) 00336 for val1 in self.feedback.current_state.multi_dof_joint_state.poses: 00337 _v1 = val1.position 00338 _x = _v1 00339 buff.write(_struct_3d.pack(_x.x, _x.y, _x.z)) 00340 _v2 = val1.orientation 00341 _x = _v2 00342 buff.write(_struct_4d.pack(_x.x, _x.y, _x.z, _x.w)) 00343 _x = self 00344 buff.write(_struct_3I.pack(_x.feedback.paused_trajectory_state.joint_state.header.seq, _x.feedback.paused_trajectory_state.joint_state.header.stamp.secs, _x.feedback.paused_trajectory_state.joint_state.header.stamp.nsecs)) 00345 _x = self.feedback.paused_trajectory_state.joint_state.header.frame_id 00346 length = len(_x) 00347 buff.write(struct.pack('<I%ss'%length, length, _x)) 00348 length = len(self.feedback.paused_trajectory_state.joint_state.name) 00349 buff.write(_struct_I.pack(length)) 00350 for val1 in self.feedback.paused_trajectory_state.joint_state.name: 00351 length = len(val1) 00352 buff.write(struct.pack('<I%ss'%length, length, val1)) 00353 length = len(self.feedback.paused_trajectory_state.joint_state.position) 00354 buff.write(_struct_I.pack(length)) 00355 pattern = '<%sd'%length 00356 buff.write(struct.pack(pattern, *self.feedback.paused_trajectory_state.joint_state.position)) 00357 length = len(self.feedback.paused_trajectory_state.joint_state.velocity) 00358 buff.write(_struct_I.pack(length)) 00359 pattern = '<%sd'%length 00360 buff.write(struct.pack(pattern, *self.feedback.paused_trajectory_state.joint_state.velocity)) 00361 length = len(self.feedback.paused_trajectory_state.joint_state.effort) 00362 buff.write(_struct_I.pack(length)) 00363 pattern = '<%sd'%length 00364 buff.write(struct.pack(pattern, *self.feedback.paused_trajectory_state.joint_state.effort)) 00365 _x = self 00366 buff.write(_struct_2I.pack(_x.feedback.paused_trajectory_state.multi_dof_joint_state.stamp.secs, _x.feedback.paused_trajectory_state.multi_dof_joint_state.stamp.nsecs)) 00367 length = len(self.feedback.paused_trajectory_state.multi_dof_joint_state.joint_names) 00368 buff.write(_struct_I.pack(length)) 00369 for val1 in self.feedback.paused_trajectory_state.multi_dof_joint_state.joint_names: 00370 length = len(val1) 00371 buff.write(struct.pack('<I%ss'%length, length, val1)) 00372 length = len(self.feedback.paused_trajectory_state.multi_dof_joint_state.frame_ids) 00373 buff.write(_struct_I.pack(length)) 00374 for val1 in self.feedback.paused_trajectory_state.multi_dof_joint_state.frame_ids: 00375 length = len(val1) 00376 buff.write(struct.pack('<I%ss'%length, length, val1)) 00377 length = len(self.feedback.paused_trajectory_state.multi_dof_joint_state.child_frame_ids) 00378 buff.write(_struct_I.pack(length)) 00379 for val1 in self.feedback.paused_trajectory_state.multi_dof_joint_state.child_frame_ids: 00380 length = len(val1) 00381 buff.write(struct.pack('<I%ss'%length, length, val1)) 00382 length = len(self.feedback.paused_trajectory_state.multi_dof_joint_state.poses) 00383 buff.write(_struct_I.pack(length)) 00384 for val1 in self.feedback.paused_trajectory_state.multi_dof_joint_state.poses: 00385 _v3 = val1.position 00386 _x = _v3 00387 buff.write(_struct_3d.pack(_x.x, _x.y, _x.z)) 00388 _v4 = val1.orientation 00389 _x = _v4 00390 buff.write(_struct_4d.pack(_x.x, _x.y, _x.z, _x.w)) 00391 _x = self 00392 buff.write(_struct_3I.pack(_x.feedback.paused_collision_map.header.seq, _x.feedback.paused_collision_map.header.stamp.secs, _x.feedback.paused_collision_map.header.stamp.nsecs)) 00393 _x = self.feedback.paused_collision_map.header.frame_id 00394 length = len(_x) 00395 buff.write(struct.pack('<I%ss'%length, length, _x)) 00396 _x = self.feedback.paused_collision_map.id 00397 length = len(_x) 00398 buff.write(struct.pack('<I%ss'%length, length, _x)) 00399 _x = self 00400 buff.write(_struct_fb.pack(_x.feedback.paused_collision_map.padding, _x.feedback.paused_collision_map.operation.operation)) 00401 length = len(self.feedback.paused_collision_map.shapes) 00402 buff.write(_struct_I.pack(length)) 00403 for val1 in self.feedback.paused_collision_map.shapes: 00404 buff.write(_struct_b.pack(val1.type)) 00405 length = len(val1.dimensions) 00406 buff.write(_struct_I.pack(length)) 00407 pattern = '<%sd'%length 00408 buff.write(struct.pack(pattern, *val1.dimensions)) 00409 length = len(val1.triangles) 00410 buff.write(_struct_I.pack(length)) 00411 pattern = '<%si'%length 00412 buff.write(struct.pack(pattern, *val1.triangles)) 00413 length = len(val1.vertices) 00414 buff.write(_struct_I.pack(length)) 00415 for val2 in val1.vertices: 00416 _x = val2 00417 buff.write(_struct_3d.pack(_x.x, _x.y, _x.z)) 00418 length = len(self.feedback.paused_collision_map.poses) 00419 buff.write(_struct_I.pack(length)) 00420 for val1 in self.feedback.paused_collision_map.poses: 00421 _v5 = val1.position 00422 _x = _v5 00423 buff.write(_struct_3d.pack(_x.x, _x.y, _x.z)) 00424 _v6 = val1.orientation 00425 _x = _v6 00426 buff.write(_struct_4d.pack(_x.x, _x.y, _x.z, _x.w)) 00427 except struct.error as se: self._check_types(se) 00428 except TypeError as te: self._check_types(te) 00429 00430 def deserialize(self, str): 00431 """ 00432 unpack serialized message in str into this message instance 00433 @param str: byte array of serialized message 00434 @type str: str 00435 """ 00436 try: 00437 if self.header is None: 00438 self.header = std_msgs.msg._Header.Header() 00439 if self.status is None: 00440 self.status = actionlib_msgs.msg.GoalStatus() 00441 if self.feedback is None: 00442 self.feedback = head_monitor_msgs.msg.HeadMonitorFeedback() 00443 end = 0 00444 _x = self 00445 start = end 00446 end += 12 00447 (_x.header.seq, _x.header.stamp.secs, _x.header.stamp.nsecs,) = _struct_3I.unpack(str[start:end]) 00448 start = end 00449 end += 4 00450 (length,) = _struct_I.unpack(str[start:end]) 00451 start = end 00452 end += length 00453 self.header.frame_id = str[start:end] 00454 _x = self 00455 start = end 00456 end += 8 00457 (_x.status.goal_id.stamp.secs, _x.status.goal_id.stamp.nsecs,) = _struct_2I.unpack(str[start:end]) 00458 start = end 00459 end += 4 00460 (length,) = _struct_I.unpack(str[start:end]) 00461 start = end 00462 end += length 00463 self.status.goal_id.id = str[start:end] 00464 start = end 00465 end += 1 00466 (self.status.status,) = _struct_B.unpack(str[start:end]) 00467 start = end 00468 end += 4 00469 (length,) = _struct_I.unpack(str[start:end]) 00470 start = end 00471 end += length 00472 self.status.text = str[start:end] 00473 _x = self 00474 start = end 00475 end += 12 00476 (_x.feedback.current_state.joint_state.header.seq, _x.feedback.current_state.joint_state.header.stamp.secs, _x.feedback.current_state.joint_state.header.stamp.nsecs,) = _struct_3I.unpack(str[start:end]) 00477 start = end 00478 end += 4 00479 (length,) = _struct_I.unpack(str[start:end]) 00480 start = end 00481 end += length 00482 self.feedback.current_state.joint_state.header.frame_id = str[start:end] 00483 start = end 00484 end += 4 00485 (length,) = _struct_I.unpack(str[start:end]) 00486 self.feedback.current_state.joint_state.name = [] 00487 for i in range(0, length): 00488 start = end 00489 end += 4 00490 (length,) = _struct_I.unpack(str[start:end]) 00491 start = end 00492 end += length 00493 val1 = str[start:end] 00494 self.feedback.current_state.joint_state.name.append(val1) 00495 start = end 00496 end += 4 00497 (length,) = _struct_I.unpack(str[start:end]) 00498 pattern = '<%sd'%length 00499 start = end 00500 end += struct.calcsize(pattern) 00501 self.feedback.current_state.joint_state.position = struct.unpack(pattern, str[start:end]) 00502 start = end 00503 end += 4 00504 (length,) = _struct_I.unpack(str[start:end]) 00505 pattern = '<%sd'%length 00506 start = end 00507 end += struct.calcsize(pattern) 00508 self.feedback.current_state.joint_state.velocity = struct.unpack(pattern, str[start:end]) 00509 start = end 00510 end += 4 00511 (length,) = _struct_I.unpack(str[start:end]) 00512 pattern = '<%sd'%length 00513 start = end 00514 end += struct.calcsize(pattern) 00515 self.feedback.current_state.joint_state.effort = struct.unpack(pattern, str[start:end]) 00516 _x = self 00517 start = end 00518 end += 8 00519 (_x.feedback.current_state.multi_dof_joint_state.stamp.secs, _x.feedback.current_state.multi_dof_joint_state.stamp.nsecs,) = _struct_2I.unpack(str[start:end]) 00520 start = end 00521 end += 4 00522 (length,) = _struct_I.unpack(str[start:end]) 00523 self.feedback.current_state.multi_dof_joint_state.joint_names = [] 00524 for i in range(0, length): 00525 start = end 00526 end += 4 00527 (length,) = _struct_I.unpack(str[start:end]) 00528 start = end 00529 end += length 00530 val1 = str[start:end] 00531 self.feedback.current_state.multi_dof_joint_state.joint_names.append(val1) 00532 start = end 00533 end += 4 00534 (length,) = _struct_I.unpack(str[start:end]) 00535 self.feedback.current_state.multi_dof_joint_state.frame_ids = [] 00536 for i in range(0, length): 00537 start = end 00538 end += 4 00539 (length,) = _struct_I.unpack(str[start:end]) 00540 start = end 00541 end += length 00542 val1 = str[start:end] 00543 self.feedback.current_state.multi_dof_joint_state.frame_ids.append(val1) 00544 start = end 00545 end += 4 00546 (length,) = _struct_I.unpack(str[start:end]) 00547 self.feedback.current_state.multi_dof_joint_state.child_frame_ids = [] 00548 for i in range(0, length): 00549 start = end 00550 end += 4 00551 (length,) = _struct_I.unpack(str[start:end]) 00552 start = end 00553 end += length 00554 val1 = str[start:end] 00555 self.feedback.current_state.multi_dof_joint_state.child_frame_ids.append(val1) 00556 start = end 00557 end += 4 00558 (length,) = _struct_I.unpack(str[start:end]) 00559 self.feedback.current_state.multi_dof_joint_state.poses = [] 00560 for i in range(0, length): 00561 val1 = geometry_msgs.msg.Pose() 00562 _v7 = val1.position 00563 _x = _v7 00564 start = end 00565 end += 24 00566 (_x.x, _x.y, _x.z,) = _struct_3d.unpack(str[start:end]) 00567 _v8 = val1.orientation 00568 _x = _v8 00569 start = end 00570 end += 32 00571 (_x.x, _x.y, _x.z, _x.w,) = _struct_4d.unpack(str[start:end]) 00572 self.feedback.current_state.multi_dof_joint_state.poses.append(val1) 00573 _x = self 00574 start = end 00575 end += 12 00576 (_x.feedback.paused_trajectory_state.joint_state.header.seq, _x.feedback.paused_trajectory_state.joint_state.header.stamp.secs, _x.feedback.paused_trajectory_state.joint_state.header.stamp.nsecs,) = _struct_3I.unpack(str[start:end]) 00577 start = end 00578 end += 4 00579 (length,) = _struct_I.unpack(str[start:end]) 00580 start = end 00581 end += length 00582 self.feedback.paused_trajectory_state.joint_state.header.frame_id = str[start:end] 00583 start = end 00584 end += 4 00585 (length,) = _struct_I.unpack(str[start:end]) 00586 self.feedback.paused_trajectory_state.joint_state.name = [] 00587 for i in range(0, length): 00588 start = end 00589 end += 4 00590 (length,) = _struct_I.unpack(str[start:end]) 00591 start = end 00592 end += length 00593 val1 = str[start:end] 00594 self.feedback.paused_trajectory_state.joint_state.name.append(val1) 00595 start = end 00596 end += 4 00597 (length,) = _struct_I.unpack(str[start:end]) 00598 pattern = '<%sd'%length 00599 start = end 00600 end += struct.calcsize(pattern) 00601 self.feedback.paused_trajectory_state.joint_state.position = struct.unpack(pattern, str[start:end]) 00602 start = end 00603 end += 4 00604 (length,) = _struct_I.unpack(str[start:end]) 00605 pattern = '<%sd'%length 00606 start = end 00607 end += struct.calcsize(pattern) 00608 self.feedback.paused_trajectory_state.joint_state.velocity = struct.unpack(pattern, str[start:end]) 00609 start = end 00610 end += 4 00611 (length,) = _struct_I.unpack(str[start:end]) 00612 pattern = '<%sd'%length 00613 start = end 00614 end += struct.calcsize(pattern) 00615 self.feedback.paused_trajectory_state.joint_state.effort = struct.unpack(pattern, str[start:end]) 00616 _x = self 00617 start = end 00618 end += 8 00619 (_x.feedback.paused_trajectory_state.multi_dof_joint_state.stamp.secs, _x.feedback.paused_trajectory_state.multi_dof_joint_state.stamp.nsecs,) = _struct_2I.unpack(str[start:end]) 00620 start = end 00621 end += 4 00622 (length,) = _struct_I.unpack(str[start:end]) 00623 self.feedback.paused_trajectory_state.multi_dof_joint_state.joint_names = [] 00624 for i in range(0, length): 00625 start = end 00626 end += 4 00627 (length,) = _struct_I.unpack(str[start:end]) 00628 start = end 00629 end += length 00630 val1 = str[start:end] 00631 self.feedback.paused_trajectory_state.multi_dof_joint_state.joint_names.append(val1) 00632 start = end 00633 end += 4 00634 (length,) = _struct_I.unpack(str[start:end]) 00635 self.feedback.paused_trajectory_state.multi_dof_joint_state.frame_ids = [] 00636 for i in range(0, length): 00637 start = end 00638 end += 4 00639 (length,) = _struct_I.unpack(str[start:end]) 00640 start = end 00641 end += length 00642 val1 = str[start:end] 00643 self.feedback.paused_trajectory_state.multi_dof_joint_state.frame_ids.append(val1) 00644 start = end 00645 end += 4 00646 (length,) = _struct_I.unpack(str[start:end]) 00647 self.feedback.paused_trajectory_state.multi_dof_joint_state.child_frame_ids = [] 00648 for i in range(0, length): 00649 start = end 00650 end += 4 00651 (length,) = _struct_I.unpack(str[start:end]) 00652 start = end 00653 end += length 00654 val1 = str[start:end] 00655 self.feedback.paused_trajectory_state.multi_dof_joint_state.child_frame_ids.append(val1) 00656 start = end 00657 end += 4 00658 (length,) = _struct_I.unpack(str[start:end]) 00659 self.feedback.paused_trajectory_state.multi_dof_joint_state.poses = [] 00660 for i in range(0, length): 00661 val1 = geometry_msgs.msg.Pose() 00662 _v9 = val1.position 00663 _x = _v9 00664 start = end 00665 end += 24 00666 (_x.x, _x.y, _x.z,) = _struct_3d.unpack(str[start:end]) 00667 _v10 = val1.orientation 00668 _x = _v10 00669 start = end 00670 end += 32 00671 (_x.x, _x.y, _x.z, _x.w,) = _struct_4d.unpack(str[start:end]) 00672 self.feedback.paused_trajectory_state.multi_dof_joint_state.poses.append(val1) 00673 _x = self 00674 start = end 00675 end += 12 00676 (_x.feedback.paused_collision_map.header.seq, _x.feedback.paused_collision_map.header.stamp.secs, _x.feedback.paused_collision_map.header.stamp.nsecs,) = _struct_3I.unpack(str[start:end]) 00677 start = end 00678 end += 4 00679 (length,) = _struct_I.unpack(str[start:end]) 00680 start = end 00681 end += length 00682 self.feedback.paused_collision_map.header.frame_id = str[start:end] 00683 start = end 00684 end += 4 00685 (length,) = _struct_I.unpack(str[start:end]) 00686 start = end 00687 end += length 00688 self.feedback.paused_collision_map.id = str[start:end] 00689 _x = self 00690 start = end 00691 end += 5 00692 (_x.feedback.paused_collision_map.padding, _x.feedback.paused_collision_map.operation.operation,) = _struct_fb.unpack(str[start:end]) 00693 start = end 00694 end += 4 00695 (length,) = _struct_I.unpack(str[start:end]) 00696 self.feedback.paused_collision_map.shapes = [] 00697 for i in range(0, length): 00698 val1 = arm_navigation_msgs.msg.Shape() 00699 start = end 00700 end += 1 00701 (val1.type,) = _struct_b.unpack(str[start:end]) 00702 start = end 00703 end += 4 00704 (length,) = _struct_I.unpack(str[start:end]) 00705 pattern = '<%sd'%length 00706 start = end 00707 end += struct.calcsize(pattern) 00708 val1.dimensions = struct.unpack(pattern, str[start:end]) 00709 start = end 00710 end += 4 00711 (length,) = _struct_I.unpack(str[start:end]) 00712 pattern = '<%si'%length 00713 start = end 00714 end += struct.calcsize(pattern) 00715 val1.triangles = struct.unpack(pattern, str[start:end]) 00716 start = end 00717 end += 4 00718 (length,) = _struct_I.unpack(str[start:end]) 00719 val1.vertices = [] 00720 for i in range(0, length): 00721 val2 = geometry_msgs.msg.Point() 00722 _x = val2 00723 start = end 00724 end += 24 00725 (_x.x, _x.y, _x.z,) = _struct_3d.unpack(str[start:end]) 00726 val1.vertices.append(val2) 00727 self.feedback.paused_collision_map.shapes.append(val1) 00728 start = end 00729 end += 4 00730 (length,) = _struct_I.unpack(str[start:end]) 00731 self.feedback.paused_collision_map.poses = [] 00732 for i in range(0, length): 00733 val1 = geometry_msgs.msg.Pose() 00734 _v11 = val1.position 00735 _x = _v11 00736 start = end 00737 end += 24 00738 (_x.x, _x.y, _x.z,) = _struct_3d.unpack(str[start:end]) 00739 _v12 = val1.orientation 00740 _x = _v12 00741 start = end 00742 end += 32 00743 (_x.x, _x.y, _x.z, _x.w,) = _struct_4d.unpack(str[start:end]) 00744 self.feedback.paused_collision_map.poses.append(val1) 00745 return self 00746 except struct.error as e: 00747 raise roslib.message.DeserializationError(e) #most likely buffer underfill 00748 00749 00750 def serialize_numpy(self, buff, numpy): 00751 """ 00752 serialize message with numpy array types into buffer 00753 @param buff: buffer 00754 @type buff: StringIO 00755 @param numpy: numpy python module 00756 @type numpy module 00757 """ 00758 try: 00759 _x = self 00760 buff.write(_struct_3I.pack(_x.header.seq, _x.header.stamp.secs, _x.header.stamp.nsecs)) 00761 _x = self.header.frame_id 00762 length = len(_x) 00763 buff.write(struct.pack('<I%ss'%length, length, _x)) 00764 _x = self 00765 buff.write(_struct_2I.pack(_x.status.goal_id.stamp.secs, _x.status.goal_id.stamp.nsecs)) 00766 _x = self.status.goal_id.id 00767 length = len(_x) 00768 buff.write(struct.pack('<I%ss'%length, length, _x)) 00769 buff.write(_struct_B.pack(self.status.status)) 00770 _x = self.status.text 00771 length = len(_x) 00772 buff.write(struct.pack('<I%ss'%length, length, _x)) 00773 _x = self 00774 buff.write(_struct_3I.pack(_x.feedback.current_state.joint_state.header.seq, _x.feedback.current_state.joint_state.header.stamp.secs, _x.feedback.current_state.joint_state.header.stamp.nsecs)) 00775 _x = self.feedback.current_state.joint_state.header.frame_id 00776 length = len(_x) 00777 buff.write(struct.pack('<I%ss'%length, length, _x)) 00778 length = len(self.feedback.current_state.joint_state.name) 00779 buff.write(_struct_I.pack(length)) 00780 for val1 in self.feedback.current_state.joint_state.name: 00781 length = len(val1) 00782 buff.write(struct.pack('<I%ss'%length, length, val1)) 00783 length = len(self.feedback.current_state.joint_state.position) 00784 buff.write(_struct_I.pack(length)) 00785 pattern = '<%sd'%length 00786 buff.write(self.feedback.current_state.joint_state.position.tostring()) 00787 length = len(self.feedback.current_state.joint_state.velocity) 00788 buff.write(_struct_I.pack(length)) 00789 pattern = '<%sd'%length 00790 buff.write(self.feedback.current_state.joint_state.velocity.tostring()) 00791 length = len(self.feedback.current_state.joint_state.effort) 00792 buff.write(_struct_I.pack(length)) 00793 pattern = '<%sd'%length 00794 buff.write(self.feedback.current_state.joint_state.effort.tostring()) 00795 _x = self 00796 buff.write(_struct_2I.pack(_x.feedback.current_state.multi_dof_joint_state.stamp.secs, _x.feedback.current_state.multi_dof_joint_state.stamp.nsecs)) 00797 length = len(self.feedback.current_state.multi_dof_joint_state.joint_names) 00798 buff.write(_struct_I.pack(length)) 00799 for val1 in self.feedback.current_state.multi_dof_joint_state.joint_names: 00800 length = len(val1) 00801 buff.write(struct.pack('<I%ss'%length, length, val1)) 00802 length = len(self.feedback.current_state.multi_dof_joint_state.frame_ids) 00803 buff.write(_struct_I.pack(length)) 00804 for val1 in self.feedback.current_state.multi_dof_joint_state.frame_ids: 00805 length = len(val1) 00806 buff.write(struct.pack('<I%ss'%length, length, val1)) 00807 length = len(self.feedback.current_state.multi_dof_joint_state.child_frame_ids) 00808 buff.write(_struct_I.pack(length)) 00809 for val1 in self.feedback.current_state.multi_dof_joint_state.child_frame_ids: 00810 length = len(val1) 00811 buff.write(struct.pack('<I%ss'%length, length, val1)) 00812 length = len(self.feedback.current_state.multi_dof_joint_state.poses) 00813 buff.write(_struct_I.pack(length)) 00814 for val1 in self.feedback.current_state.multi_dof_joint_state.poses: 00815 _v13 = val1.position 00816 _x = _v13 00817 buff.write(_struct_3d.pack(_x.x, _x.y, _x.z)) 00818 _v14 = val1.orientation 00819 _x = _v14 00820 buff.write(_struct_4d.pack(_x.x, _x.y, _x.z, _x.w)) 00821 _x = self 00822 buff.write(_struct_3I.pack(_x.feedback.paused_trajectory_state.joint_state.header.seq, _x.feedback.paused_trajectory_state.joint_state.header.stamp.secs, _x.feedback.paused_trajectory_state.joint_state.header.stamp.nsecs)) 00823 _x = self.feedback.paused_trajectory_state.joint_state.header.frame_id 00824 length = len(_x) 00825 buff.write(struct.pack('<I%ss'%length, length, _x)) 00826 length = len(self.feedback.paused_trajectory_state.joint_state.name) 00827 buff.write(_struct_I.pack(length)) 00828 for val1 in self.feedback.paused_trajectory_state.joint_state.name: 00829 length = len(val1) 00830 buff.write(struct.pack('<I%ss'%length, length, val1)) 00831 length = len(self.feedback.paused_trajectory_state.joint_state.position) 00832 buff.write(_struct_I.pack(length)) 00833 pattern = '<%sd'%length 00834 buff.write(self.feedback.paused_trajectory_state.joint_state.position.tostring()) 00835 length = len(self.feedback.paused_trajectory_state.joint_state.velocity) 00836 buff.write(_struct_I.pack(length)) 00837 pattern = '<%sd'%length 00838 buff.write(self.feedback.paused_trajectory_state.joint_state.velocity.tostring()) 00839 length = len(self.feedback.paused_trajectory_state.joint_state.effort) 00840 buff.write(_struct_I.pack(length)) 00841 pattern = '<%sd'%length 00842 buff.write(self.feedback.paused_trajectory_state.joint_state.effort.tostring()) 00843 _x = self 00844 buff.write(_struct_2I.pack(_x.feedback.paused_trajectory_state.multi_dof_joint_state.stamp.secs, _x.feedback.paused_trajectory_state.multi_dof_joint_state.stamp.nsecs)) 00845 length = len(self.feedback.paused_trajectory_state.multi_dof_joint_state.joint_names) 00846 buff.write(_struct_I.pack(length)) 00847 for val1 in self.feedback.paused_trajectory_state.multi_dof_joint_state.joint_names: 00848 length = len(val1) 00849 buff.write(struct.pack('<I%ss'%length, length, val1)) 00850 length = len(self.feedback.paused_trajectory_state.multi_dof_joint_state.frame_ids) 00851 buff.write(_struct_I.pack(length)) 00852 for val1 in self.feedback.paused_trajectory_state.multi_dof_joint_state.frame_ids: 00853 length = len(val1) 00854 buff.write(struct.pack('<I%ss'%length, length, val1)) 00855 length = len(self.feedback.paused_trajectory_state.multi_dof_joint_state.child_frame_ids) 00856 buff.write(_struct_I.pack(length)) 00857 for val1 in self.feedback.paused_trajectory_state.multi_dof_joint_state.child_frame_ids: 00858 length = len(val1) 00859 buff.write(struct.pack('<I%ss'%length, length, val1)) 00860 length = len(self.feedback.paused_trajectory_state.multi_dof_joint_state.poses) 00861 buff.write(_struct_I.pack(length)) 00862 for val1 in self.feedback.paused_trajectory_state.multi_dof_joint_state.poses: 00863 _v15 = val1.position 00864 _x = _v15 00865 buff.write(_struct_3d.pack(_x.x, _x.y, _x.z)) 00866 _v16 = val1.orientation 00867 _x = _v16 00868 buff.write(_struct_4d.pack(_x.x, _x.y, _x.z, _x.w)) 00869 _x = self 00870 buff.write(_struct_3I.pack(_x.feedback.paused_collision_map.header.seq, _x.feedback.paused_collision_map.header.stamp.secs, _x.feedback.paused_collision_map.header.stamp.nsecs)) 00871 _x = self.feedback.paused_collision_map.header.frame_id 00872 length = len(_x) 00873 buff.write(struct.pack('<I%ss'%length, length, _x)) 00874 _x = self.feedback.paused_collision_map.id 00875 length = len(_x) 00876 buff.write(struct.pack('<I%ss'%length, length, _x)) 00877 _x = self 00878 buff.write(_struct_fb.pack(_x.feedback.paused_collision_map.padding, _x.feedback.paused_collision_map.operation.operation)) 00879 length = len(self.feedback.paused_collision_map.shapes) 00880 buff.write(_struct_I.pack(length)) 00881 for val1 in self.feedback.paused_collision_map.shapes: 00882 buff.write(_struct_b.pack(val1.type)) 00883 length = len(val1.dimensions) 00884 buff.write(_struct_I.pack(length)) 00885 pattern = '<%sd'%length 00886 buff.write(val1.dimensions.tostring()) 00887 length = len(val1.triangles) 00888 buff.write(_struct_I.pack(length)) 00889 pattern = '<%si'%length 00890 buff.write(val1.triangles.tostring()) 00891 length = len(val1.vertices) 00892 buff.write(_struct_I.pack(length)) 00893 for val2 in val1.vertices: 00894 _x = val2 00895 buff.write(_struct_3d.pack(_x.x, _x.y, _x.z)) 00896 length = len(self.feedback.paused_collision_map.poses) 00897 buff.write(_struct_I.pack(length)) 00898 for val1 in self.feedback.paused_collision_map.poses: 00899 _v17 = val1.position 00900 _x = _v17 00901 buff.write(_struct_3d.pack(_x.x, _x.y, _x.z)) 00902 _v18 = val1.orientation 00903 _x = _v18 00904 buff.write(_struct_4d.pack(_x.x, _x.y, _x.z, _x.w)) 00905 except struct.error as se: self._check_types(se) 00906 except TypeError as te: self._check_types(te) 00907 00908 def deserialize_numpy(self, str, numpy): 00909 """ 00910 unpack serialized message in str into this message instance using numpy for array types 00911 @param str: byte array of serialized message 00912 @type str: str 00913 @param numpy: numpy python module 00914 @type numpy: module 00915 """ 00916 try: 00917 if self.header is None: 00918 self.header = std_msgs.msg._Header.Header() 00919 if self.status is None: 00920 self.status = actionlib_msgs.msg.GoalStatus() 00921 if self.feedback is None: 00922 self.feedback = head_monitor_msgs.msg.HeadMonitorFeedback() 00923 end = 0 00924 _x = self 00925 start = end 00926 end += 12 00927 (_x.header.seq, _x.header.stamp.secs, _x.header.stamp.nsecs,) = _struct_3I.unpack(str[start:end]) 00928 start = end 00929 end += 4 00930 (length,) = _struct_I.unpack(str[start:end]) 00931 start = end 00932 end += length 00933 self.header.frame_id = str[start:end] 00934 _x = self 00935 start = end 00936 end += 8 00937 (_x.status.goal_id.stamp.secs, _x.status.goal_id.stamp.nsecs,) = _struct_2I.unpack(str[start:end]) 00938 start = end 00939 end += 4 00940 (length,) = _struct_I.unpack(str[start:end]) 00941 start = end 00942 end += length 00943 self.status.goal_id.id = str[start:end] 00944 start = end 00945 end += 1 00946 (self.status.status,) = _struct_B.unpack(str[start:end]) 00947 start = end 00948 end += 4 00949 (length,) = _struct_I.unpack(str[start:end]) 00950 start = end 00951 end += length 00952 self.status.text = str[start:end] 00953 _x = self 00954 start = end 00955 end += 12 00956 (_x.feedback.current_state.joint_state.header.seq, _x.feedback.current_state.joint_state.header.stamp.secs, _x.feedback.current_state.joint_state.header.stamp.nsecs,) = _struct_3I.unpack(str[start:end]) 00957 start = end 00958 end += 4 00959 (length,) = _struct_I.unpack(str[start:end]) 00960 start = end 00961 end += length 00962 self.feedback.current_state.joint_state.header.frame_id = str[start:end] 00963 start = end 00964 end += 4 00965 (length,) = _struct_I.unpack(str[start:end]) 00966 self.feedback.current_state.joint_state.name = [] 00967 for i in range(0, length): 00968 start = end 00969 end += 4 00970 (length,) = _struct_I.unpack(str[start:end]) 00971 start = end 00972 end += length 00973 val1 = str[start:end] 00974 self.feedback.current_state.joint_state.name.append(val1) 00975 start = end 00976 end += 4 00977 (length,) = _struct_I.unpack(str[start:end]) 00978 pattern = '<%sd'%length 00979 start = end 00980 end += struct.calcsize(pattern) 00981 self.feedback.current_state.joint_state.position = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length) 00982 start = end 00983 end += 4 00984 (length,) = _struct_I.unpack(str[start:end]) 00985 pattern = '<%sd'%length 00986 start = end 00987 end += struct.calcsize(pattern) 00988 self.feedback.current_state.joint_state.velocity = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length) 00989 start = end 00990 end += 4 00991 (length,) = _struct_I.unpack(str[start:end]) 00992 pattern = '<%sd'%length 00993 start = end 00994 end += struct.calcsize(pattern) 00995 self.feedback.current_state.joint_state.effort = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length) 00996 _x = self 00997 start = end 00998 end += 8 00999 (_x.feedback.current_state.multi_dof_joint_state.stamp.secs, _x.feedback.current_state.multi_dof_joint_state.stamp.nsecs,) = _struct_2I.unpack(str[start:end]) 01000 start = end 01001 end += 4 01002 (length,) = _struct_I.unpack(str[start:end]) 01003 self.feedback.current_state.multi_dof_joint_state.joint_names = [] 01004 for i in range(0, length): 01005 start = end 01006 end += 4 01007 (length,) = _struct_I.unpack(str[start:end]) 01008 start = end 01009 end += length 01010 val1 = str[start:end] 01011 self.feedback.current_state.multi_dof_joint_state.joint_names.append(val1) 01012 start = end 01013 end += 4 01014 (length,) = _struct_I.unpack(str[start:end]) 01015 self.feedback.current_state.multi_dof_joint_state.frame_ids = [] 01016 for i in range(0, length): 01017 start = end 01018 end += 4 01019 (length,) = _struct_I.unpack(str[start:end]) 01020 start = end 01021 end += length 01022 val1 = str[start:end] 01023 self.feedback.current_state.multi_dof_joint_state.frame_ids.append(val1) 01024 start = end 01025 end += 4 01026 (length,) = _struct_I.unpack(str[start:end]) 01027 self.feedback.current_state.multi_dof_joint_state.child_frame_ids = [] 01028 for i in range(0, length): 01029 start = end 01030 end += 4 01031 (length,) = _struct_I.unpack(str[start:end]) 01032 start = end 01033 end += length 01034 val1 = str[start:end] 01035 self.feedback.current_state.multi_dof_joint_state.child_frame_ids.append(val1) 01036 start = end 01037 end += 4 01038 (length,) = _struct_I.unpack(str[start:end]) 01039 self.feedback.current_state.multi_dof_joint_state.poses = [] 01040 for i in range(0, length): 01041 val1 = geometry_msgs.msg.Pose() 01042 _v19 = val1.position 01043 _x = _v19 01044 start = end 01045 end += 24 01046 (_x.x, _x.y, _x.z,) = _struct_3d.unpack(str[start:end]) 01047 _v20 = val1.orientation 01048 _x = _v20 01049 start = end 01050 end += 32 01051 (_x.x, _x.y, _x.z, _x.w,) = _struct_4d.unpack(str[start:end]) 01052 self.feedback.current_state.multi_dof_joint_state.poses.append(val1) 01053 _x = self 01054 start = end 01055 end += 12 01056 (_x.feedback.paused_trajectory_state.joint_state.header.seq, _x.feedback.paused_trajectory_state.joint_state.header.stamp.secs, _x.feedback.paused_trajectory_state.joint_state.header.stamp.nsecs,) = _struct_3I.unpack(str[start:end]) 01057 start = end 01058 end += 4 01059 (length,) = _struct_I.unpack(str[start:end]) 01060 start = end 01061 end += length 01062 self.feedback.paused_trajectory_state.joint_state.header.frame_id = str[start:end] 01063 start = end 01064 end += 4 01065 (length,) = _struct_I.unpack(str[start:end]) 01066 self.feedback.paused_trajectory_state.joint_state.name = [] 01067 for i in range(0, length): 01068 start = end 01069 end += 4 01070 (length,) = _struct_I.unpack(str[start:end]) 01071 start = end 01072 end += length 01073 val1 = str[start:end] 01074 self.feedback.paused_trajectory_state.joint_state.name.append(val1) 01075 start = end 01076 end += 4 01077 (length,) = _struct_I.unpack(str[start:end]) 01078 pattern = '<%sd'%length 01079 start = end 01080 end += struct.calcsize(pattern) 01081 self.feedback.paused_trajectory_state.joint_state.position = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length) 01082 start = end 01083 end += 4 01084 (length,) = _struct_I.unpack(str[start:end]) 01085 pattern = '<%sd'%length 01086 start = end 01087 end += struct.calcsize(pattern) 01088 self.feedback.paused_trajectory_state.joint_state.velocity = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length) 01089 start = end 01090 end += 4 01091 (length,) = _struct_I.unpack(str[start:end]) 01092 pattern = '<%sd'%length 01093 start = end 01094 end += struct.calcsize(pattern) 01095 self.feedback.paused_trajectory_state.joint_state.effort = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length) 01096 _x = self 01097 start = end 01098 end += 8 01099 (_x.feedback.paused_trajectory_state.multi_dof_joint_state.stamp.secs, _x.feedback.paused_trajectory_state.multi_dof_joint_state.stamp.nsecs,) = _struct_2I.unpack(str[start:end]) 01100 start = end 01101 end += 4 01102 (length,) = _struct_I.unpack(str[start:end]) 01103 self.feedback.paused_trajectory_state.multi_dof_joint_state.joint_names = [] 01104 for i in range(0, length): 01105 start = end 01106 end += 4 01107 (length,) = _struct_I.unpack(str[start:end]) 01108 start = end 01109 end += length 01110 val1 = str[start:end] 01111 self.feedback.paused_trajectory_state.multi_dof_joint_state.joint_names.append(val1) 01112 start = end 01113 end += 4 01114 (length,) = _struct_I.unpack(str[start:end]) 01115 self.feedback.paused_trajectory_state.multi_dof_joint_state.frame_ids = [] 01116 for i in range(0, length): 01117 start = end 01118 end += 4 01119 (length,) = _struct_I.unpack(str[start:end]) 01120 start = end 01121 end += length 01122 val1 = str[start:end] 01123 self.feedback.paused_trajectory_state.multi_dof_joint_state.frame_ids.append(val1) 01124 start = end 01125 end += 4 01126 (length,) = _struct_I.unpack(str[start:end]) 01127 self.feedback.paused_trajectory_state.multi_dof_joint_state.child_frame_ids = [] 01128 for i in range(0, length): 01129 start = end 01130 end += 4 01131 (length,) = _struct_I.unpack(str[start:end]) 01132 start = end 01133 end += length 01134 val1 = str[start:end] 01135 self.feedback.paused_trajectory_state.multi_dof_joint_state.child_frame_ids.append(val1) 01136 start = end 01137 end += 4 01138 (length,) = _struct_I.unpack(str[start:end]) 01139 self.feedback.paused_trajectory_state.multi_dof_joint_state.poses = [] 01140 for i in range(0, length): 01141 val1 = geometry_msgs.msg.Pose() 01142 _v21 = val1.position 01143 _x = _v21 01144 start = end 01145 end += 24 01146 (_x.x, _x.y, _x.z,) = _struct_3d.unpack(str[start:end]) 01147 _v22 = val1.orientation 01148 _x = _v22 01149 start = end 01150 end += 32 01151 (_x.x, _x.y, _x.z, _x.w,) = _struct_4d.unpack(str[start:end]) 01152 self.feedback.paused_trajectory_state.multi_dof_joint_state.poses.append(val1) 01153 _x = self 01154 start = end 01155 end += 12 01156 (_x.feedback.paused_collision_map.header.seq, _x.feedback.paused_collision_map.header.stamp.secs, _x.feedback.paused_collision_map.header.stamp.nsecs,) = _struct_3I.unpack(str[start:end]) 01157 start = end 01158 end += 4 01159 (length,) = _struct_I.unpack(str[start:end]) 01160 start = end 01161 end += length 01162 self.feedback.paused_collision_map.header.frame_id = str[start:end] 01163 start = end 01164 end += 4 01165 (length,) = _struct_I.unpack(str[start:end]) 01166 start = end 01167 end += length 01168 self.feedback.paused_collision_map.id = str[start:end] 01169 _x = self 01170 start = end 01171 end += 5 01172 (_x.feedback.paused_collision_map.padding, _x.feedback.paused_collision_map.operation.operation,) = _struct_fb.unpack(str[start:end]) 01173 start = end 01174 end += 4 01175 (length,) = _struct_I.unpack(str[start:end]) 01176 self.feedback.paused_collision_map.shapes = [] 01177 for i in range(0, length): 01178 val1 = arm_navigation_msgs.msg.Shape() 01179 start = end 01180 end += 1 01181 (val1.type,) = _struct_b.unpack(str[start:end]) 01182 start = end 01183 end += 4 01184 (length,) = _struct_I.unpack(str[start:end]) 01185 pattern = '<%sd'%length 01186 start = end 01187 end += struct.calcsize(pattern) 01188 val1.dimensions = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length) 01189 start = end 01190 end += 4 01191 (length,) = _struct_I.unpack(str[start:end]) 01192 pattern = '<%si'%length 01193 start = end 01194 end += struct.calcsize(pattern) 01195 val1.triangles = numpy.frombuffer(str[start:end], dtype=numpy.int32, count=length) 01196 start = end 01197 end += 4 01198 (length,) = _struct_I.unpack(str[start:end]) 01199 val1.vertices = [] 01200 for i in range(0, length): 01201 val2 = geometry_msgs.msg.Point() 01202 _x = val2 01203 start = end 01204 end += 24 01205 (_x.x, _x.y, _x.z,) = _struct_3d.unpack(str[start:end]) 01206 val1.vertices.append(val2) 01207 self.feedback.paused_collision_map.shapes.append(val1) 01208 start = end 01209 end += 4 01210 (length,) = _struct_I.unpack(str[start:end]) 01211 self.feedback.paused_collision_map.poses = [] 01212 for i in range(0, length): 01213 val1 = geometry_msgs.msg.Pose() 01214 _v23 = val1.position 01215 _x = _v23 01216 start = end 01217 end += 24 01218 (_x.x, _x.y, _x.z,) = _struct_3d.unpack(str[start:end]) 01219 _v24 = val1.orientation 01220 _x = _v24 01221 start = end 01222 end += 32 01223 (_x.x, _x.y, _x.z, _x.w,) = _struct_4d.unpack(str[start:end]) 01224 self.feedback.paused_collision_map.poses.append(val1) 01225 return self 01226 except struct.error as e: 01227 raise roslib.message.DeserializationError(e) #most likely buffer underfill 01228 01229 _struct_I = roslib.message.struct_I 01230 _struct_B = struct.Struct("<B") 01231 _struct_3I = struct.Struct("<3I") 01232 _struct_fb = struct.Struct("<fb") 01233 _struct_b = struct.Struct("<b") 01234 _struct_4d = struct.Struct("<4d") 01235 _struct_2I = struct.Struct("<2I") 01236 _struct_3d = struct.Struct("<3d")