kuavo-humanoid-sdk 1.2.2__20250922181216-py3-none-any.whl

kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_twoArmHandPoseCmdFreeSrv.py

@@ -0,0 +1,716 @@
+# This Python file uses the following encoding: utf-8
+"""autogenerated by genpy from kuavo_msgs/twoArmHandPoseCmdFreeSrvRequest.msg. Do not edit."""
+import codecs
+import sys
+python3 = True if sys.hexversion > 0x03000000 else False
+import genpy
+import struct
+
+import kuavo_msgs.msg
+import std_msgs.msg
+
+class twoArmHandPoseCmdFreeSrvRequest(genpy.Message):
+  _md5sum = "4c961793a7f64133c21ec394db1fac70"
+  _type = "kuavo_msgs/twoArmHandPoseCmdFreeSrvRequest"
+  _has_header = False  # flag to mark the presence of a Header object
+  _full_text = """twoArmHandPoseCmdFree twoArmHandPoseCmdFreeRequest
+
+================================================================================
+MSG: kuavo_msgs/twoArmHandPoseCmdFree
+twoArmHandPoseFree  hand_poses
+# params for the IK solver
+bool use_custom_ik_param
+bool joint_angles_as_q0
+ikSolveParam ik_param
+================================================================================
+MSG: kuavo_msgs/twoArmHandPoseFree
+Header header
+armHandPoseFree  left_pose
+armHandPoseFree  right_pose
+================================================================================
+MSG: std_msgs/Header
+# Standard metadata for higher-level stamped data types.
+# This is generally used to communicate timestamped data 
+# in a particular coordinate frame.
+# 
+# sequence ID: consecutively increasing ID 
+uint32 seq
+#Two-integer timestamp that is expressed as:
+# * stamp.sec: seconds (stamp_secs) since epoch (in Python the variable is called 'secs')
+# * stamp.nsec: nanoseconds since stamp_secs (in Python the variable is called 'nsecs')
+# time-handling sugar is provided by the client library
+time stamp
+#Frame this data is associated with
+string frame_id
+
+================================================================================
+MSG: kuavo_msgs/armHandPoseFree
+float64[3] pos_xyz
+float64[4] quat_xyzw
+
+float64[3] elbow_pos_xyz
+
+float64[] joint_angles
+
+================================================================================
+MSG: kuavo_msgs/ikSolveParam
+# snopt params
+float64 major_optimality_tol
+float64 major_feasibility_tol
+float64 minor_feasibility_tol
+float64 major_iterations_limit
+# constraint and cost params
+float64 oritation_constraint_tol
+float64 pos_constraint_tol # work when pos_cost_weight > 0.0
+float64 pos_cost_weight"""
+  __slots__ = ['twoArmHandPoseCmdFreeRequest']
+  _slot_types = ['kuavo_msgs/twoArmHandPoseCmdFree']
+
+  def __init__(self, *args, **kwds):
+    """
+    Constructor. Any message fields that are implicitly/explicitly
+    set to None will be assigned a default value. The recommend
+    use is keyword arguments as this is more robust to future message
+    changes.  You cannot mix in-order arguments and keyword arguments.
+
+    The available fields are:
+       twoArmHandPoseCmdFreeRequest
+
+    :param args: complete set of field values, in .msg order
+    :param kwds: use keyword arguments corresponding to message field names
+    to set specific fields.
+    """
+    if args or kwds:
+      super(twoArmHandPoseCmdFreeSrvRequest, self).__init__(*args, **kwds)
+      # message fields cannot be None, assign default values for those that are
+      if self.twoArmHandPoseCmdFreeRequest is None:
+        self.twoArmHandPoseCmdFreeRequest = kuavo_msgs.msg.twoArmHandPoseCmdFree()
+    else:
+      self.twoArmHandPoseCmdFreeRequest = kuavo_msgs.msg.twoArmHandPoseCmdFree()
+
+  def _get_types(self):
+    """
+    internal API method
+    """
+    return self._slot_types
+
+  def serialize(self, buff):
+    """
+    serialize message into buffer
+    :param buff: buffer, ``StringIO``
+    """
+    try:
+      _x = self
+      buff.write(_get_struct_3I().pack(_x.twoArmHandPoseCmdFreeRequest.hand_poses.header.seq, _x.twoArmHandPoseCmdFreeRequest.hand_poses.header.stamp.secs, _x.twoArmHandPoseCmdFreeRequest.hand_poses.header.stamp.nsecs))
+      _x = self.twoArmHandPoseCmdFreeRequest.hand_poses.header.frame_id
+      length = len(_x)
+      if python3 or type(_x) == unicode:
+        _x = _x.encode('utf-8')
+        length = len(_x)
+      buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
+      buff.write(_get_struct_3d().pack(*self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.pos_xyz))
+      buff.write(_get_struct_4d().pack(*self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.quat_xyzw))
+      buff.write(_get_struct_3d().pack(*self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.elbow_pos_xyz))
+      length = len(self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.joint_angles)
+      buff.write(_struct_I.pack(length))
+      pattern = '<%sd'%length
+      buff.write(struct.Struct(pattern).pack(*self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.joint_angles))
+      buff.write(_get_struct_3d().pack(*self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.pos_xyz))
+      buff.write(_get_struct_4d().pack(*self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.quat_xyzw))
+      buff.write(_get_struct_3d().pack(*self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.elbow_pos_xyz))
+      length = len(self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.joint_angles)
+      buff.write(_struct_I.pack(length))
+      pattern = '<%sd'%length
+      buff.write(struct.Struct(pattern).pack(*self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.joint_angles))
+      _x = self
+      buff.write(_get_struct_2B7d().pack(_x.twoArmHandPoseCmdFreeRequest.use_custom_ik_param, _x.twoArmHandPoseCmdFreeRequest.joint_angles_as_q0, _x.twoArmHandPoseCmdFreeRequest.ik_param.major_optimality_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.major_feasibility_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.minor_feasibility_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.major_iterations_limit, _x.twoArmHandPoseCmdFreeRequest.ik_param.oritation_constraint_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.pos_constraint_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.pos_cost_weight))
+    except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
+    except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
+
+  def deserialize(self, str):
+    """
+    unpack serialized message in str into this message instance
+    :param str: byte array of serialized message, ``str``
+    """
+    if python3:
+      codecs.lookup_error("rosmsg").msg_type = self._type
+    try:
+      if self.twoArmHandPoseCmdFreeRequest is None:
+        self.twoArmHandPoseCmdFreeRequest = kuavo_msgs.msg.twoArmHandPoseCmdFree()
+      end = 0
+      _x = self
+      start = end
+      end += 12
+      (_x.twoArmHandPoseCmdFreeRequest.hand_poses.header.seq, _x.twoArmHandPoseCmdFreeRequest.hand_poses.header.stamp.secs, _x.twoArmHandPoseCmdFreeRequest.hand_poses.header.stamp.nsecs,) = _get_struct_3I().unpack(str[start:end])
+      start = end
+      end += 4
+      (length,) = _struct_I.unpack(str[start:end])
+      start = end
+      end += length
+      if python3:
+        self.twoArmHandPoseCmdFreeRequest.hand_poses.header.frame_id = str[start:end].decode('utf-8', 'rosmsg')
+      else:
+        self.twoArmHandPoseCmdFreeRequest.hand_poses.header.frame_id = str[start:end]
+      start = end
+      end += 24
+      self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.pos_xyz = _get_struct_3d().unpack(str[start:end])
+      start = end
+      end += 32
+      self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.quat_xyzw = _get_struct_4d().unpack(str[start:end])
+      start = end
+      end += 24
+      self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.elbow_pos_xyz = _get_struct_3d().unpack(str[start:end])
+      start = end
+      end += 4
+      (length,) = _struct_I.unpack(str[start:end])
+      pattern = '<%sd'%length
+      start = end
+      s = struct.Struct(pattern)
+      end += s.size
+      self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.joint_angles = s.unpack(str[start:end])
+      start = end
+      end += 24
+      self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.pos_xyz = _get_struct_3d().unpack(str[start:end])
+      start = end
+      end += 32
+      self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.quat_xyzw = _get_struct_4d().unpack(str[start:end])
+      start = end
+      end += 24
+      self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.elbow_pos_xyz = _get_struct_3d().unpack(str[start:end])
+      start = end
+      end += 4
+      (length,) = _struct_I.unpack(str[start:end])
+      pattern = '<%sd'%length
+      start = end
+      s = struct.Struct(pattern)
+      end += s.size
+      self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.joint_angles = s.unpack(str[start:end])
+      _x = self
+      start = end
+      end += 58
+      (_x.twoArmHandPoseCmdFreeRequest.use_custom_ik_param, _x.twoArmHandPoseCmdFreeRequest.joint_angles_as_q0, _x.twoArmHandPoseCmdFreeRequest.ik_param.major_optimality_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.major_feasibility_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.minor_feasibility_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.major_iterations_limit, _x.twoArmHandPoseCmdFreeRequest.ik_param.oritation_constraint_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.pos_constraint_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.pos_cost_weight,) = _get_struct_2B7d().unpack(str[start:end])
+      self.twoArmHandPoseCmdFreeRequest.use_custom_ik_param = bool(self.twoArmHandPoseCmdFreeRequest.use_custom_ik_param)
+      self.twoArmHandPoseCmdFreeRequest.joint_angles_as_q0 = bool(self.twoArmHandPoseCmdFreeRequest.joint_angles_as_q0)
+      return self
+    except struct.error as e:
+      raise genpy.DeserializationError(e)  # most likely buffer underfill
+
+
+  def serialize_numpy(self, buff, numpy):
+    """
+    serialize message with numpy array types into buffer
+    :param buff: buffer, ``StringIO``
+    :param numpy: numpy python module
+    """
+    try:
+      _x = self
+      buff.write(_get_struct_3I().pack(_x.twoArmHandPoseCmdFreeRequest.hand_poses.header.seq, _x.twoArmHandPoseCmdFreeRequest.hand_poses.header.stamp.secs, _x.twoArmHandPoseCmdFreeRequest.hand_poses.header.stamp.nsecs))
+      _x = self.twoArmHandPoseCmdFreeRequest.hand_poses.header.frame_id
+      length = len(_x)
+      if python3 or type(_x) == unicode:
+        _x = _x.encode('utf-8')
+        length = len(_x)
+      buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
+      buff.write(self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.pos_xyz.tostring())
+      buff.write(self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.quat_xyzw.tostring())
+      buff.write(self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.elbow_pos_xyz.tostring())
+      length = len(self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.joint_angles)
+      buff.write(_struct_I.pack(length))
+      pattern = '<%sd'%length
+      buff.write(self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.joint_angles.tostring())
+      buff.write(self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.pos_xyz.tostring())
+      buff.write(self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.quat_xyzw.tostring())
+      buff.write(self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.elbow_pos_xyz.tostring())
+      length = len(self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.joint_angles)
+      buff.write(_struct_I.pack(length))
+      pattern = '<%sd'%length
+      buff.write(self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.joint_angles.tostring())
+      _x = self
+      buff.write(_get_struct_2B7d().pack(_x.twoArmHandPoseCmdFreeRequest.use_custom_ik_param, _x.twoArmHandPoseCmdFreeRequest.joint_angles_as_q0, _x.twoArmHandPoseCmdFreeRequest.ik_param.major_optimality_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.major_feasibility_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.minor_feasibility_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.major_iterations_limit, _x.twoArmHandPoseCmdFreeRequest.ik_param.oritation_constraint_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.pos_constraint_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.pos_cost_weight))
+    except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
+    except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
+
+  def deserialize_numpy(self, str, numpy):
+    """
+    unpack serialized message in str into this message instance using numpy for array types
+    :param str: byte array of serialized message, ``str``
+    :param numpy: numpy python module
+    """
+    if python3:
+      codecs.lookup_error("rosmsg").msg_type = self._type
+    try:
+      if self.twoArmHandPoseCmdFreeRequest is None:
+        self.twoArmHandPoseCmdFreeRequest = kuavo_msgs.msg.twoArmHandPoseCmdFree()
+      end = 0
+      _x = self
+      start = end
+      end += 12
+      (_x.twoArmHandPoseCmdFreeRequest.hand_poses.header.seq, _x.twoArmHandPoseCmdFreeRequest.hand_poses.header.stamp.secs, _x.twoArmHandPoseCmdFreeRequest.hand_poses.header.stamp.nsecs,) = _get_struct_3I().unpack(str[start:end])
+      start = end
+      end += 4
+      (length,) = _struct_I.unpack(str[start:end])
+      start = end
+      end += length
+      if python3:
+        self.twoArmHandPoseCmdFreeRequest.hand_poses.header.frame_id = str[start:end].decode('utf-8', 'rosmsg')
+      else:
+        self.twoArmHandPoseCmdFreeRequest.hand_poses.header.frame_id = str[start:end]
+      start = end
+      end += 24
+      self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.pos_xyz = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=3)
+      start = end
+      end += 32
+      self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.quat_xyzw = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=4)
+      start = end
+      end += 24
+      self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.elbow_pos_xyz = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=3)
+      start = end
+      end += 4
+      (length,) = _struct_I.unpack(str[start:end])
+      pattern = '<%sd'%length
+      start = end
+      s = struct.Struct(pattern)
+      end += s.size
+      self.twoArmHandPoseCmdFreeRequest.hand_poses.left_pose.joint_angles = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length)
+      start = end
+      end += 24
+      self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.pos_xyz = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=3)
+      start = end
+      end += 32
+      self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.quat_xyzw = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=4)
+      start = end
+      end += 24
+      self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.elbow_pos_xyz = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=3)
+      start = end
+      end += 4
+      (length,) = _struct_I.unpack(str[start:end])
+      pattern = '<%sd'%length
+      start = end
+      s = struct.Struct(pattern)
+      end += s.size
+      self.twoArmHandPoseCmdFreeRequest.hand_poses.right_pose.joint_angles = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length)
+      _x = self
+      start = end
+      end += 58
+      (_x.twoArmHandPoseCmdFreeRequest.use_custom_ik_param, _x.twoArmHandPoseCmdFreeRequest.joint_angles_as_q0, _x.twoArmHandPoseCmdFreeRequest.ik_param.major_optimality_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.major_feasibility_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.minor_feasibility_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.major_iterations_limit, _x.twoArmHandPoseCmdFreeRequest.ik_param.oritation_constraint_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.pos_constraint_tol, _x.twoArmHandPoseCmdFreeRequest.ik_param.pos_cost_weight,) = _get_struct_2B7d().unpack(str[start:end])
+      self.twoArmHandPoseCmdFreeRequest.use_custom_ik_param = bool(self.twoArmHandPoseCmdFreeRequest.use_custom_ik_param)
+      self.twoArmHandPoseCmdFreeRequest.joint_angles_as_q0 = bool(self.twoArmHandPoseCmdFreeRequest.joint_angles_as_q0)
+      return self
+    except struct.error as e:
+      raise genpy.DeserializationError(e)  # most likely buffer underfill
+
+_struct_I = genpy.struct_I
+def _get_struct_I():
+    global _struct_I
+    return _struct_I
+_struct_2B7d = None
+def _get_struct_2B7d():
+    global _struct_2B7d
+    if _struct_2B7d is None:
+        _struct_2B7d = struct.Struct("<2B7d")
+    return _struct_2B7d
+_struct_3I = None
+def _get_struct_3I():
+    global _struct_3I
+    if _struct_3I is None:
+        _struct_3I = struct.Struct("<3I")
+    return _struct_3I
+_struct_3d = None
+def _get_struct_3d():
+    global _struct_3d
+    if _struct_3d is None:
+        _struct_3d = struct.Struct("<3d")
+    return _struct_3d
+_struct_4d = None
+def _get_struct_4d():
+    global _struct_4d
+    if _struct_4d is None:
+        _struct_4d = struct.Struct("<4d")
+    return _struct_4d
+# This Python file uses the following encoding: utf-8
+"""autogenerated by genpy from kuavo_msgs/twoArmHandPoseCmdFreeSrvResponse.msg. Do not edit."""
+import codecs
+import sys
+python3 = True if sys.hexversion > 0x03000000 else False
+import genpy
+import struct
+
+import kuavo_msgs.msg
+import std_msgs.msg
+
+class twoArmHandPoseCmdFreeSrvResponse(genpy.Message):
+  _md5sum = "595a805f76743c01c9ebd3b35eca94a0"
+  _type = "kuavo_msgs/twoArmHandPoseCmdFreeSrvResponse"
+  _has_header = False  # flag to mark the presence of a Header object
+  _full_text = """bool success
+bool with_torso
+float64[] q_arm
+float64[] q_torso
+
+float64   time_cost # unit: ms
+# ik result
+twoArmHandPoseFree  hand_poses
+
+
+================================================================================
+MSG: kuavo_msgs/twoArmHandPoseFree
+Header header
+armHandPoseFree  left_pose
+armHandPoseFree  right_pose
+================================================================================
+MSG: std_msgs/Header
+# Standard metadata for higher-level stamped data types.
+# This is generally used to communicate timestamped data 
+# in a particular coordinate frame.
+# 
+# sequence ID: consecutively increasing ID 
+uint32 seq
+#Two-integer timestamp that is expressed as:
+# * stamp.sec: seconds (stamp_secs) since epoch (in Python the variable is called 'secs')
+# * stamp.nsec: nanoseconds since stamp_secs (in Python the variable is called 'nsecs')
+# time-handling sugar is provided by the client library
+time stamp
+#Frame this data is associated with
+string frame_id
+
+================================================================================
+MSG: kuavo_msgs/armHandPoseFree
+float64[3] pos_xyz
+float64[4] quat_xyzw
+
+float64[3] elbow_pos_xyz
+
+float64[] joint_angles
+"""
+  __slots__ = ['success','with_torso','q_arm','q_torso','time_cost','hand_poses']
+  _slot_types = ['bool','bool','float64[]','float64[]','float64','kuavo_msgs/twoArmHandPoseFree']
+
+  def __init__(self, *args, **kwds):
+    """
+    Constructor. Any message fields that are implicitly/explicitly
+    set to None will be assigned a default value. The recommend
+    use is keyword arguments as this is more robust to future message
+    changes.  You cannot mix in-order arguments and keyword arguments.
+
+    The available fields are:
+       success,with_torso,q_arm,q_torso,time_cost,hand_poses
+
+    :param args: complete set of field values, in .msg order
+    :param kwds: use keyword arguments corresponding to message field names
+    to set specific fields.
+    """
+    if args or kwds:
+      super(twoArmHandPoseCmdFreeSrvResponse, self).__init__(*args, **kwds)
+      # message fields cannot be None, assign default values for those that are
+      if self.success is None:
+        self.success = False
+      if self.with_torso is None:
+        self.with_torso = False
+      if self.q_arm is None:
+        self.q_arm = []
+      if self.q_torso is None:
+        self.q_torso = []
+      if self.time_cost is None:
+        self.time_cost = 0.
+      if self.hand_poses is None:
+        self.hand_poses = kuavo_msgs.msg.twoArmHandPoseFree()
+    else:
+      self.success = False
+      self.with_torso = False
+      self.q_arm = []
+      self.q_torso = []
+      self.time_cost = 0.
+      self.hand_poses = kuavo_msgs.msg.twoArmHandPoseFree()
+
+  def _get_types(self):
+    """
+    internal API method
+    """
+    return self._slot_types
+
+  def serialize(self, buff):
+    """
+    serialize message into buffer
+    :param buff: buffer, ``StringIO``
+    """
+    try:
+      _x = self
+      buff.write(_get_struct_2B().pack(_x.success, _x.with_torso))
+      length = len(self.q_arm)
+      buff.write(_struct_I.pack(length))
+      pattern = '<%sd'%length
+      buff.write(struct.Struct(pattern).pack(*self.q_arm))
+      length = len(self.q_torso)
+      buff.write(_struct_I.pack(length))
+      pattern = '<%sd'%length
+      buff.write(struct.Struct(pattern).pack(*self.q_torso))
+      _x = self
+      buff.write(_get_struct_d3I().pack(_x.time_cost, _x.hand_poses.header.seq, _x.hand_poses.header.stamp.secs, _x.hand_poses.header.stamp.nsecs))
+      _x = self.hand_poses.header.frame_id
+      length = len(_x)
+      if python3 or type(_x) == unicode:
+        _x = _x.encode('utf-8')
+        length = len(_x)
+      buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
+      buff.write(_get_struct_3d().pack(*self.hand_poses.left_pose.pos_xyz))
+      buff.write(_get_struct_4d().pack(*self.hand_poses.left_pose.quat_xyzw))
+      buff.write(_get_struct_3d().pack(*self.hand_poses.left_pose.elbow_pos_xyz))
+      length = len(self.hand_poses.left_pose.joint_angles)
+      buff.write(_struct_I.pack(length))
+      pattern = '<%sd'%length
+      buff.write(struct.Struct(pattern).pack(*self.hand_poses.left_pose.joint_angles))
+      buff.write(_get_struct_3d().pack(*self.hand_poses.right_pose.pos_xyz))
+      buff.write(_get_struct_4d().pack(*self.hand_poses.right_pose.quat_xyzw))
+      buff.write(_get_struct_3d().pack(*self.hand_poses.right_pose.elbow_pos_xyz))
+      length = len(self.hand_poses.right_pose.joint_angles)
+      buff.write(_struct_I.pack(length))
+      pattern = '<%sd'%length
+      buff.write(struct.Struct(pattern).pack(*self.hand_poses.right_pose.joint_angles))
+    except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
+    except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
+
+  def deserialize(self, str):
+    """
+    unpack serialized message in str into this message instance
+    :param str: byte array of serialized message, ``str``
+    """
+    if python3:
+      codecs.lookup_error("rosmsg").msg_type = self._type
+    try:
+      if self.hand_poses is None:
+        self.hand_poses = kuavo_msgs.msg.twoArmHandPoseFree()
+      end = 0
+      _x = self
+      start = end
+      end += 2
+      (_x.success, _x.with_torso,) = _get_struct_2B().unpack(str[start:end])
+      self.success = bool(self.success)
+      self.with_torso = bool(self.with_torso)
+      start = end
+      end += 4
+      (length,) = _struct_I.unpack(str[start:end])
+      pattern = '<%sd'%length
+      start = end
+      s = struct.Struct(pattern)
+      end += s.size
+      self.q_arm = s.unpack(str[start:end])
+      start = end
+      end += 4
+      (length,) = _struct_I.unpack(str[start:end])
+      pattern = '<%sd'%length
+      start = end
+      s = struct.Struct(pattern)
+      end += s.size
+      self.q_torso = s.unpack(str[start:end])
+      _x = self
+      start = end
+      end += 20
+      (_x.time_cost, _x.hand_poses.header.seq, _x.hand_poses.header.stamp.secs, _x.hand_poses.header.stamp.nsecs,) = _get_struct_d3I().unpack(str[start:end])
+      start = end
+      end += 4
+      (length,) = _struct_I.unpack(str[start:end])
+      start = end
+      end += length
+      if python3:
+        self.hand_poses.header.frame_id = str[start:end].decode('utf-8', 'rosmsg')
+      else:
+        self.hand_poses.header.frame_id = str[start:end]
+      start = end
+      end += 24
+      self.hand_poses.left_pose.pos_xyz = _get_struct_3d().unpack(str[start:end])
+      start = end
+      end += 32
+      self.hand_poses.left_pose.quat_xyzw = _get_struct_4d().unpack(str[start:end])
+      start = end
+      end += 24
+      self.hand_poses.left_pose.elbow_pos_xyz = _get_struct_3d().unpack(str[start:end])
+      start = end
+      end += 4
+      (length,) = _struct_I.unpack(str[start:end])
+      pattern = '<%sd'%length
+      start = end
+      s = struct.Struct(pattern)
+      end += s.size
+      self.hand_poses.left_pose.joint_angles = s.unpack(str[start:end])
+      start = end
+      end += 24
+      self.hand_poses.right_pose.pos_xyz = _get_struct_3d().unpack(str[start:end])
+      start = end
+      end += 32
+      self.hand_poses.right_pose.quat_xyzw = _get_struct_4d().unpack(str[start:end])
+      start = end
+      end += 24
+      self.hand_poses.right_pose.elbow_pos_xyz = _get_struct_3d().unpack(str[start:end])
+      start = end
+      end += 4
+      (length,) = _struct_I.unpack(str[start:end])
+      pattern = '<%sd'%length
+      start = end
+      s = struct.Struct(pattern)
+      end += s.size
+      self.hand_poses.right_pose.joint_angles = s.unpack(str[start:end])
+      return self
+    except struct.error as e:
+      raise genpy.DeserializationError(e)  # most likely buffer underfill
+
+
+  def serialize_numpy(self, buff, numpy):
+    """
+    serialize message with numpy array types into buffer
+    :param buff: buffer, ``StringIO``
+    :param numpy: numpy python module
+    """
+    try:
+      _x = self
+      buff.write(_get_struct_2B().pack(_x.success, _x.with_torso))
+      length = len(self.q_arm)
+      buff.write(_struct_I.pack(length))
+      pattern = '<%sd'%length
+      buff.write(self.q_arm.tostring())
+      length = len(self.q_torso)
+      buff.write(_struct_I.pack(length))
+      pattern = '<%sd'%length
+      buff.write(self.q_torso.tostring())
+      _x = self
+      buff.write(_get_struct_d3I().pack(_x.time_cost, _x.hand_poses.header.seq, _x.hand_poses.header.stamp.secs, _x.hand_poses.header.stamp.nsecs))
+      _x = self.hand_poses.header.frame_id
+      length = len(_x)
+      if python3 or type(_x) == unicode:
+        _x = _x.encode('utf-8')
+        length = len(_x)
+      buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
+      buff.write(self.hand_poses.left_pose.pos_xyz.tostring())
+      buff.write(self.hand_poses.left_pose.quat_xyzw.tostring())
+      buff.write(self.hand_poses.left_pose.elbow_pos_xyz.tostring())
+      length = len(self.hand_poses.left_pose.joint_angles)
+      buff.write(_struct_I.pack(length))
+      pattern = '<%sd'%length
+      buff.write(self.hand_poses.left_pose.joint_angles.tostring())
+      buff.write(self.hand_poses.right_pose.pos_xyz.tostring())
+      buff.write(self.hand_poses.right_pose.quat_xyzw.tostring())
+      buff.write(self.hand_poses.right_pose.elbow_pos_xyz.tostring())
+      length = len(self.hand_poses.right_pose.joint_angles)
+      buff.write(_struct_I.pack(length))
+      pattern = '<%sd'%length
+      buff.write(self.hand_poses.right_pose.joint_angles.tostring())
+    except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
+    except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
+
+  def deserialize_numpy(self, str, numpy):
+    """
+    unpack serialized message in str into this message instance using numpy for array types
+    :param str: byte array of serialized message, ``str``
+    :param numpy: numpy python module
+    """
+    if python3:
+      codecs.lookup_error("rosmsg").msg_type = self._type
+    try:
+      if self.hand_poses is None:
+        self.hand_poses = kuavo_msgs.msg.twoArmHandPoseFree()
+      end = 0
+      _x = self
+      start = end
+      end += 2
+      (_x.success, _x.with_torso,) = _get_struct_2B().unpack(str[start:end])
+      self.success = bool(self.success)
+      self.with_torso = bool(self.with_torso)
+      start = end
+      end += 4
+      (length,) = _struct_I.unpack(str[start:end])
+      pattern = '<%sd'%length
+      start = end
+      s = struct.Struct(pattern)
+      end += s.size
+      self.q_arm = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length)
+      start = end
+      end += 4
+      (length,) = _struct_I.unpack(str[start:end])
+      pattern = '<%sd'%length
+      start = end
+      s = struct.Struct(pattern)
+      end += s.size
+      self.q_torso = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length)
+      _x = self
+      start = end
+      end += 20
+      (_x.time_cost, _x.hand_poses.header.seq, _x.hand_poses.header.stamp.secs, _x.hand_poses.header.stamp.nsecs,) = _get_struct_d3I().unpack(str[start:end])
+      start = end
+      end += 4
+      (length,) = _struct_I.unpack(str[start:end])
+      start = end
+      end += length
+      if python3:
+        self.hand_poses.header.frame_id = str[start:end].decode('utf-8', 'rosmsg')
+      else:
+        self.hand_poses.header.frame_id = str[start:end]
+      start = end
+      end += 24
+      self.hand_poses.left_pose.pos_xyz = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=3)
+      start = end
+      end += 32
+      self.hand_poses.left_pose.quat_xyzw = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=4)
+      start = end
+      end += 24
+      self.hand_poses.left_pose.elbow_pos_xyz = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=3)
+      start = end
+      end += 4
+      (length,) = _struct_I.unpack(str[start:end])
+      pattern = '<%sd'%length
+      start = end
+      s = struct.Struct(pattern)
+      end += s.size
+      self.hand_poses.left_pose.joint_angles = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length)
+      start = end
+      end += 24
+      self.hand_poses.right_pose.pos_xyz = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=3)
+      start = end
+      end += 32
+      self.hand_poses.right_pose.quat_xyzw = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=4)
+      start = end
+      end += 24
+      self.hand_poses.right_pose.elbow_pos_xyz = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=3)
+      start = end
+      end += 4
+      (length,) = _struct_I.unpack(str[start:end])
+      pattern = '<%sd'%length
+      start = end
+      s = struct.Struct(pattern)
+      end += s.size
+      self.hand_poses.right_pose.joint_angles = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length)
+      return self
+    except struct.error as e:
+      raise genpy.DeserializationError(e)  # most likely buffer underfill
+
+_struct_I = genpy.struct_I
+def _get_struct_I():
+    global _struct_I
+    return _struct_I
+_struct_2B = None
+def _get_struct_2B():
+    global _struct_2B
+    if _struct_2B is None:
+        _struct_2B = struct.Struct("<2B")
+    return _struct_2B
+_struct_3d = None
+def _get_struct_3d():
+    global _struct_3d
+    if _struct_3d is None:
+        _struct_3d = struct.Struct("<3d")
+    return _struct_3d
+_struct_4d = None
+def _get_struct_4d():
+    global _struct_4d
+    if _struct_4d is None:
+        _struct_4d = struct.Struct("<4d")
+    return _struct_4d
+_struct_d3I = None
+def _get_struct_d3I():
+    global _struct_d3I
+    if _struct_d3I is None:
+        _struct_d3I = struct.Struct("<d3I")
+    return _struct_d3I
+class twoArmHandPoseCmdFreeSrv(object):
+  _type          = 'kuavo_msgs/twoArmHandPoseCmdFreeSrv'
+  _md5sum = '9e826e4318978cda947091039c85e59e'
+  _request_class  = twoArmHandPoseCmdFreeSrvRequest
+  _response_class = twoArmHandPoseCmdFreeSrvResponse