kuavo-humanoid-sdk 1.1.2a692__py3-none-any.whl → 1.1.2a922__py3-none-any.whl

This diff represents the content of publicly available package versions that have been released to one of the supported registries. The information contained in this diff is provided for informational purposes only and reflects changes between package versions as they appear in their respective public registries.

Potentially problematic release.


This version of kuavo-humanoid-sdk might be problematic. Click here for more details.

Files changed (83) hide show
  1. kuavo_humanoid_sdk/kuavo/core/ros/state.py +1 -1
  2. kuavo_humanoid_sdk/msg/__init__.py +4 -0
  3. kuavo_humanoid_sdk/msg/kuavo_msgs/__init__.py +7 -0
  4. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_Metadata.py +199 -0
  5. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/__init__.py +26 -0
  6. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_armPoseWithTimeStamp.py +168 -0
  7. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_armTargetPoses.py +151 -0
  8. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_dexhandCommand.py +229 -0
  9. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_dexhandTouchState.py +256 -0
  10. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_endEffectorData.py +227 -0
  11. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPose.py +122 -0
  12. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPoseTargetTrajectories.py +203 -0
  13. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_gaitTimeName.py +147 -0
  14. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_gestureInfo.py +218 -0
  15. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_gestureTask.py +149 -0
  16. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_headBodyPose.py +145 -0
  17. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_imuData.py +165 -0
  18. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_jointCmd.py +390 -0
  19. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_jointData.py +205 -0
  20. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_lejuClawCommand.py +320 -0
  21. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_lejuClawState.py +341 -0
  22. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_questJoySticks.py +191 -0
  23. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_robotHandPosition.py +225 -0
  24. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_robotHeadMotionData.py +128 -0
  25. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_robotState.py +222 -0
  26. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_sensorsData.py +495 -0
  27. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_switchGaitByName.py +200 -0
  28. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_touchSensorStatus.py +162 -0
  29. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_yoloDetection.py +251 -0
  30. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_yoloOutputData.py +168 -0
  31. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/__init__.py +15 -0
  32. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_changeArmCtrlMode.py +275 -0
  33. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_changeTorsoCtrlMode.py +274 -0
  34. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_controlLejuClaw.py +408 -0
  35. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_enableHandTouchSensor.py +304 -0
  36. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_footPoseTargetTrajectoriesSrv.py +321 -0
  37. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_gestureExecute.py +339 -0
  38. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_gestureExecuteState.py +257 -0
  39. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_gestureList.py +418 -0
  40. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_getCurrentGaitName.py +253 -0
  41. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_handForceLevel.py +330 -0
  42. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_jointMoveTo.py +302 -0
  43. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_setHwIntialState.py +304 -0
  44. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_setMotorEncoderRoundService.py +283 -0
  45. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_setTagId.py +275 -0
  46. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_singleStepControl.py +356 -0
  47. kuavo_humanoid_sdk/msg/motion_capture_ik/__init__.py +7 -0
  48. kuavo_humanoid_sdk/msg/motion_capture_ik/msg/__init__.py +9 -0
  49. kuavo_humanoid_sdk/msg/motion_capture_ik/msg/_armHandPose.py +160 -0
  50. kuavo_humanoid_sdk/msg/motion_capture_ik/msg/_handPose.py +136 -0
  51. kuavo_humanoid_sdk/msg/motion_capture_ik/msg/_headBodyPose.py +145 -0
  52. kuavo_humanoid_sdk/msg/motion_capture_ik/msg/_ikSolveError.py +171 -0
  53. kuavo_humanoid_sdk/msg/motion_capture_ik/msg/_ikSolveParam.py +140 -0
  54. kuavo_humanoid_sdk/msg/motion_capture_ik/msg/_robotArmQVVD.py +177 -0
  55. kuavo_humanoid_sdk/msg/motion_capture_ik/msg/_robotHandPosition.py +225 -0
  56. kuavo_humanoid_sdk/msg/motion_capture_ik/msg/_twoArmHandPose.py +272 -0
  57. kuavo_humanoid_sdk/msg/motion_capture_ik/msg/_twoArmHandPoseCmd.py +311 -0
  58. kuavo_humanoid_sdk/msg/motion_capture_ik/srv/__init__.py +4 -0
  59. kuavo_humanoid_sdk/msg/motion_capture_ik/srv/_changeArmCtrlMode.py +275 -0
  60. kuavo_humanoid_sdk/msg/motion_capture_ik/srv/_changeArmCtrlModeKuavo.py +236 -0
  61. kuavo_humanoid_sdk/msg/motion_capture_ik/srv/_fkSrv.py +394 -0
  62. kuavo_humanoid_sdk/msg/motion_capture_ik/srv/_twoArmHandPoseCmdSrv.py +661 -0
  63. kuavo_humanoid_sdk/msg/ocs2_msgs/__init__.py +7 -0
  64. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/__init__.py +12 -0
  65. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_constraint.py +142 -0
  66. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_controller_data.py +121 -0
  67. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_lagrangian_metrics.py +148 -0
  68. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mode_schedule.py +150 -0
  69. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_flattened_controller.py +666 -0
  70. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_input.py +122 -0
  71. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_observation.py +209 -0
  72. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_performance_indices.py +140 -0
  73. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_solver_data.py +886 -0
  74. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_state.py +122 -0
  75. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_target_trajectories.py +239 -0
  76. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_multiplier.py +148 -0
  77. kuavo_humanoid_sdk/msg/ocs2_msgs/srv/__init__.py +1 -0
  78. kuavo_humanoid_sdk/msg/ocs2_msgs/srv/_reset.py +376 -0
  79. {kuavo_humanoid_sdk-1.1.2a692.dist-info → kuavo_humanoid_sdk-1.1.2a922.dist-info}/METADATA +2 -2
  80. kuavo_humanoid_sdk-1.1.2a922.dist-info/RECORD +104 -0
  81. kuavo_humanoid_sdk-1.1.2a692.dist-info/RECORD +0 -27
  82. {kuavo_humanoid_sdk-1.1.2a692.dist-info → kuavo_humanoid_sdk-1.1.2a922.dist-info}/WHEEL +0 -0
  83. {kuavo_humanoid_sdk-1.1.2a692.dist-info → kuavo_humanoid_sdk-1.1.2a922.dist-info}/top_level.txt +0 -0
