$search
00001 """autogenerated by genmsg_py from EECartImpedActionFeedback.msg. Do not edit.""" 00002 import roslib.message 00003 import struct 00004 00005 import ee_cart_imped_msgs.msg 00006 import geometry_msgs.msg 00007 import roslib.rostime 00008 import actionlib_msgs.msg 00009 import std_msgs.msg 00010 00011 class EECartImpedActionFeedback(roslib.message.Message): 00012 _md5sum = "cf14a7f10d332262a83da91f99884b31" 00013 _type = "ee_cart_imped_msgs/EECartImpedActionFeedback" 00014 _has_header = True #flag to mark the presence of a Header object 00015 _full_text = """# ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ====== 00016 00017 Header header 00018 actionlib_msgs/GoalStatus status 00019 EECartImpedFeedback feedback 00020 00021 ================================================================================ 00022 MSG: std_msgs/Header 00023 # Standard metadata for higher-level stamped data types. 00024 # This is generally used to communicate timestamped data 00025 # in a particular coordinate frame. 00026 # 00027 # sequence ID: consecutively increasing ID 00028 uint32 seq 00029 #Two-integer timestamp that is expressed as: 00030 # * stamp.secs: seconds (stamp_secs) since epoch 00031 # * stamp.nsecs: nanoseconds since stamp_secs 00032 # time-handling sugar is provided by the client library 00033 time stamp 00034 #Frame this data is associated with 00035 # 0: no frame 00036 # 1: global frame 00037 string frame_id 00038 00039 ================================================================================ 00040 MSG: actionlib_msgs/GoalStatus 00041 GoalID goal_id 00042 uint8 status 00043 uint8 PENDING = 0 # The goal has yet to be processed by the action server 00044 uint8 ACTIVE = 1 # The goal is currently being processed by the action server 00045 uint8 PREEMPTED = 2 # The goal received a cancel request after it started executing 00046 # and has since completed its execution (Terminal State) 00047 uint8 SUCCEEDED = 3 # The goal was achieved successfully by the action server (Terminal State) 00048 uint8 ABORTED = 4 # The goal was aborted during execution by the action server due 00049 # to some failure (Terminal State) 00050 uint8 REJECTED = 5 # The goal was rejected by the action server without being processed, 00051 # because the goal was unattainable or invalid (Terminal State) 00052 uint8 PREEMPTING = 6 # The goal received a cancel request after it started executing 00053 # and has not yet completed execution 00054 uint8 RECALLING = 7 # The goal received a cancel request before it started executing, 00055 # but the action server has not yet confirmed that the goal is canceled 00056 uint8 RECALLED = 8 # The goal received a cancel request before it started executing 00057 # and was successfully cancelled (Terminal State) 00058 uint8 LOST = 9 # An action client can determine that a goal is LOST. This should not be 00059 # sent over the wire by an action server 00060 00061 #Allow for the user to associate a string with GoalStatus for debugging 00062 string text 00063 00064 00065 ================================================================================ 00066 MSG: actionlib_msgs/GoalID 00067 # The stamp should store the time at which this goal was requested. 00068 # It is used by an action server when it tries to preempt all 00069 # goals that were requested before a certain time 00070 time stamp 00071 00072 # The id provides a way to associate feedback and 00073 # result message with specific goal requests. The id 00074 # specified must be unique. 00075 string id 00076 00077 00078 ================================================================================ 00079 MSG: ee_cart_imped_msgs/EECartImpedFeedback 00080 # ====== DO NOT MODIFY! AUTOGENERATED FROM AN ACTION DEFINITION ====== 00081 #feedback 00082 #current pose and squared error in force 00083 #and the running time of this goal so far 00084 Header header 00085 ee_cart_imped_msgs/StiffPoint[] goal 00086 ee_cart_imped_msgs/StiffPoint initial_point 00087 ee_cart_imped_msgs/StiffPoint desired 00088 ee_cart_imped_msgs/StiffPoint actual_pose 00089 float64 effort_sq_error 00090 float64[] requested_joint_efforts 00091 float64[] actual_joint_efforts 00092 duration running_time 00093 00094 00095 00096 ================================================================================ 00097 MSG: ee_cart_imped_msgs/StiffPoint 00098 Header header 00099 #The pose to achieve in the stiffness directions 00100 geometry_msgs/Pose pose 00101 #Wrench or stiffness for each dimension 00102 geometry_msgs/Wrench wrench_or_stiffness 00103 #The following are True if a force/torque should 00104 #be exerted and False if a stiffness should be used. 00105 bool isForceX 00106 bool isForceY 00107 bool isForceZ 00108 bool isTorqueX 00109 bool isTorqueY 00110 bool isTorqueZ 00111 #The time from the start of the trajectory that this 00112 #point should be achieved. 00113 duration time_from_start 00114 ================================================================================ 00115 MSG: geometry_msgs/Pose 00116 # A representation of pose in free space, composed of postion and orientation. 00117 Point position 00118 Quaternion orientation 00119 00120 ================================================================================ 00121 MSG: geometry_msgs/Point 00122 # This contains the position of a point in free space 00123 float64 x 00124 float64 y 00125 float64 z 00126 00127 ================================================================================ 00128 MSG: geometry_msgs/Quaternion 00129 # This represents an orientation in free space in quaternion form. 00130 00131 float64 x 00132 float64 y 00133 float64 z 00134 float64 w 00135 00136 ================================================================================ 00137 MSG: geometry_msgs/Wrench 00138 # This represents force in free space, seperated into 00139 # it's linear and angular parts. 00140 Vector3 force 00141 Vector3 torque 00142 00143 ================================================================================ 00144 MSG: geometry_msgs/Vector3 00145 # This represents a vector in free space. 00146 00147 float64 x 00148 float64 y 00149 float64 z 00150 """ 00151 __slots__ = ['header','status','feedback'] 00152 _slot_types = ['Header','actionlib_msgs/GoalStatus','ee_cart_imped_msgs/EECartImpedFeedback'] 00153 00154 def __init__(self, *args, **kwds): 00155 """ 00156 Constructor. Any message fields that are implicitly/explicitly 00157 set to None will be assigned a default value. The recommend 00158 use is keyword arguments as this is more robust to future message 00159 changes. You cannot mix in-order arguments and keyword arguments. 00160 00161 The available fields are: 00162 header,status,feedback 00163 00164 @param args: complete set of field values, in .msg order 00165 @param kwds: use keyword arguments corresponding to message field names 00166 to set specific fields. 00167 """ 00168 if args or kwds: 00169 super(EECartImpedActionFeedback, self).__init__(*args, **kwds) 00170 #message fields cannot be None, assign default values for those that are 00171 if self.header is None: 00172 self.header = std_msgs.msg._Header.Header() 00173 if self.status is None: 00174 self.status = actionlib_msgs.msg.GoalStatus() 00175 if self.feedback is None: 00176 self.feedback = ee_cart_imped_msgs.msg.EECartImpedFeedback() 00177 else: 00178 self.header = std_msgs.msg._Header.Header() 00179 self.status = actionlib_msgs.msg.GoalStatus() 00180 self.feedback = ee_cart_imped_msgs.msg.EECartImpedFeedback() 00181 00182 def _get_types(self): 00183 """ 00184 internal API method 00185 """ 00186 return self._slot_types 00187 00188 def serialize(self, buff): 00189 """ 00190 serialize message into buffer 00191 @param buff: buffer 00192 @type buff: StringIO 00193 """ 00194 try: 00195 _x = self 00196 buff.write(_struct_3I.pack(_x.header.seq, _x.header.stamp.secs, _x.header.stamp.nsecs)) 00197 _x = self.header.frame_id 00198 length = len(_x) 00199 buff.write(struct.pack('<I%ss'%length, length, _x)) 00200 _x = self 00201 buff.write(_struct_2I.pack(_x.status.goal_id.stamp.secs, _x.status.goal_id.stamp.nsecs)) 00202 _x = self.status.goal_id.id 00203 length = len(_x) 00204 buff.write(struct.pack('<I%ss'%length, length, _x)) 00205 buff.write(_struct_B.pack(self.status.status)) 00206 _x = self.status.text 00207 length = len(_x) 00208 buff.write(struct.pack('<I%ss'%length, length, _x)) 00209 _x = self 00210 buff.write(_struct_3I.pack(_x.feedback.header.seq, _x.feedback.header.stamp.secs, _x.feedback.header.stamp.nsecs)) 00211 _x = self.feedback.header.frame_id 00212 length = len(_x) 00213 buff.write(struct.pack('<I%ss'%length, length, _x)) 00214 length = len(self.feedback.goal) 00215 buff.write(_struct_I.pack(length)) 00216 for val1 in self.feedback.goal: 00217 _v1 = val1.header 00218 buff.write(_struct_I.pack(_v1.seq)) 00219 _v2 = _v1.stamp 00220 _x = _v2 00221 buff.write(_struct_2I.pack(_x.secs, _x.nsecs)) 00222 _x = _v1.frame_id 00223 length = len(_x) 00224 buff.write(struct.pack('<I%ss'%length, length, _x)) 00225 _v3 = val1.pose 00226 _v4 = _v3.position 00227 _x = _v4 00228 buff.write(_struct_3d.pack(_x.x, _x.y, _x.z)) 00229 _v5 = _v3.orientation 00230 _x = _v5 00231 buff.write(_struct_4d.pack(_x.x, _x.y, _x.z, _x.w)) 00232 _v6 = val1.wrench_or_stiffness 00233 _v7 = _v6.force 00234 _x = _v7 00235 buff.write(_struct_3d.pack(_x.x, _x.y, _x.z)) 00236 _v8 = _v6.torque 00237 _x = _v8 00238 buff.write(_struct_3d.pack(_x.x, _x.y, _x.z)) 00239 _x = val1 00240 buff.write(_struct_6B.pack(_x.isForceX, _x.isForceY, _x.isForceZ, _x.isTorqueX, _x.isTorqueY, _x.isTorqueZ)) 00241 _v9 = val1.time_from_start 00242 _x = _v9 00243 buff.write(_struct_2i.pack(_x.secs, _x.nsecs)) 00244 _x = self 00245 buff.write(_struct_3I.pack(_x.feedback.initial_point.header.seq, _x.feedback.initial_point.header.stamp.secs, _x.feedback.initial_point.header.stamp.nsecs)) 00246 _x = self.feedback.initial_point.header.frame_id 00247 length = len(_x) 00248 buff.write(struct.pack('<I%ss'%length, length, _x)) 00249 _x = self 00250 buff.write(_struct_13d6B2i3I.pack(_x.feedback.initial_point.pose.position.x, _x.feedback.initial_point.pose.position.y, _x.feedback.initial_point.pose.position.z, _x.feedback.initial_point.pose.orientation.x, _x.feedback.initial_point.pose.orientation.y, _x.feedback.initial_point.pose.orientation.z, _x.feedback.initial_point.pose.orientation.w, _x.feedback.initial_point.wrench_or_stiffness.force.x, _x.feedback.initial_point.wrench_or_stiffness.force.y, _x.feedback.initial_point.wrench_or_stiffness.force.z, _x.feedback.initial_point.wrench_or_stiffness.torque.x, _x.feedback.initial_point.wrench_or_stiffness.torque.y, _x.feedback.initial_point.wrench_or_stiffness.torque.z, _x.feedback.initial_point.isForceX, _x.feedback.initial_point.isForceY, _x.feedback.initial_point.isForceZ, _x.feedback.initial_point.isTorqueX, _x.feedback.initial_point.isTorqueY, _x.feedback.initial_point.isTorqueZ, _x.feedback.initial_point.time_from_start.secs, _x.feedback.initial_point.time_from_start.nsecs, _x.feedback.desired.header.seq, _x.feedback.desired.header.stamp.secs, _x.feedback.desired.header.stamp.nsecs)) 00251 _x = self.feedback.desired.header.frame_id 00252 length = len(_x) 00253 buff.write(struct.pack('<I%ss'%length, length, _x)) 00254 _x = self 00255 buff.write(_struct_13d6B2i3I.pack(_x.feedback.desired.pose.position.x, _x.feedback.desired.pose.position.y, _x.feedback.desired.pose.position.z, _x.feedback.desired.pose.orientation.x, _x.feedback.desired.pose.orientation.y, _x.feedback.desired.pose.orientation.z, _x.feedback.desired.pose.orientation.w, _x.feedback.desired.wrench_or_stiffness.force.x, _x.feedback.desired.wrench_or_stiffness.force.y, _x.feedback.desired.wrench_or_stiffness.force.z, _x.feedback.desired.wrench_or_stiffness.torque.x, _x.feedback.desired.wrench_or_stiffness.torque.y, _x.feedback.desired.wrench_or_stiffness.torque.z, _x.feedback.desired.isForceX, _x.feedback.desired.isForceY, _x.feedback.desired.isForceZ, _x.feedback.desired.isTorqueX, _x.feedback.desired.isTorqueY, _x.feedback.desired.isTorqueZ, _x.feedback.desired.time_from_start.secs, _x.feedback.desired.time_from_start.nsecs, _x.feedback.actual_pose.header.seq, _x.feedback.actual_pose.header.stamp.secs, _x.feedback.actual_pose.header.stamp.nsecs)) 00256 _x = self.feedback.actual_pose.header.frame_id 00257 length = len(_x) 00258 buff.write(struct.pack('<I%ss'%length, length, _x)) 00259 _x = self 00260 buff.write(_struct_13d6B2id.pack(_x.feedback.actual_pose.pose.position.x, _x.feedback.actual_pose.pose.position.y, _x.feedback.actual_pose.pose.position.z, _x.feedback.actual_pose.pose.orientation.x, _x.feedback.actual_pose.pose.orientation.y, _x.feedback.actual_pose.pose.orientation.z, _x.feedback.actual_pose.pose.orientation.w, _x.feedback.actual_pose.wrench_or_stiffness.force.x, _x.feedback.actual_pose.wrench_or_stiffness.force.y, _x.feedback.actual_pose.wrench_or_stiffness.force.z, _x.feedback.actual_pose.wrench_or_stiffness.torque.x, _x.feedback.actual_pose.wrench_or_stiffness.torque.y, _x.feedback.actual_pose.wrench_or_stiffness.torque.z, _x.feedback.actual_pose.isForceX, _x.feedback.actual_pose.isForceY, _x.feedback.actual_pose.isForceZ, _x.feedback.actual_pose.isTorqueX, _x.feedback.actual_pose.isTorqueY, _x.feedback.actual_pose.isTorqueZ, _x.feedback.actual_pose.time_from_start.secs, _x.feedback.actual_pose.time_from_start.nsecs, _x.feedback.effort_sq_error)) 00261 length = len(self.feedback.requested_joint_efforts) 00262 buff.write(_struct_I.pack(length)) 00263 pattern = '<%sd'%length 00264 buff.write(struct.pack(pattern, *self.feedback.requested_joint_efforts)) 00265 length = len(self.feedback.actual_joint_efforts) 00266 buff.write(_struct_I.pack(length)) 00267 pattern = '<%sd'%length 00268 buff.write(struct.pack(pattern, *self.feedback.actual_joint_efforts)) 00269 _x = self 00270 buff.write(_struct_2i.pack(_x.feedback.running_time.secs, _x.feedback.running_time.nsecs)) 00271 except struct.error as se: self._check_types(se) 00272 except TypeError as te: self._check_types(te) 00273 00274 def deserialize(self, str): 00275 """ 00276 unpack serialized message in str into this message instance 00277 @param str: byte array of serialized message 00278 @type str: str 00279 """ 00280 try: 00281 if self.header is None: 00282 self.header = std_msgs.msg._Header.Header() 00283 if self.status is None: 00284 self.status = actionlib_msgs.msg.GoalStatus() 00285 if self.feedback is None: 00286 self.feedback = ee_cart_imped_msgs.msg.EECartImpedFeedback() 00287 end = 0 00288 _x = self 00289 start = end 00290 end += 12 00291 (_x.header.seq, _x.header.stamp.secs, _x.header.stamp.nsecs,) = _struct_3I.unpack(str[start:end]) 00292 start = end 00293 end += 4 00294 (length,) = _struct_I.unpack(str[start:end]) 00295 start = end 00296 end += length 00297 self.header.frame_id = str[start:end] 00298 _x = self 00299 start = end 00300 end += 8 00301 (_x.status.goal_id.stamp.secs, _x.status.goal_id.stamp.nsecs,) = _struct_2I.unpack(str[start:end]) 00302 start = end 00303 end += 4 00304 (length,) = _struct_I.unpack(str[start:end]) 00305 start = end 00306 end += length 00307 self.status.goal_id.id = str[start:end] 00308 start = end 00309 end += 1 00310 (self.status.status,) = _struct_B.unpack(str[start:end]) 00311 start = end 00312 end += 4 00313 (length,) = _struct_I.unpack(str[start:end]) 00314 start = end 00315 end += length 00316 self.status.text = str[start:end] 00317 _x = self 00318 start = end 00319 end += 12 00320 (_x.feedback.header.seq, _x.feedback.header.stamp.secs, _x.feedback.header.stamp.nsecs,) = _struct_3I.unpack(str[start:end]) 00321 start = end 00322 end += 4 00323 (length,) = _struct_I.unpack(str[start:end]) 00324 start = end 00325 end += length 00326 self.feedback.header.frame_id = str[start:end] 00327 start = end 00328 end += 4 00329 (length,) = _struct_I.unpack(str[start:end]) 00330 self.feedback.goal = [] 00331 for i in range(0, length): 00332 val1 = ee_cart_imped_msgs.msg.StiffPoint() 00333 _v10 = val1.header 00334 start = end 00335 end += 4 00336 (_v10.seq,) = _struct_I.unpack(str[start:end]) 00337 _v11 = _v10.stamp 00338 _x = _v11 00339 start = end 00340 end += 8 00341 (_x.secs, _x.nsecs,) = _struct_2I.unpack(str[start:end]) 00342 start = end 00343 end += 4 00344 (length,) = _struct_I.unpack(str[start:end]) 00345 start = end 00346 end += length 00347 _v10.frame_id = str[start:end] 00348 _v12 = val1.pose 00349 _v13 = _v12.position 00350 _x = _v13 00351 start = end 00352 end += 24 00353 (_x.x, _x.y, _x.z,) = _struct_3d.unpack(str[start:end]) 00354 _v14 = _v12.orientation 00355 _x = _v14 00356 start = end 00357 end += 32 00358 (_x.x, _x.y, _x.z, _x.w,) = _struct_4d.unpack(str[start:end]) 00359 _v15 = val1.wrench_or_stiffness 00360 _v16 = _v15.force 00361 _x = _v16 00362 start = end 00363 end += 24 00364 (_x.x, _x.y, _x.z,) = _struct_3d.unpack(str[start:end]) 00365 _v17 = _v15.torque 00366 _x = _v17 00367 start = end 00368 end += 24 00369 (_x.x, _x.y, _x.z,) = _struct_3d.unpack(str[start:end]) 00370 _x = val1 00371 start = end 00372 end += 6 00373 (_x.isForceX, _x.isForceY, _x.isForceZ, _x.isTorqueX, _x.isTorqueY, _x.isTorqueZ,) = _struct_6B.unpack(str[start:end]) 00374 val1.isForceX = bool(val1.isForceX) 00375 val1.isForceY = bool(val1.isForceY) 00376 val1.isForceZ = bool(val1.isForceZ) 00377 val1.isTorqueX = bool(val1.isTorqueX) 00378 val1.isTorqueY = bool(val1.isTorqueY) 00379 val1.isTorqueZ = bool(val1.isTorqueZ) 00380 _v18 = val1.time_from_start 00381 _x = _v18 00382 start = end 00383 end += 8 00384 (_x.secs, _x.nsecs,) = _struct_2i.unpack(str[start:end]) 00385 self.feedback.goal.append(val1) 00386 _x = self 00387 start = end 00388 end += 12 00389 (_x.feedback.initial_point.header.seq, _x.feedback.initial_point.header.stamp.secs, _x.feedback.initial_point.header.stamp.nsecs,) = _struct_3I.unpack(str[start:end]) 00390 start = end 00391 end += 4 00392 (length,) = _struct_I.unpack(str[start:end]) 00393 start = end 00394 end += length 00395 self.feedback.initial_point.header.frame_id = str[start:end] 00396 _x = self 00397 start = end 00398 end += 130 00399 (_x.feedback.initial_point.pose.position.x, _x.feedback.initial_point.pose.position.y, _x.feedback.initial_point.pose.position.z, _x.feedback.initial_point.pose.orientation.x, _x.feedback.initial_point.pose.orientation.y, _x.feedback.initial_point.pose.orientation.z, _x.feedback.initial_point.pose.orientation.w, _x.feedback.initial_point.wrench_or_stiffness.force.x, _x.feedback.initial_point.wrench_or_stiffness.force.y, _x.feedback.initial_point.wrench_or_stiffness.force.z, _x.feedback.initial_point.wrench_or_stiffness.torque.x, _x.feedback.initial_point.wrench_or_stiffness.torque.y, _x.feedback.initial_point.wrench_or_stiffness.torque.z, _x.feedback.initial_point.isForceX, _x.feedback.initial_point.isForceY, _x.feedback.initial_point.isForceZ, _x.feedback.initial_point.isTorqueX, _x.feedback.initial_point.isTorqueY, _x.feedback.initial_point.isTorqueZ, _x.feedback.initial_point.time_from_start.secs, _x.feedback.initial_point.time_from_start.nsecs, _x.feedback.desired.header.seq, _x.feedback.desired.header.stamp.secs, _x.feedback.desired.header.stamp.nsecs,) = _struct_13d6B2i3I.unpack(str[start:end]) 00400 self.feedback.initial_point.isForceX = bool(self.feedback.initial_point.isForceX) 00401 self.feedback.initial_point.isForceY = bool(self.feedback.initial_point.isForceY) 00402 self.feedback.initial_point.isForceZ = bool(self.feedback.initial_point.isForceZ) 00403 self.feedback.initial_point.isTorqueX = bool(self.feedback.initial_point.isTorqueX) 00404 self.feedback.initial_point.isTorqueY = bool(self.feedback.initial_point.isTorqueY) 00405 self.feedback.initial_point.isTorqueZ = bool(self.feedback.initial_point.isTorqueZ) 00406 start = end 00407 end += 4 00408 (length,) = _struct_I.unpack(str[start:end]) 00409 start = end 00410 end += length 00411 self.feedback.desired.header.frame_id = str[start:end] 00412 _x = self 00413 start = end 00414 end += 130 00415 (_x.feedback.desired.pose.position.x, _x.feedback.desired.pose.position.y, _x.feedback.desired.pose.position.z, _x.feedback.desired.pose.orientation.x, _x.feedback.desired.pose.orientation.y, _x.feedback.desired.pose.orientation.z, _x.feedback.desired.pose.orientation.w, _x.feedback.desired.wrench_or_stiffness.force.x, _x.feedback.desired.wrench_or_stiffness.force.y, _x.feedback.desired.wrench_or_stiffness.force.z, _x.feedback.desired.wrench_or_stiffness.torque.x, _x.feedback.desired.wrench_or_stiffness.torque.y, _x.feedback.desired.wrench_or_stiffness.torque.z, _x.feedback.desired.isForceX, _x.feedback.desired.isForceY, _x.feedback.desired.isForceZ, _x.feedback.desired.isTorqueX, _x.feedback.desired.isTorqueY, _x.feedback.desired.isTorqueZ, _x.feedback.desired.time_from_start.secs, _x.feedback.desired.time_from_start.nsecs, _x.feedback.actual_pose.header.seq, _x.feedback.actual_pose.header.stamp.secs, _x.feedback.actual_pose.header.stamp.nsecs,) = _struct_13d6B2i3I.unpack(str[start:end]) 00416 self.feedback.desired.isForceX = bool(self.feedback.desired.isForceX) 00417 self.feedback.desired.isForceY = bool(self.feedback.desired.isForceY) 00418 self.feedback.desired.isForceZ = bool(self.feedback.desired.isForceZ) 00419 self.feedback.desired.isTorqueX = bool(self.feedback.desired.isTorqueX) 00420 self.feedback.desired.isTorqueY = bool(self.feedback.desired.isTorqueY) 00421 self.feedback.desired.isTorqueZ = bool(self.feedback.desired.isTorqueZ) 00422 start = end 00423 end += 4 00424 (length,) = _struct_I.unpack(str[start:end]) 00425 start = end 00426 end += length 00427 self.feedback.actual_pose.header.frame_id = str[start:end] 00428 _x = self 00429 start = end 00430 end += 126 00431 (_x.feedback.actual_pose.pose.position.x, _x.feedback.actual_pose.pose.position.y, _x.feedback.actual_pose.pose.position.z, _x.feedback.actual_pose.pose.orientation.x, _x.feedback.actual_pose.pose.orientation.y, _x.feedback.actual_pose.pose.orientation.z, _x.feedback.actual_pose.pose.orientation.w, _x.feedback.actual_pose.wrench_or_stiffness.force.x, _x.feedback.actual_pose.wrench_or_stiffness.force.y, _x.feedback.actual_pose.wrench_or_stiffness.force.z, _x.feedback.actual_pose.wrench_or_stiffness.torque.x, _x.feedback.actual_pose.wrench_or_stiffness.torque.y, _x.feedback.actual_pose.wrench_or_stiffness.torque.z, _x.feedback.actual_pose.isForceX, _x.feedback.actual_pose.isForceY, _x.feedback.actual_pose.isForceZ, _x.feedback.actual_pose.isTorqueX, _x.feedback.actual_pose.isTorqueY, _x.feedback.actual_pose.isTorqueZ, _x.feedback.actual_pose.time_from_start.secs, _x.feedback.actual_pose.time_from_start.nsecs, _x.feedback.effort_sq_error,) = _struct_13d6B2id.unpack(str[start:end]) 00432 self.feedback.actual_pose.isForceX = bool(self.feedback.actual_pose.isForceX) 00433 self.feedback.actual_pose.isForceY = bool(self.feedback.actual_pose.isForceY) 00434 self.feedback.actual_pose.isForceZ = bool(self.feedback.actual_pose.isForceZ) 00435 self.feedback.actual_pose.isTorqueX = bool(self.feedback.actual_pose.isTorqueX) 00436 self.feedback.actual_pose.isTorqueY = bool(self.feedback.actual_pose.isTorqueY) 00437 self.feedback.actual_pose.isTorqueZ = bool(self.feedback.actual_pose.isTorqueZ) 00438 start = end 00439 end += 4 00440 (length,) = _struct_I.unpack(str[start:end]) 00441 pattern = '<%sd'%length 00442 start = end 00443 end += struct.calcsize(pattern) 00444 self.feedback.requested_joint_efforts = struct.unpack(pattern, str[start:end]) 00445 start = end 00446 end += 4 00447 (length,) = _struct_I.unpack(str[start:end]) 00448 pattern = '<%sd'%length 00449 start = end 00450 end += struct.calcsize(pattern) 00451 self.feedback.actual_joint_efforts = struct.unpack(pattern, str[start:end]) 00452 _x = self 00453 start = end 00454 end += 8 00455 (_x.feedback.running_time.secs, _x.feedback.running_time.nsecs,) = _struct_2i.unpack(str[start:end]) 00456 return self 00457 except struct.error as e: 00458 raise roslib.message.DeserializationError(e) #most likely buffer underfill 00459 00460 00461 def serialize_numpy(self, buff, numpy): 00462 """ 00463 serialize message with numpy array types into buffer 00464 @param buff: buffer 00465 @type buff: StringIO 00466 @param numpy: numpy python module 00467 @type numpy module 00468 """ 00469 try: 00470 _x = self 00471 buff.write(_struct_3I.pack(_x.header.seq, _x.header.stamp.secs, _x.header.stamp.nsecs)) 00472 _x = self.header.frame_id 00473 length = len(_x) 00474 buff.write(struct.pack('<I%ss'%length, length, _x)) 00475 _x = self 00476 buff.write(_struct_2I.pack(_x.status.goal_id.stamp.secs, _x.status.goal_id.stamp.nsecs)) 00477 _x = self.status.goal_id.id 00478 length = len(_x) 00479 buff.write(struct.pack('<I%ss'%length, length, _x)) 00480 buff.write(_struct_B.pack(self.status.status)) 00481 _x = self.status.text 00482 length = len(_x) 00483 buff.write(struct.pack('<I%ss'%length, length, _x)) 00484 _x = self 00485 buff.write(_struct_3I.pack(_x.feedback.header.seq, _x.feedback.header.stamp.secs, _x.feedback.header.stamp.nsecs)) 00486 _x = self.feedback.header.frame_id 00487 length = len(_x) 00488 buff.write(struct.pack('<I%ss'%length, length, _x)) 00489 length = len(self.feedback.goal) 00490 buff.write(_struct_I.pack(length)) 00491 for val1 in self.feedback.goal: 00492 _v19 = val1.header 00493 buff.write(_struct_I.pack(_v19.seq)) 00494 _v20 = _v19.stamp 00495 _x = _v20 00496 buff.write(_struct_2I.pack(_x.secs, _x.nsecs)) 00497 _x = _v19.frame_id 00498 length = len(_x) 00499 buff.write(struct.pack('<I%ss'%length, length, _x)) 00500 _v21 = val1.pose 00501 _v22 = _v21.position 00502 _x = _v22 00503 buff.write(_struct_3d.pack(_x.x, _x.y, _x.z)) 00504 _v23 = _v21.orientation 00505 _x = _v23 00506 buff.write(_struct_4d.pack(_x.x, _x.y, _x.z, _x.w)) 00507 _v24 = val1.wrench_or_stiffness 00508 _v25 = _v24.force 00509 _x = _v25 00510 buff.write(_struct_3d.pack(_x.x, _x.y, _x.z)) 00511 _v26 = _v24.torque 00512 _x = _v26 00513 buff.write(_struct_3d.pack(_x.x, _x.y, _x.z)) 00514 _x = val1 00515 buff.write(_struct_6B.pack(_x.isForceX, _x.isForceY, _x.isForceZ, _x.isTorqueX, _x.isTorqueY, _x.isTorqueZ)) 00516 _v27 = val1.time_from_start 00517 _x = _v27 00518 buff.write(_struct_2i.pack(_x.secs, _x.nsecs)) 00519 _x = self 00520 buff.write(_struct_3I.pack(_x.feedback.initial_point.header.seq, _x.feedback.initial_point.header.stamp.secs, _x.feedback.initial_point.header.stamp.nsecs)) 00521 _x = self.feedback.initial_point.header.frame_id 00522 length = len(_x) 00523 buff.write(struct.pack('<I%ss'%length, length, _x)) 00524 _x = self 00525 buff.write(_struct_13d6B2i3I.pack(_x.feedback.initial_point.pose.position.x, _x.feedback.initial_point.pose.position.y, _x.feedback.initial_point.pose.position.z, _x.feedback.initial_point.pose.orientation.x, _x.feedback.initial_point.pose.orientation.y, _x.feedback.initial_point.pose.orientation.z, _x.feedback.initial_point.pose.orientation.w, _x.feedback.initial_point.wrench_or_stiffness.force.x, _x.feedback.initial_point.wrench_or_stiffness.force.y, _x.feedback.initial_point.wrench_or_stiffness.force.z, _x.feedback.initial_point.wrench_or_stiffness.torque.x, _x.feedback.initial_point.wrench_or_stiffness.torque.y, _x.feedback.initial_point.wrench_or_stiffness.torque.z, _x.feedback.initial_point.isForceX, _x.feedback.initial_point.isForceY, _x.feedback.initial_point.isForceZ, _x.feedback.initial_point.isTorqueX, _x.feedback.initial_point.isTorqueY, _x.feedback.initial_point.isTorqueZ, _x.feedback.initial_point.time_from_start.secs, _x.feedback.initial_point.time_from_start.nsecs, _x.feedback.desired.header.seq, _x.feedback.desired.header.stamp.secs, _x.feedback.desired.header.stamp.nsecs)) 00526 _x = self.feedback.desired.header.frame_id 00527 length = len(_x) 00528 buff.write(struct.pack('<I%ss'%length, length, _x)) 00529 _x = self 00530 buff.write(_struct_13d6B2i3I.pack(_x.feedback.desired.pose.position.x, _x.feedback.desired.pose.position.y, _x.feedback.desired.pose.position.z, _x.feedback.desired.pose.orientation.x, _x.feedback.desired.pose.orientation.y, _x.feedback.desired.pose.orientation.z, _x.feedback.desired.pose.orientation.w, _x.feedback.desired.wrench_or_stiffness.force.x, _x.feedback.desired.wrench_or_stiffness.force.y, _x.feedback.desired.wrench_or_stiffness.force.z, _x.feedback.desired.wrench_or_stiffness.torque.x, _x.feedback.desired.wrench_or_stiffness.torque.y, _x.feedback.desired.wrench_or_stiffness.torque.z, _x.feedback.desired.isForceX, _x.feedback.desired.isForceY, _x.feedback.desired.isForceZ, _x.feedback.desired.isTorqueX, _x.feedback.desired.isTorqueY, _x.feedback.desired.isTorqueZ, _x.feedback.desired.time_from_start.secs, _x.feedback.desired.time_from_start.nsecs, _x.feedback.actual_pose.header.seq, _x.feedback.actual_pose.header.stamp.secs, _x.feedback.actual_pose.header.stamp.nsecs)) 00531 _x = self.feedback.actual_pose.header.frame_id 00532 length = len(_x) 00533 buff.write(struct.pack('<I%ss'%length, length, _x)) 00534 _x = self 00535 buff.write(_struct_13d6B2id.pack(_x.feedback.actual_pose.pose.position.x, _x.feedback.actual_pose.pose.position.y, _x.feedback.actual_pose.pose.position.z, _x.feedback.actual_pose.pose.orientation.x, _x.feedback.actual_pose.pose.orientation.y, _x.feedback.actual_pose.pose.orientation.z, _x.feedback.actual_pose.pose.orientation.w, _x.feedback.actual_pose.wrench_or_stiffness.force.x, _x.feedback.actual_pose.wrench_or_stiffness.force.y, _x.feedback.actual_pose.wrench_or_stiffness.force.z, _x.feedback.actual_pose.wrench_or_stiffness.torque.x, _x.feedback.actual_pose.wrench_or_stiffness.torque.y, _x.feedback.actual_pose.wrench_or_stiffness.torque.z, _x.feedback.actual_pose.isForceX, _x.feedback.actual_pose.isForceY, _x.feedback.actual_pose.isForceZ, _x.feedback.actual_pose.isTorqueX, _x.feedback.actual_pose.isTorqueY, _x.feedback.actual_pose.isTorqueZ, _x.feedback.actual_pose.time_from_start.secs, _x.feedback.actual_pose.time_from_start.nsecs, _x.feedback.effort_sq_error)) 00536 length = len(self.feedback.requested_joint_efforts) 00537 buff.write(_struct_I.pack(length)) 00538 pattern = '<%sd'%length 00539 buff.write(self.feedback.requested_joint_efforts.tostring()) 00540 length = len(self.feedback.actual_joint_efforts) 00541 buff.write(_struct_I.pack(length)) 00542 pattern = '<%sd'%length 00543 buff.write(self.feedback.actual_joint_efforts.tostring()) 00544 _x = self 00545 buff.write(_struct_2i.pack(_x.feedback.running_time.secs, _x.feedback.running_time.nsecs)) 00546 except struct.error as se: self._check_types(se) 00547 except TypeError as te: self._check_types(te) 00548 00549 def deserialize_numpy(self, str, numpy): 00550 """ 00551 unpack serialized message in str into this message instance using numpy for array types 00552 @param str: byte array of serialized message 00553 @type str: str 00554 @param numpy: numpy python module 00555 @type numpy: module 00556 """ 00557 try: 00558 if self.header is None: 00559 self.header = std_msgs.msg._Header.Header() 00560 if self.status is None: 00561 self.status = actionlib_msgs.msg.GoalStatus() 00562 if self.feedback is None: 00563 self.feedback = ee_cart_imped_msgs.msg.EECartImpedFeedback() 00564 end = 0 00565 _x = self 00566 start = end 00567 end += 12 00568 (_x.header.seq, _x.header.stamp.secs, _x.header.stamp.nsecs,) = _struct_3I.unpack(str[start:end]) 00569 start = end 00570 end += 4 00571 (length,) = _struct_I.unpack(str[start:end]) 00572 start = end 00573 end += length 00574 self.header.frame_id = str[start:end] 00575 _x = self 00576 start = end 00577 end += 8 00578 (_x.status.goal_id.stamp.secs, _x.status.goal_id.stamp.nsecs,) = _struct_2I.unpack(str[start:end]) 00579 start = end 00580 end += 4 00581 (length,) = _struct_I.unpack(str[start:end]) 00582 start = end 00583 end += length 00584 self.status.goal_id.id = str[start:end] 00585 start = end 00586 end += 1 00587 (self.status.status,) = _struct_B.unpack(str[start:end]) 00588 start = end 00589 end += 4 00590 (length,) = _struct_I.unpack(str[start:end]) 00591 start = end 00592 end += length 00593 self.status.text = str[start:end] 00594 _x = self 00595 start = end 00596 end += 12 00597 (_x.feedback.header.seq, _x.feedback.header.stamp.secs, _x.feedback.header.stamp.nsecs,) = _struct_3I.unpack(str[start:end]) 00598 start = end 00599 end += 4 00600 (length,) = _struct_I.unpack(str[start:end]) 00601 start = end 00602 end += length 00603 self.feedback.header.frame_id = str[start:end] 00604 start = end 00605 end += 4 00606 (length,) = _struct_I.unpack(str[start:end]) 00607 self.feedback.goal = [] 00608 for i in range(0, length): 00609 val1 = ee_cart_imped_msgs.msg.StiffPoint() 00610 _v28 = val1.header 00611 start = end 00612 end += 4 00613 (_v28.seq,) = _struct_I.unpack(str[start:end]) 00614 _v29 = _v28.stamp 00615 _x = _v29 00616 start = end 00617 end += 8 00618 (_x.secs, _x.nsecs,) = _struct_2I.unpack(str[start:end]) 00619 start = end 00620 end += 4 00621 (length,) = _struct_I.unpack(str[start:end]) 00622 start = end 00623 end += length 00624 _v28.frame_id = str[start:end] 00625 _v30 = val1.pose 00626 _v31 = _v30.position 00627 _x = _v31 00628 start = end 00629 end += 24 00630 (_x.x, _x.y, _x.z,) = _struct_3d.unpack(str[start:end]) 00631 _v32 = _v30.orientation 00632 _x = _v32 00633 start = end 00634 end += 32 00635 (_x.x, _x.y, _x.z, _x.w,) = _struct_4d.unpack(str[start:end]) 00636 _v33 = val1.wrench_or_stiffness 00637 _v34 = _v33.force 00638 _x = _v34 00639 start = end 00640 end += 24 00641 (_x.x, _x.y, _x.z,) = _struct_3d.unpack(str[start:end]) 00642 _v35 = _v33.torque 00643 _x = _v35 00644 start = end 00645 end += 24 00646 (_x.x, _x.y, _x.z,) = _struct_3d.unpack(str[start:end]) 00647 _x = val1 00648 start = end 00649 end += 6 00650 (_x.isForceX, _x.isForceY, _x.isForceZ, _x.isTorqueX, _x.isTorqueY, _x.isTorqueZ,) = _struct_6B.unpack(str[start:end]) 00651 val1.isForceX = bool(val1.isForceX) 00652 val1.isForceY = bool(val1.isForceY) 00653 val1.isForceZ = bool(val1.isForceZ) 00654 val1.isTorqueX = bool(val1.isTorqueX) 00655 val1.isTorqueY = bool(val1.isTorqueY) 00656 val1.isTorqueZ = bool(val1.isTorqueZ) 00657 _v36 = val1.time_from_start 00658 _x = _v36 00659 start = end 00660 end += 8 00661 (_x.secs, _x.nsecs,) = _struct_2i.unpack(str[start:end]) 00662 self.feedback.goal.append(val1) 00663 _x = self 00664 start = end 00665 end += 12 00666 (_x.feedback.initial_point.header.seq, _x.feedback.initial_point.header.stamp.secs, _x.feedback.initial_point.header.stamp.nsecs,) = _struct_3I.unpack(str[start:end]) 00667 start = end 00668 end += 4 00669 (length,) = _struct_I.unpack(str[start:end]) 00670 start = end 00671 end += length 00672 self.feedback.initial_point.header.frame_id = str[start:end] 00673 _x = self 00674 start = end 00675 end += 130 00676 (_x.feedback.initial_point.pose.position.x, _x.feedback.initial_point.pose.position.y, _x.feedback.initial_point.pose.position.z, _x.feedback.initial_point.pose.orientation.x, _x.feedback.initial_point.pose.orientation.y, _x.feedback.initial_point.pose.orientation.z, _x.feedback.initial_point.pose.orientation.w, _x.feedback.initial_point.wrench_or_stiffness.force.x, _x.feedback.initial_point.wrench_or_stiffness.force.y, _x.feedback.initial_point.wrench_or_stiffness.force.z, _x.feedback.initial_point.wrench_or_stiffness.torque.x, _x.feedback.initial_point.wrench_or_stiffness.torque.y, _x.feedback.initial_point.wrench_or_stiffness.torque.z, _x.feedback.initial_point.isForceX, _x.feedback.initial_point.isForceY, _x.feedback.initial_point.isForceZ, _x.feedback.initial_point.isTorqueX, _x.feedback.initial_point.isTorqueY, _x.feedback.initial_point.isTorqueZ, _x.feedback.initial_point.time_from_start.secs, _x.feedback.initial_point.time_from_start.nsecs, _x.feedback.desired.header.seq, _x.feedback.desired.header.stamp.secs, _x.feedback.desired.header.stamp.nsecs,) = _struct_13d6B2i3I.unpack(str[start:end]) 00677 self.feedback.initial_point.isForceX = bool(self.feedback.initial_point.isForceX) 00678 self.feedback.initial_point.isForceY = bool(self.feedback.initial_point.isForceY) 00679 self.feedback.initial_point.isForceZ = bool(self.feedback.initial_point.isForceZ) 00680 self.feedback.initial_point.isTorqueX = bool(self.feedback.initial_point.isTorqueX) 00681 self.feedback.initial_point.isTorqueY = bool(self.feedback.initial_point.isTorqueY) 00682 self.feedback.initial_point.isTorqueZ = bool(self.feedback.initial_point.isTorqueZ) 00683 start = end 00684 end += 4 00685 (length,) = _struct_I.unpack(str[start:end]) 00686 start = end 00687 end += length 00688 self.feedback.desired.header.frame_id = str[start:end] 00689 _x = self 00690 start = end 00691 end += 130 00692 (_x.feedback.desired.pose.position.x, _x.feedback.desired.pose.position.y, _x.feedback.desired.pose.position.z, _x.feedback.desired.pose.orientation.x, _x.feedback.desired.pose.orientation.y, _x.feedback.desired.pose.orientation.z, _x.feedback.desired.pose.orientation.w, _x.feedback.desired.wrench_or_stiffness.force.x, _x.feedback.desired.wrench_or_stiffness.force.y, _x.feedback.desired.wrench_or_stiffness.force.z, _x.feedback.desired.wrench_or_stiffness.torque.x, _x.feedback.desired.wrench_or_stiffness.torque.y, _x.feedback.desired.wrench_or_stiffness.torque.z, _x.feedback.desired.isForceX, _x.feedback.desired.isForceY, _x.feedback.desired.isForceZ, _x.feedback.desired.isTorqueX, _x.feedback.desired.isTorqueY, _x.feedback.desired.isTorqueZ, _x.feedback.desired.time_from_start.secs, _x.feedback.desired.time_from_start.nsecs, _x.feedback.actual_pose.header.seq, _x.feedback.actual_pose.header.stamp.secs, _x.feedback.actual_pose.header.stamp.nsecs,) = _struct_13d6B2i3I.unpack(str[start:end]) 00693 self.feedback.desired.isForceX = bool(self.feedback.desired.isForceX) 00694 self.feedback.desired.isForceY = bool(self.feedback.desired.isForceY) 00695 self.feedback.desired.isForceZ = bool(self.feedback.desired.isForceZ) 00696 self.feedback.desired.isTorqueX = bool(self.feedback.desired.isTorqueX) 00697 self.feedback.desired.isTorqueY = bool(self.feedback.desired.isTorqueY) 00698 self.feedback.desired.isTorqueZ = bool(self.feedback.desired.isTorqueZ) 00699 start = end 00700 end += 4 00701 (length,) = _struct_I.unpack(str[start:end]) 00702 start = end 00703 end += length 00704 self.feedback.actual_pose.header.frame_id = str[start:end] 00705 _x = self 00706 start = end 00707 end += 126 00708 (_x.feedback.actual_pose.pose.position.x, _x.feedback.actual_pose.pose.position.y, _x.feedback.actual_pose.pose.position.z, _x.feedback.actual_pose.pose.orientation.x, _x.feedback.actual_pose.pose.orientation.y, _x.feedback.actual_pose.pose.orientation.z, _x.feedback.actual_pose.pose.orientation.w, _x.feedback.actual_pose.wrench_or_stiffness.force.x, _x.feedback.actual_pose.wrench_or_stiffness.force.y, _x.feedback.actual_pose.wrench_or_stiffness.force.z, _x.feedback.actual_pose.wrench_or_stiffness.torque.x, _x.feedback.actual_pose.wrench_or_stiffness.torque.y, _x.feedback.actual_pose.wrench_or_stiffness.torque.z, _x.feedback.actual_pose.isForceX, _x.feedback.actual_pose.isForceY, _x.feedback.actual_pose.isForceZ, _x.feedback.actual_pose.isTorqueX, _x.feedback.actual_pose.isTorqueY, _x.feedback.actual_pose.isTorqueZ, _x.feedback.actual_pose.time_from_start.secs, _x.feedback.actual_pose.time_from_start.nsecs, _x.feedback.effort_sq_error,) = _struct_13d6B2id.unpack(str[start:end]) 00709 self.feedback.actual_pose.isForceX = bool(self.feedback.actual_pose.isForceX) 00710 self.feedback.actual_pose.isForceY = bool(self.feedback.actual_pose.isForceY) 00711 self.feedback.actual_pose.isForceZ = bool(self.feedback.actual_pose.isForceZ) 00712 self.feedback.actual_pose.isTorqueX = bool(self.feedback.actual_pose.isTorqueX) 00713 self.feedback.actual_pose.isTorqueY = bool(self.feedback.actual_pose.isTorqueY) 00714 self.feedback.actual_pose.isTorqueZ = bool(self.feedback.actual_pose.isTorqueZ) 00715 start = end 00716 end += 4 00717 (length,) = _struct_I.unpack(str[start:end]) 00718 pattern = '<%sd'%length 00719 start = end 00720 end += struct.calcsize(pattern) 00721 self.feedback.requested_joint_efforts = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length) 00722 start = end 00723 end += 4 00724 (length,) = _struct_I.unpack(str[start:end]) 00725 pattern = '<%sd'%length 00726 start = end 00727 end += struct.calcsize(pattern) 00728 self.feedback.actual_joint_efforts = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length) 00729 _x = self 00730 start = end 00731 end += 8 00732 (_x.feedback.running_time.secs, _x.feedback.running_time.nsecs,) = _struct_2i.unpack(str[start:end]) 00733 return self 00734 except struct.error as e: 00735 raise roslib.message.DeserializationError(e) #most likely buffer underfill 00736 00737 _struct_I = roslib.message.struct_I 00738 _struct_6B = struct.Struct("<6B") 00739 _struct_B = struct.Struct("<B") 00740 _struct_13d6B2id = struct.Struct("<13d6B2id") 00741 _struct_2i = struct.Struct("<2i") 00742 _struct_3I = struct.Struct("<3I") 00743 _struct_13d6B2i3I = struct.Struct("<13d6B2i3I") 00744 _struct_4d = struct.Struct("<4d") 00745 _struct_2I = struct.Struct("<2I") 00746 _struct_3d = struct.Struct("<3d")