@@ -0,0 +1,311 @@
1
+ # This Python file uses the following encoding: utf-8
2
+ """autogenerated by genpy from motion_capture_ik/twoArmHandPoseCmd.msg. Do not edit."""
3
+ import codecs
4
+ import sys
5
+ python3 = True if sys.hexversion > 0x03000000 else False
6
+ import genpy
7
+ import struct
8
+
9
+ import motion_capture_ik.msg
10
+ import std_msgs.msg
11
+
12
+ class twoArmHandPoseCmd(genpy.Message):
13
+ _md5sum = "d4b6792a6f960bea428fd7158220110b"
14
+ _type = "motion_capture_ik/twoArmHandPoseCmd"
15
+ _has_header = False # flag to mark the presence of a Header object
16
+ _full_text = """twoArmHandPose hand_poses
17
+ # params for the IK solver
18
+ bool use_custom_ik_param
19
+ bool joint_angles_as_q0
20
+ ikSolveParam ik_param
21
+ ================================================================================
22
+ MSG: motion_capture_ik/twoArmHandPose
23
+ Header header
24
+ armHandPose left_pose
25
+ armHandPose right_pose
26
+ ================================================================================
27
+ MSG: std_msgs/Header
28
+ # Standard metadata for higher-level stamped data types.
29
+ # This is generally used to communicate timestamped data
30
+ # in a particular coordinate frame.
31
+ #
32
+ # sequence ID: consecutively increasing ID
33
+ uint32 seq
34
+ #Two-integer timestamp that is expressed as:
35
+ # * stamp.sec: seconds (stamp_secs) since epoch (in Python the variable is called 'secs')
36
+ # * stamp.nsec: nanoseconds since stamp_secs (in Python the variable is called 'nsecs')
37
+ # time-handling sugar is provided by the client library
38
+ time stamp
39
+ #Frame this data is associated with
40
+ string frame_id
41
+
42
+ ================================================================================
43
+ MSG: motion_capture_ik/armHandPose
44
+ float64[3] pos_xyz
45
+ float64[4] quat_xyzw
46
+
47
+ float64[3] elbow_pos_xyz
48
+
49
+ float64[7] joint_angles
50
+ ================================================================================
51
+ MSG: motion_capture_ik/ikSolveParam
52
+ # snopt params
53
+ float64 major_optimality_tol
54
+ float64 major_feasibility_tol
55
+ float64 minor_feasibility_tol
56
+ float64 major_iterations_limit
57
+ # constraint and cost params
58
+ float64 oritation_constraint_tol
59
+ float64 pos_constraint_tol # work when pos_cost_weight > 0.0
60
+ float64 pos_cost_weight"""
61
+ __slots__ = ['hand_poses','use_custom_ik_param','joint_angles_as_q0','ik_param']
62
+ _slot_types = ['motion_capture_ik/twoArmHandPose','bool','bool','motion_capture_ik/ikSolveParam']
63
+
64
+ def __init__(self, *args, **kwds):
65
+ """
66
+ Constructor. Any message fields that are implicitly/explicitly
67
+ set to None will be assigned a default value. The recommend
68
+ use is keyword arguments as this is more robust to future message
69
+ changes. You cannot mix in-order arguments and keyword arguments.
70
+
71
+ The available fields are:
72
+ hand_poses,use_custom_ik_param,joint_angles_as_q0,ik_param
73
+
74
+ :param args: complete set of field values, in .msg order
75
+ :param kwds: use keyword arguments corresponding to message field names
76
+ to set specific fields.
77
+ """
78
+ if args or kwds:
79
+ super(twoArmHandPoseCmd, self).__init__(*args, **kwds)
80
+ # message fields cannot be None, assign default values for those that are
81
+ if self.hand_poses is None:
82
+ self.hand_poses = motion_capture_ik.msg.twoArmHandPose()
83
+ if self.use_custom_ik_param is None:
84
+ self.use_custom_ik_param = False
85
+ if self.joint_angles_as_q0 is None:
86
+ self.joint_angles_as_q0 = False
87
+ if self.ik_param is None:
88
+ self.ik_param = motion_capture_ik.msg.ikSolveParam()
89
+ else:
90
+ self.hand_poses = motion_capture_ik.msg.twoArmHandPose()
91
+ self.use_custom_ik_param = False
92
+ self.joint_angles_as_q0 = False
93
+ self.ik_param = motion_capture_ik.msg.ikSolveParam()
94
+
95
+ def _get_types(self):
96
+ """
97
+ internal API method
98
+ """
99
+ return self._slot_types
100
+
101
+ def serialize(self, buff):
102
+ """
103
+ serialize message into buffer
104
+ :param buff: buffer, ``StringIO``
105
+ """
106
+ try:
107
+ _x = self
108
+ buff.write(_get_struct_3I().pack(_x.hand_poses.header.seq, _x.hand_poses.header.stamp.secs, _x.hand_poses.header.stamp.nsecs))
109
+ _x = self.hand_poses.header.frame_id
110
+ length = len(_x)
111
+ if python3 or type(_x) == unicode:
112
+ _x = _x.encode('utf-8')
113
+ length = len(_x)
114
+ buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
115
+ buff.write(_get_struct_3d().pack(*self.hand_poses.left_pose.pos_xyz))
116
+ buff.write(_get_struct_4d().pack(*self.hand_poses.left_pose.quat_xyzw))
117
+ buff.write(_get_struct_3d().pack(*self.hand_poses.left_pose.elbow_pos_xyz))
118
+ buff.write(_get_struct_7d().pack(*self.hand_poses.left_pose.joint_angles))
119
+ buff.write(_get_struct_3d().pack(*self.hand_poses.right_pose.pos_xyz))
120
+ buff.write(_get_struct_4d().pack(*self.hand_poses.right_pose.quat_xyzw))
121
+ buff.write(_get_struct_3d().pack(*self.hand_poses.right_pose.elbow_pos_xyz))
122
+ buff.write(_get_struct_7d().pack(*self.hand_poses.right_pose.joint_angles))
123
+ _x = self
124
+ buff.write(_get_struct_2B7d().pack(_x.use_custom_ik_param, _x.joint_angles_as_q0, _x.ik_param.major_optimality_tol, _x.ik_param.major_feasibility_tol, _x.ik_param.minor_feasibility_tol, _x.ik_param.major_iterations_limit, _x.ik_param.oritation_constraint_tol, _x.ik_param.pos_constraint_tol, _x.ik_param.pos_cost_weight))
125
+ except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
126
+ except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
127
+
128
+ def deserialize(self, str):
129
+ """
130
+ unpack serialized message in str into this message instance
131
+ :param str: byte array of serialized message, ``str``
132
+ """
133
+ if python3:
134
+ codecs.lookup_error("rosmsg").msg_type = self._type
135
+ try:
136
+ if self.hand_poses is None:
137
+ self.hand_poses = motion_capture_ik.msg.twoArmHandPose()
138
+ if self.ik_param is None:
139
+ self.ik_param = motion_capture_ik.msg.ikSolveParam()
140
+ end = 0
141
+ _x = self
142
+ start = end
143
+ end += 12
144
+ (_x.hand_poses.header.seq, _x.hand_poses.header.stamp.secs, _x.hand_poses.header.stamp.nsecs,) = _get_struct_3I().unpack(str[start:end])
145
+ start = end
146
+ end += 4
147
+ (length,) = _struct_I.unpack(str[start:end])
148
+ start = end
149
+ end += length
150
+ if python3:
151
+ self.hand_poses.header.frame_id = str[start:end].decode('utf-8', 'rosmsg')
152
+ else:
153
+ self.hand_poses.header.frame_id = str[start:end]
154
+ start = end
155
+ end += 24
156
+ self.hand_poses.left_pose.pos_xyz = _get_struct_3d().unpack(str[start:end])
157
+ start = end
158
+ end += 32
159
+ self.hand_poses.left_pose.quat_xyzw = _get_struct_4d().unpack(str[start:end])
160
+ start = end
161
+ end += 24
162
+ self.hand_poses.left_pose.elbow_pos_xyz = _get_struct_3d().unpack(str[start:end])
163
+ start = end
164
+ end += 56
165
+ self.hand_poses.left_pose.joint_angles = _get_struct_7d().unpack(str[start:end])
166
+ start = end
167
+ end += 24
168
+ self.hand_poses.right_pose.pos_xyz = _get_struct_3d().unpack(str[start:end])
169
+ start = end
170
+ end += 32
171
+ self.hand_poses.right_pose.quat_xyzw = _get_struct_4d().unpack(str[start:end])
172
+ start = end
173
+ end += 24
174
+ self.hand_poses.right_pose.elbow_pos_xyz = _get_struct_3d().unpack(str[start:end])
175
+ start = end
176
+ end += 56
177
+ self.hand_poses.right_pose.joint_angles = _get_struct_7d().unpack(str[start:end])
178
+ _x = self
179
+ start = end
180
+ end += 58
181
+ (_x.use_custom_ik_param, _x.joint_angles_as_q0, _x.ik_param.major_optimality_tol, _x.ik_param.major_feasibility_tol, _x.ik_param.minor_feasibility_tol, _x.ik_param.major_iterations_limit, _x.ik_param.oritation_constraint_tol, _x.ik_param.pos_constraint_tol, _x.ik_param.pos_cost_weight,) = _get_struct_2B7d().unpack(str[start:end])
182
+ self.use_custom_ik_param = bool(self.use_custom_ik_param)
183
+ self.joint_angles_as_q0 = bool(self.joint_angles_as_q0)
184
+ return self
185
+ except struct.error as e:
186
+ raise genpy.DeserializationError(e) # most likely buffer underfill
187
+
188
+
189
+ def serialize_numpy(self, buff, numpy):
190
+ """
191
+ serialize message with numpy array types into buffer
192
+ :param buff: buffer, ``StringIO``
193
+ :param numpy: numpy python module
194
+ """
195
+ try:
196
+ _x = self
197
+ buff.write(_get_struct_3I().pack(_x.hand_poses.header.seq, _x.hand_poses.header.stamp.secs, _x.hand_poses.header.stamp.nsecs))
198
+ _x = self.hand_poses.header.frame_id
199
+ length = len(_x)
200
+ if python3 or type(_x) == unicode:
201
+ _x = _x.encode('utf-8')
202
+ length = len(_x)
203
+ buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
204
+ buff.write(self.hand_poses.left_pose.pos_xyz.tostring())
205
+ buff.write(self.hand_poses.left_pose.quat_xyzw.tostring())
206
+ buff.write(self.hand_poses.left_pose.elbow_pos_xyz.tostring())
207
+ buff.write(self.hand_poses.left_pose.joint_angles.tostring())
208
+ buff.write(self.hand_poses.right_pose.pos_xyz.tostring())
209
+ buff.write(self.hand_poses.right_pose.quat_xyzw.tostring())
210
+ buff.write(self.hand_poses.right_pose.elbow_pos_xyz.tostring())
211
+ buff.write(self.hand_poses.right_pose.joint_angles.tostring())
212
+ _x = self
213
+ buff.write(_get_struct_2B7d().pack(_x.use_custom_ik_param, _x.joint_angles_as_q0, _x.ik_param.major_optimality_tol, _x.ik_param.major_feasibility_tol, _x.ik_param.minor_feasibility_tol, _x.ik_param.major_iterations_limit, _x.ik_param.oritation_constraint_tol, _x.ik_param.pos_constraint_tol, _x.ik_param.pos_cost_weight))
214
+ except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
215
+ except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
216
+
217
+ def deserialize_numpy(self, str, numpy):
218
+ """
219
+ unpack serialized message in str into this message instance using numpy for array types
220
+ :param str: byte array of serialized message, ``str``
221
+ :param numpy: numpy python module
222
+ """
223
+ if python3:
224
+ codecs.lookup_error("rosmsg").msg_type = self._type
225
+ try:
226
+ if self.hand_poses is None:
227
+ self.hand_poses = motion_capture_ik.msg.twoArmHandPose()
228
+ if self.ik_param is None:
229
+ self.ik_param = motion_capture_ik.msg.ikSolveParam()
230
+ end = 0
231
+ _x = self
232
+ start = end
233
+ end += 12
234
+ (_x.hand_poses.header.seq, _x.hand_poses.header.stamp.secs, _x.hand_poses.header.stamp.nsecs,) = _get_struct_3I().unpack(str[start:end])
235
+ start = end
236
+ end += 4
237
+ (length,) = _struct_I.unpack(str[start:end])
238
+ start = end
239
+ end += length
240
+ if python3:
241
+ self.hand_poses.header.frame_id = str[start:end].decode('utf-8', 'rosmsg')
242
+ else:
243
+ self.hand_poses.header.frame_id = str[start:end]
244
+ start = end
245
+ end += 24
246
+ self.hand_poses.left_pose.pos_xyz = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=3)
247
+ start = end
248
+ end += 32
249
+ self.hand_poses.left_pose.quat_xyzw = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=4)
250
+ start = end
251
+ end += 24
252
+ self.hand_poses.left_pose.elbow_pos_xyz = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=3)
253
+ start = end
254
+ end += 56
255
+ self.hand_poses.left_pose.joint_angles = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=7)
256
+ start = end
257
+ end += 24
258
+ self.hand_poses.right_pose.pos_xyz = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=3)
259
+ start = end
260
+ end += 32
261
+ self.hand_poses.right_pose.quat_xyzw = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=4)
262
+ start = end
263
+ end += 24
264
+ self.hand_poses.right_pose.elbow_pos_xyz = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=3)
265
+ start = end
266
+ end += 56
267
+ self.hand_poses.right_pose.joint_angles = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=7)
268
+ _x = self
269
+ start = end
270
+ end += 58
271
+ (_x.use_custom_ik_param, _x.joint_angles_as_q0, _x.ik_param.major_optimality_tol, _x.ik_param.major_feasibility_tol, _x.ik_param.minor_feasibility_tol, _x.ik_param.major_iterations_limit, _x.ik_param.oritation_constraint_tol, _x.ik_param.pos_constraint_tol, _x.ik_param.pos_cost_weight,) = _get_struct_2B7d().unpack(str[start:end])
272
+ self.use_custom_ik_param = bool(self.use_custom_ik_param)
273
+ self.joint_angles_as_q0 = bool(self.joint_angles_as_q0)
274
+ return self
275
+ except struct.error as e:
276
+ raise genpy.DeserializationError(e) # most likely buffer underfill
277
+
278
+ _struct_I = genpy.struct_I
279
+ def _get_struct_I():
280
+ global _struct_I
281
+ return _struct_I
282
+ _struct_2B7d = None
283
+ def _get_struct_2B7d():
284
+ global _struct_2B7d
285
+ if _struct_2B7d is None:
286
+ _struct_2B7d = struct.Struct("<2B7d")
287
+ return _struct_2B7d
288
+ _struct_3I = None
289
+ def _get_struct_3I():
290
+ global _struct_3I
291
+ if _struct_3I is None:
292
+ _struct_3I = struct.Struct("<3I")
293
+ return _struct_3I
294
+ _struct_3d = None
295
+ def _get_struct_3d():
296
+ global _struct_3d
297
+ if _struct_3d is None:
298
+ _struct_3d = struct.Struct("<3d")
299
+ return _struct_3d
300
+ _struct_4d = None
301
+ def _get_struct_4d():
302
+ global _struct_4d
303
+ if _struct_4d is None:
304
+ _struct_4d = struct.Struct("<4d")
305
+ return _struct_4d
306
+ _struct_7d = None
307
+ def _get_struct_7d():
308
+ global _struct_7d
309
+ if _struct_7d is None:
310
+ _struct_7d = struct.Struct("<7d")
311
+ return _struct_7d
@@ -0,0 +1,4 @@
1
+ from ._changeArmCtrlMode import *
2
+ from ._changeArmCtrlModeKuavo import *
3
+ from ._fkSrv import *
4
+ from ._twoArmHandPoseCmdSrv import *
@@ -0,0 +1,275 @@
1
+ # This Python file uses the following encoding: utf-8
2
+ """autogenerated by genpy from motion_capture_ik/changeArmCtrlModeRequest.msg. Do not edit."""
3
+ import codecs
4
+ import sys
5
+ python3 = True if sys.hexversion > 0x03000000 else False
6
+ import genpy
7
+ import struct
8
+
9
+
10
+ class changeArmCtrlModeRequest(genpy.Message):
11
+ _md5sum = "1f5907fdb226711da233100c712cc0eb"
12
+ _type = "motion_capture_ik/changeArmCtrlModeRequest"
13
+ _has_header = False # flag to mark the presence of a Header object
14
+ _full_text = """int32 control_mode # 0: keep pose, 1: auto_swing_arm, 2: external_control
15
+ """
16
+ __slots__ = ['control_mode']
17
+ _slot_types = ['int32']
18
+
19
+ def __init__(self, *args, **kwds):
20
+ """
21
+ Constructor. Any message fields that are implicitly/explicitly
22
+ set to None will be assigned a default value. The recommend
23
+ use is keyword arguments as this is more robust to future message
24
+ changes. You cannot mix in-order arguments and keyword arguments.
25
+
26
+ The available fields are:
27
+ control_mode
28
+
29
+ :param args: complete set of field values, in .msg order
30
+ :param kwds: use keyword arguments corresponding to message field names
31
+ to set specific fields.
32
+ """
33
+ if args or kwds:
34
+ super(changeArmCtrlModeRequest, self).__init__(*args, **kwds)
35
+ # message fields cannot be None, assign default values for those that are
36
+ if self.control_mode is None:
37
+ self.control_mode = 0
38
+ else:
39
+ self.control_mode = 0
40
+
41
+ def _get_types(self):
42
+ """
43
+ internal API method
44
+ """
45
+ return self._slot_types
46
+
47
+ def serialize(self, buff):
48
+ """
49
+ serialize message into buffer
50
+ :param buff: buffer, ``StringIO``
51
+ """
52
+ try:
53
+ _x = self.control_mode
54
+ buff.write(_get_struct_i().pack(_x))
55
+ except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
56
+ except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
57
+
58
+ def deserialize(self, str):
59
+ """
60
+ unpack serialized message in str into this message instance
61
+ :param str: byte array of serialized message, ``str``
62
+ """
63
+ if python3:
64
+ codecs.lookup_error("rosmsg").msg_type = self._type
65
+ try:
66
+ end = 0
67
+ start = end
68
+ end += 4
69
+ (self.control_mode,) = _get_struct_i().unpack(str[start:end])
70
+ return self
71
+ except struct.error as e:
72
+ raise genpy.DeserializationError(e) # most likely buffer underfill
73
+
74
+
75
+ def serialize_numpy(self, buff, numpy):
76
+ """
77
+ serialize message with numpy array types into buffer
78
+ :param buff: buffer, ``StringIO``
79
+ :param numpy: numpy python module
80
+ """
81
+ try:
82
+ _x = self.control_mode
83
+ buff.write(_get_struct_i().pack(_x))
84
+ except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
85
+ except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
86
+
87
+ def deserialize_numpy(self, str, numpy):
88
+ """
89
+ unpack serialized message in str into this message instance using numpy for array types
90
+ :param str: byte array of serialized message, ``str``
91
+ :param numpy: numpy python module
92
+ """
93
+ if python3:
94
+ codecs.lookup_error("rosmsg").msg_type = self._type
95
+ try:
96
+ end = 0
97
+ start = end
98
+ end += 4
99
+ (self.control_mode,) = _get_struct_i().unpack(str[start:end])
100
+ return self
101
+ except struct.error as e:
102
+ raise genpy.DeserializationError(e) # most likely buffer underfill
103
+
104
+ _struct_I = genpy.struct_I
105
+ def _get_struct_I():
106
+ global _struct_I
107
+ return _struct_I
108
+ _struct_i = None
109
+ def _get_struct_i():
110
+ global _struct_i
111
+ if _struct_i is None:
112
+ _struct_i = struct.Struct("<i")
113
+ return _struct_i
114
+ # This Python file uses the following encoding: utf-8
115
+ """autogenerated by genpy from motion_capture_ik/changeArmCtrlModeResponse.msg. Do not edit."""
116
+ import codecs
117
+ import sys
118
+ python3 = True if sys.hexversion > 0x03000000 else False
119
+ import genpy
120
+ import struct
121
+
122
+
123
+ class changeArmCtrlModeResponse(genpy.Message):
124
+ _md5sum = "2f115bf9b7d68ace12ac850b142c1536"
125
+ _type = "motion_capture_ik/changeArmCtrlModeResponse"
126
+ _has_header = False # flag to mark the presence of a Header object
127
+ _full_text = """bool result
128
+ int32 mode
129
+ string message
130
+
131
+
132
+ """
133
+ __slots__ = ['result','mode','message']
134
+ _slot_types = ['bool','int32','string']
135
+
136
+ def __init__(self, *args, **kwds):
137
+ """
138
+ Constructor. Any message fields that are implicitly/explicitly
139
+ set to None will be assigned a default value. The recommend
140
+ use is keyword arguments as this is more robust to future message
141
+ changes. You cannot mix in-order arguments and keyword arguments.
142
+
143
+ The available fields are:
144
+ result,mode,message
145
+
146
+ :param args: complete set of field values, in .msg order
147
+ :param kwds: use keyword arguments corresponding to message field names
148
+ to set specific fields.
149
+ """
150
+ if args or kwds:
151
+ super(changeArmCtrlModeResponse, self).__init__(*args, **kwds)
152
+ # message fields cannot be None, assign default values for those that are
153
+ if self.result is None:
154
+ self.result = False
155
+ if self.mode is None:
156
+ self.mode = 0
157
+ if self.message is None:
158
+ self.message = ''
159
+ else:
160
+ self.result = False
161
+ self.mode = 0
162
+ self.message = ''
163
+
164
+ def _get_types(self):
165
+ """
166
+ internal API method
167
+ """
168
+ return self._slot_types
169
+
170
+ def serialize(self, buff):
171
+ """
172
+ serialize message into buffer
173
+ :param buff: buffer, ``StringIO``
174
+ """
175
+ try:
176
+ _x = self
177
+ buff.write(_get_struct_Bi().pack(_x.result, _x.mode))
178
+ _x = self.message
179
+ length = len(_x)
180
+ if python3 or type(_x) == unicode:
181
+ _x = _x.encode('utf-8')
182
+ length = len(_x)
183
+ buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
184
+ except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
185
+ except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
186
+
187
+ def deserialize(self, str):
188
+ """
189
+ unpack serialized message in str into this message instance
190
+ :param str: byte array of serialized message, ``str``
191
+ """
192
+ if python3:
193
+ codecs.lookup_error("rosmsg").msg_type = self._type
194
+ try:
195
+ end = 0
196
+ _x = self
197
+ start = end
198
+ end += 5
199
+ (_x.result, _x.mode,) = _get_struct_Bi().unpack(str[start:end])
200
+ self.result = bool(self.result)
201
+ start = end
202
+ end += 4
203
+ (length,) = _struct_I.unpack(str[start:end])
204
+ start = end
205
+ end += length
206
+ if python3:
207
+ self.message = str[start:end].decode('utf-8', 'rosmsg')
208
+ else:
209
+ self.message = str[start:end]
210
+ return self
211
+ except struct.error as e:
212
+ raise genpy.DeserializationError(e) # most likely buffer underfill
213
+
214
+
215
+ def serialize_numpy(self, buff, numpy):
216
+ """
217
+ serialize message with numpy array types into buffer
218
+ :param buff: buffer, ``StringIO``
219
+ :param numpy: numpy python module
220
+ """
221
+ try:
222
+ _x = self
223
+ buff.write(_get_struct_Bi().pack(_x.result, _x.mode))
224
+ _x = self.message
225
+ length = len(_x)
226
+ if python3 or type(_x) == unicode:
227
+ _x = _x.encode('utf-8')
228
+ length = len(_x)
229
+ buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
230
+ except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
231
+ except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
232
+
233
+ def deserialize_numpy(self, str, numpy):
234
+ """
235
+ unpack serialized message in str into this message instance using numpy for array types
236
+ :param str: byte array of serialized message, ``str``
237
+ :param numpy: numpy python module
238
+ """
239
+ if python3:
240
+ codecs.lookup_error("rosmsg").msg_type = self._type
241
+ try:
242
+ end = 0
243
+ _x = self
244
+ start = end
245
+ end += 5
246
+ (_x.result, _x.mode,) = _get_struct_Bi().unpack(str[start:end])
247
+ self.result = bool(self.result)
248
+ start = end
249
+ end += 4
250
+ (length,) = _struct_I.unpack(str[start:end])
251
+ start = end
252
+ end += length
253
+ if python3:
254
+ self.message = str[start:end].decode('utf-8', 'rosmsg')
255
+ else:
256
+ self.message = str[start:end]
257
+ return self
258
+ except struct.error as e:
259
+ raise genpy.DeserializationError(e) # most likely buffer underfill
260
+
261
+ _struct_I = genpy.struct_I
262
+ def _get_struct_I():
263
+ global _struct_I
264
+ return _struct_I
265
+ _struct_Bi = None
266
+ def _get_struct_Bi():
267
+ global _struct_Bi
268
+ if _struct_Bi is None:
269
+ _struct_Bi = struct.Struct("<Bi")
270
+ return _struct_Bi
271
+ class changeArmCtrlMode(object):
272
+ _type = 'motion_capture_ik/changeArmCtrlMode'
273
+ _md5sum = '8a8d154c05ee16e8f5d2b72d9bb51026'
274
+ _request_class = changeArmCtrlModeRequest
275
+ _response_class = changeArmCtrlModeResponse