kuavo-humanoid-sdk 1.1.5__py3-none-any.whl → 1.1.6__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.
- kuavo_humanoid_sdk/__init__.py +0 -2
- kuavo_humanoid_sdk/interfaces/data_types.py +0 -90
- kuavo_humanoid_sdk/kuavo/__init__.py +0 -3
- kuavo_humanoid_sdk/kuavo/core/core.py +20 -238
- kuavo_humanoid_sdk/kuavo/core/ros/control.py +27 -1087
- kuavo_humanoid_sdk/kuavo/core/ros/param.py +4 -142
- kuavo_humanoid_sdk/kuavo/core/ros/state.py +19 -556
- kuavo_humanoid_sdk/kuavo/core/ros_env.py +1 -229
- kuavo_humanoid_sdk/kuavo/dexterous_hand.py +2 -6
- kuavo_humanoid_sdk/kuavo/leju_claw.py +2 -6
- kuavo_humanoid_sdk/kuavo/robot.py +27 -150
- kuavo_humanoid_sdk/kuavo/robot_arm.py +7 -53
- kuavo_humanoid_sdk/kuavo/robot_head.py +0 -10
- kuavo_humanoid_sdk/kuavo/robot_info.py +2 -7
- kuavo_humanoid_sdk/kuavo/robot_state.py +4 -41
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/__init__.py +0 -7
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/__init__.py +0 -5
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_playmusic.py +20 -26
- kuavo_humanoid_sdk/msg/motion_capture_ik/msg/__init__.py +9 -0
- kuavo_humanoid_sdk/msg/{kuavo_msgs → motion_capture_ik}/msg/_armHandPose.py +2 -2
- kuavo_humanoid_sdk/msg/{kuavo_msgs → motion_capture_ik}/msg/_handPose.py +2 -2
- kuavo_humanoid_sdk/msg/motion_capture_ik/msg/_headBodyPose.py +145 -0
- kuavo_humanoid_sdk/msg/{kuavo_msgs → motion_capture_ik}/msg/_ikSolveError.py +13 -13
- kuavo_humanoid_sdk/msg/{kuavo_msgs → motion_capture_ik}/msg/_ikSolveParam.py +2 -2
- kuavo_humanoid_sdk/msg/{kuavo_msgs → motion_capture_ik}/msg/_robotArmQVVD.py +2 -2
- kuavo_humanoid_sdk/msg/motion_capture_ik/msg/_robotHandPosition.py +225 -0
- kuavo_humanoid_sdk/msg/{kuavo_msgs → motion_capture_ik}/msg/_twoArmHandPose.py +13 -13
- kuavo_humanoid_sdk/msg/{kuavo_msgs → motion_capture_ik}/msg/_twoArmHandPoseCmd.py +30 -34
- kuavo_humanoid_sdk/msg/motion_capture_ik/srv/__init__.py +4 -0
- kuavo_humanoid_sdk/msg/{kuavo_msgs/srv/_setMmCtrlFrame.py → motion_capture_ik/srv/_changeArmCtrlMode.py} +37 -35
- kuavo_humanoid_sdk/msg/{kuavo_msgs → motion_capture_ik}/srv/_changeArmCtrlModeKuavo.py +5 -5
- kuavo_humanoid_sdk/msg/{kuavo_msgs → motion_capture_ik}/srv/_fkSrv.py +13 -13
- kuavo_humanoid_sdk/msg/{kuavo_msgs → motion_capture_ik}/srv/_twoArmHandPoseCmdSrv.py +37 -38
- {kuavo_humanoid_sdk-1.1.5.dist-info → kuavo_humanoid_sdk-1.1.6.dist-info}/METADATA +1 -2
- {kuavo_humanoid_sdk-1.1.5.dist-info → kuavo_humanoid_sdk-1.1.6.dist-info}/RECORD +37 -46
- kuavo_humanoid_sdk/common/global_config.py +0 -16
- kuavo_humanoid_sdk/common/websocket_kuavo_sdk.py +0 -23
- kuavo_humanoid_sdk/kuavo/core/audio.py +0 -36
- kuavo_humanoid_sdk/kuavo/core/ros/audio.py +0 -176
- kuavo_humanoid_sdk/kuavo/core/ros/tools.py +0 -158
- kuavo_humanoid_sdk/kuavo/core/ros/vision.py +0 -283
- kuavo_humanoid_sdk/kuavo/robot_audio.py +0 -39
- kuavo_humanoid_sdk/kuavo/robot_tool.py +0 -62
- kuavo_humanoid_sdk/kuavo/robot_vision.py +0 -90
- kuavo_humanoid_sdk/kuavo_strategy/__init__.py +0 -2
- kuavo_humanoid_sdk/kuavo_strategy/grasp_box/grasp_box_strategy.py +0 -418
- kuavo_humanoid_sdk/kuavo_strategy/kuavo_strategy.py +0 -63
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_SpeechSynthesis.py +0 -270
- {kuavo_humanoid_sdk-1.1.5.dist-info → kuavo_humanoid_sdk-1.1.6.dist-info}/WHEEL +0 -0
- {kuavo_humanoid_sdk-1.1.5.dist-info → kuavo_humanoid_sdk-1.1.6.dist-info}/top_level.txt +0 -0
|
@@ -1,5 +1,5 @@
|
|
|
1
1
|
# This Python file uses the following encoding: utf-8
|
|
2
|
-
"""autogenerated by genpy from
|
|
2
|
+
"""autogenerated by genpy from motion_capture_ik/changeArmCtrlModeRequest.msg. Do not edit."""
|
|
3
3
|
import codecs
|
|
4
4
|
import sys
|
|
5
5
|
python3 = True if sys.hexversion > 0x03000000 else False
|
|
@@ -7,13 +7,13 @@ import genpy
|
|
|
7
7
|
import struct
|
|
8
8
|
|
|
9
9
|
|
|
10
|
-
class
|
|
11
|
-
_md5sum = "
|
|
12
|
-
_type = "
|
|
10
|
+
class changeArmCtrlModeRequest(genpy.Message):
|
|
11
|
+
_md5sum = "1f5907fdb226711da233100c712cc0eb"
|
|
12
|
+
_type = "motion_capture_ik/changeArmCtrlModeRequest"
|
|
13
13
|
_has_header = False # flag to mark the presence of a Header object
|
|
14
|
-
_full_text = """int32
|
|
14
|
+
_full_text = """int32 control_mode # 0: keep pose, 1: auto_swing_arm, 2: external_control
|
|
15
15
|
"""
|
|
16
|
-
__slots__ = ['
|
|
16
|
+
__slots__ = ['control_mode']
|
|
17
17
|
_slot_types = ['int32']
|
|
18
18
|
|
|
19
19
|
def __init__(self, *args, **kwds):
|
|
@@ -24,19 +24,19 @@ class setMmCtrlFrameRequest(genpy.Message):
|
|
|
24
24
|
changes. You cannot mix in-order arguments and keyword arguments.
|
|
25
25
|
|
|
26
26
|
The available fields are:
|
|
27
|
-
|
|
27
|
+
control_mode
|
|
28
28
|
|
|
29
29
|
:param args: complete set of field values, in .msg order
|
|
30
30
|
:param kwds: use keyword arguments corresponding to message field names
|
|
31
31
|
to set specific fields.
|
|
32
32
|
"""
|
|
33
33
|
if args or kwds:
|
|
34
|
-
super(
|
|
34
|
+
super(changeArmCtrlModeRequest, self).__init__(*args, **kwds)
|
|
35
35
|
# message fields cannot be None, assign default values for those that are
|
|
36
|
-
if self.
|
|
37
|
-
self.
|
|
36
|
+
if self.control_mode is None:
|
|
37
|
+
self.control_mode = 0
|
|
38
38
|
else:
|
|
39
|
-
self.
|
|
39
|
+
self.control_mode = 0
|
|
40
40
|
|
|
41
41
|
def _get_types(self):
|
|
42
42
|
"""
|
|
@@ -50,7 +50,7 @@ class setMmCtrlFrameRequest(genpy.Message):
|
|
|
50
50
|
:param buff: buffer, ``StringIO``
|
|
51
51
|
"""
|
|
52
52
|
try:
|
|
53
|
-
_x = self.
|
|
53
|
+
_x = self.control_mode
|
|
54
54
|
buff.write(_get_struct_i().pack(_x))
|
|
55
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
56
|
except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
|
|
@@ -66,7 +66,7 @@ class setMmCtrlFrameRequest(genpy.Message):
|
|
|
66
66
|
end = 0
|
|
67
67
|
start = end
|
|
68
68
|
end += 4
|
|
69
|
-
(self.
|
|
69
|
+
(self.control_mode,) = _get_struct_i().unpack(str[start:end])
|
|
70
70
|
return self
|
|
71
71
|
except struct.error as e:
|
|
72
72
|
raise genpy.DeserializationError(e) # most likely buffer underfill
|
|
@@ -79,7 +79,7 @@ class setMmCtrlFrameRequest(genpy.Message):
|
|
|
79
79
|
:param numpy: numpy python module
|
|
80
80
|
"""
|
|
81
81
|
try:
|
|
82
|
-
_x = self.
|
|
82
|
+
_x = self.control_mode
|
|
83
83
|
buff.write(_get_struct_i().pack(_x))
|
|
84
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
85
|
except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
|
|
@@ -96,7 +96,7 @@ class setMmCtrlFrameRequest(genpy.Message):
|
|
|
96
96
|
end = 0
|
|
97
97
|
start = end
|
|
98
98
|
end += 4
|
|
99
|
-
(self.
|
|
99
|
+
(self.control_mode,) = _get_struct_i().unpack(str[start:end])
|
|
100
100
|
return self
|
|
101
101
|
except struct.error as e:
|
|
102
102
|
raise genpy.DeserializationError(e) # most likely buffer underfill
|
|
@@ -112,7 +112,7 @@ def _get_struct_i():
|
|
|
112
112
|
_struct_i = struct.Struct("<i")
|
|
113
113
|
return _struct_i
|
|
114
114
|
# This Python file uses the following encoding: utf-8
|
|
115
|
-
"""autogenerated by genpy from
|
|
115
|
+
"""autogenerated by genpy from motion_capture_ik/changeArmCtrlModeResponse.msg. Do not edit."""
|
|
116
116
|
import codecs
|
|
117
117
|
import sys
|
|
118
118
|
python3 = True if sys.hexversion > 0x03000000 else False
|
|
@@ -120,15 +120,17 @@ import genpy
|
|
|
120
120
|
import struct
|
|
121
121
|
|
|
122
122
|
|
|
123
|
-
class
|
|
124
|
-
_md5sum = "
|
|
125
|
-
_type = "
|
|
123
|
+
class changeArmCtrlModeResponse(genpy.Message):
|
|
124
|
+
_md5sum = "2f115bf9b7d68ace12ac850b142c1536"
|
|
125
|
+
_type = "motion_capture_ik/changeArmCtrlModeResponse"
|
|
126
126
|
_has_header = False # flag to mark the presence of a Header object
|
|
127
127
|
_full_text = """bool result
|
|
128
|
-
int32
|
|
128
|
+
int32 mode
|
|
129
129
|
string message
|
|
130
|
+
|
|
131
|
+
|
|
130
132
|
"""
|
|
131
|
-
__slots__ = ['result','
|
|
133
|
+
__slots__ = ['result','mode','message']
|
|
132
134
|
_slot_types = ['bool','int32','string']
|
|
133
135
|
|
|
134
136
|
def __init__(self, *args, **kwds):
|
|
@@ -139,24 +141,24 @@ string message
|
|
|
139
141
|
changes. You cannot mix in-order arguments and keyword arguments.
|
|
140
142
|
|
|
141
143
|
The available fields are:
|
|
142
|
-
result,
|
|
144
|
+
result,mode,message
|
|
143
145
|
|
|
144
146
|
:param args: complete set of field values, in .msg order
|
|
145
147
|
:param kwds: use keyword arguments corresponding to message field names
|
|
146
148
|
to set specific fields.
|
|
147
149
|
"""
|
|
148
150
|
if args or kwds:
|
|
149
|
-
super(
|
|
151
|
+
super(changeArmCtrlModeResponse, self).__init__(*args, **kwds)
|
|
150
152
|
# message fields cannot be None, assign default values for those that are
|
|
151
153
|
if self.result is None:
|
|
152
154
|
self.result = False
|
|
153
|
-
if self.
|
|
154
|
-
self.
|
|
155
|
+
if self.mode is None:
|
|
156
|
+
self.mode = 0
|
|
155
157
|
if self.message is None:
|
|
156
158
|
self.message = ''
|
|
157
159
|
else:
|
|
158
160
|
self.result = False
|
|
159
|
-
self.
|
|
161
|
+
self.mode = 0
|
|
160
162
|
self.message = ''
|
|
161
163
|
|
|
162
164
|
def _get_types(self):
|
|
@@ -172,7 +174,7 @@ string message
|
|
|
172
174
|
"""
|
|
173
175
|
try:
|
|
174
176
|
_x = self
|
|
175
|
-
buff.write(_get_struct_Bi().pack(_x.result, _x.
|
|
177
|
+
buff.write(_get_struct_Bi().pack(_x.result, _x.mode))
|
|
176
178
|
_x = self.message
|
|
177
179
|
length = len(_x)
|
|
178
180
|
if python3 or type(_x) == unicode:
|
|
@@ -194,7 +196,7 @@ string message
|
|
|
194
196
|
_x = self
|
|
195
197
|
start = end
|
|
196
198
|
end += 5
|
|
197
|
-
(_x.result, _x.
|
|
199
|
+
(_x.result, _x.mode,) = _get_struct_Bi().unpack(str[start:end])
|
|
198
200
|
self.result = bool(self.result)
|
|
199
201
|
start = end
|
|
200
202
|
end += 4
|
|
@@ -218,7 +220,7 @@ string message
|
|
|
218
220
|
"""
|
|
219
221
|
try:
|
|
220
222
|
_x = self
|
|
221
|
-
buff.write(_get_struct_Bi().pack(_x.result, _x.
|
|
223
|
+
buff.write(_get_struct_Bi().pack(_x.result, _x.mode))
|
|
222
224
|
_x = self.message
|
|
223
225
|
length = len(_x)
|
|
224
226
|
if python3 or type(_x) == unicode:
|
|
@@ -241,7 +243,7 @@ string message
|
|
|
241
243
|
_x = self
|
|
242
244
|
start = end
|
|
243
245
|
end += 5
|
|
244
|
-
(_x.result, _x.
|
|
246
|
+
(_x.result, _x.mode,) = _get_struct_Bi().unpack(str[start:end])
|
|
245
247
|
self.result = bool(self.result)
|
|
246
248
|
start = end
|
|
247
249
|
end += 4
|
|
@@ -266,8 +268,8 @@ def _get_struct_Bi():
|
|
|
266
268
|
if _struct_Bi is None:
|
|
267
269
|
_struct_Bi = struct.Struct("<Bi")
|
|
268
270
|
return _struct_Bi
|
|
269
|
-
class
|
|
270
|
-
_type = '
|
|
271
|
-
_md5sum = '
|
|
272
|
-
_request_class =
|
|
273
|
-
_response_class =
|
|
271
|
+
class changeArmCtrlMode(object):
|
|
272
|
+
_type = 'motion_capture_ik/changeArmCtrlMode'
|
|
273
|
+
_md5sum = '8a8d154c05ee16e8f5d2b72d9bb51026'
|
|
274
|
+
_request_class = changeArmCtrlModeRequest
|
|
275
|
+
_response_class = changeArmCtrlModeResponse
|
|
@@ -1,5 +1,5 @@
|
|
|
1
1
|
# This Python file uses the following encoding: utf-8
|
|
2
|
-
"""autogenerated by genpy from
|
|
2
|
+
"""autogenerated by genpy from motion_capture_ik/changeArmCtrlModeKuavoRequest.msg. Do not edit."""
|
|
3
3
|
import codecs
|
|
4
4
|
import sys
|
|
5
5
|
python3 = True if sys.hexversion > 0x03000000 else False
|
|
@@ -9,7 +9,7 @@ import struct
|
|
|
9
9
|
|
|
10
10
|
class changeArmCtrlModeKuavoRequest(genpy.Message):
|
|
11
11
|
_md5sum = "14ef2aa2f48bb3f617c9e71fd0bc444e"
|
|
12
|
-
_type = "
|
|
12
|
+
_type = "motion_capture_ik/changeArmCtrlModeKuavoRequest"
|
|
13
13
|
_has_header = False # flag to mark the presence of a Header object
|
|
14
14
|
_full_text = """bool control_mode
|
|
15
15
|
"""
|
|
@@ -114,7 +114,7 @@ def _get_struct_B():
|
|
|
114
114
|
_struct_B = struct.Struct("<B")
|
|
115
115
|
return _struct_B
|
|
116
116
|
# This Python file uses the following encoding: utf-8
|
|
117
|
-
"""autogenerated by genpy from
|
|
117
|
+
"""autogenerated by genpy from motion_capture_ik/changeArmCtrlModeKuavoResponse.msg. Do not edit."""
|
|
118
118
|
import codecs
|
|
119
119
|
import sys
|
|
120
120
|
python3 = True if sys.hexversion > 0x03000000 else False
|
|
@@ -124,7 +124,7 @@ import struct
|
|
|
124
124
|
|
|
125
125
|
class changeArmCtrlModeKuavoResponse(genpy.Message):
|
|
126
126
|
_md5sum = "eb13ac1f1354ccecb7941ee8fa2192e8"
|
|
127
|
-
_type = "
|
|
127
|
+
_type = "motion_capture_ik/changeArmCtrlModeKuavoResponse"
|
|
128
128
|
_has_header = False # flag to mark the presence of a Header object
|
|
129
129
|
_full_text = """bool result
|
|
130
130
|
|
|
@@ -230,7 +230,7 @@ def _get_struct_B():
|
|
|
230
230
|
_struct_B = struct.Struct("<B")
|
|
231
231
|
return _struct_B
|
|
232
232
|
class changeArmCtrlModeKuavo(object):
|
|
233
|
-
_type = '
|
|
233
|
+
_type = 'motion_capture_ik/changeArmCtrlModeKuavo'
|
|
234
234
|
_md5sum = 'f89438f9d6f48f748eabe64775a22261'
|
|
235
235
|
_request_class = changeArmCtrlModeKuavoRequest
|
|
236
236
|
_response_class = changeArmCtrlModeKuavoResponse
|
|
@@ -1,5 +1,5 @@
|
|
|
1
1
|
# This Python file uses the following encoding: utf-8
|
|
2
|
-
"""autogenerated by genpy from
|
|
2
|
+
"""autogenerated by genpy from motion_capture_ik/fkSrvRequest.msg. Do not edit."""
|
|
3
3
|
import codecs
|
|
4
4
|
import sys
|
|
5
5
|
python3 = True if sys.hexversion > 0x03000000 else False
|
|
@@ -9,7 +9,7 @@ import struct
|
|
|
9
9
|
|
|
10
10
|
class fkSrvRequest(genpy.Message):
|
|
11
11
|
_md5sum = "ab94b9bcaaa12f74def43e4b33992df1"
|
|
12
|
-
_type = "
|
|
12
|
+
_type = "motion_capture_ik/fkSrvRequest"
|
|
13
13
|
_has_header = False # flag to mark the presence of a Header object
|
|
14
14
|
_full_text = """float64[] q # 广义关节角度,如果是虚拟关节ik,则前4维度为躯干虚拟关节的角度,后14维度为手臂关节的角度
|
|
15
15
|
"""
|
|
@@ -120,25 +120,25 @@ def _get_struct_I():
|
|
|
120
120
|
global _struct_I
|
|
121
121
|
return _struct_I
|
|
122
122
|
# This Python file uses the following encoding: utf-8
|
|
123
|
-
"""autogenerated by genpy from
|
|
123
|
+
"""autogenerated by genpy from motion_capture_ik/fkSrvResponse.msg. Do not edit."""
|
|
124
124
|
import codecs
|
|
125
125
|
import sys
|
|
126
126
|
python3 = True if sys.hexversion > 0x03000000 else False
|
|
127
127
|
import genpy
|
|
128
128
|
import struct
|
|
129
129
|
|
|
130
|
-
import
|
|
130
|
+
import motion_capture_ik.msg
|
|
131
131
|
import std_msgs.msg
|
|
132
132
|
|
|
133
133
|
class fkSrvResponse(genpy.Message):
|
|
134
134
|
_md5sum = "0989ef9ed6b7b2e5e8a37c79ae6916d9"
|
|
135
|
-
_type = "
|
|
135
|
+
_type = "motion_capture_ik/fkSrvResponse"
|
|
136
136
|
_has_header = False # flag to mark the presence of a Header object
|
|
137
137
|
_full_text = """bool success
|
|
138
138
|
twoArmHandPose hand_poses
|
|
139
139
|
|
|
140
140
|
================================================================================
|
|
141
|
-
MSG:
|
|
141
|
+
MSG: motion_capture_ik/twoArmHandPose
|
|
142
142
|
Header header
|
|
143
143
|
armHandPose left_pose
|
|
144
144
|
armHandPose right_pose
|
|
@@ -159,7 +159,7 @@ time stamp
|
|
|
159
159
|
string frame_id
|
|
160
160
|
|
|
161
161
|
================================================================================
|
|
162
|
-
MSG:
|
|
162
|
+
MSG: motion_capture_ik/armHandPose
|
|
163
163
|
float64[3] pos_xyz
|
|
164
164
|
float64[4] quat_xyzw
|
|
165
165
|
|
|
@@ -167,7 +167,7 @@ float64[3] elbow_pos_xyz
|
|
|
167
167
|
|
|
168
168
|
float64[7] joint_angles"""
|
|
169
169
|
__slots__ = ['success','hand_poses']
|
|
170
|
-
_slot_types = ['bool','
|
|
170
|
+
_slot_types = ['bool','motion_capture_ik/twoArmHandPose']
|
|
171
171
|
|
|
172
172
|
def __init__(self, *args, **kwds):
|
|
173
173
|
"""
|
|
@@ -189,10 +189,10 @@ float64[7] joint_angles"""
|
|
|
189
189
|
if self.success is None:
|
|
190
190
|
self.success = False
|
|
191
191
|
if self.hand_poses is None:
|
|
192
|
-
self.hand_poses =
|
|
192
|
+
self.hand_poses = motion_capture_ik.msg.twoArmHandPose()
|
|
193
193
|
else:
|
|
194
194
|
self.success = False
|
|
195
|
-
self.hand_poses =
|
|
195
|
+
self.hand_poses = motion_capture_ik.msg.twoArmHandPose()
|
|
196
196
|
|
|
197
197
|
def _get_types(self):
|
|
198
198
|
"""
|
|
@@ -234,7 +234,7 @@ float64[7] joint_angles"""
|
|
|
234
234
|
codecs.lookup_error("rosmsg").msg_type = self._type
|
|
235
235
|
try:
|
|
236
236
|
if self.hand_poses is None:
|
|
237
|
-
self.hand_poses =
|
|
237
|
+
self.hand_poses = motion_capture_ik.msg.twoArmHandPose()
|
|
238
238
|
end = 0
|
|
239
239
|
_x = self
|
|
240
240
|
start = end
|
|
@@ -315,7 +315,7 @@ float64[7] joint_angles"""
|
|
|
315
315
|
codecs.lookup_error("rosmsg").msg_type = self._type
|
|
316
316
|
try:
|
|
317
317
|
if self.hand_poses is None:
|
|
318
|
-
self.hand_poses =
|
|
318
|
+
self.hand_poses = motion_capture_ik.msg.twoArmHandPose()
|
|
319
319
|
end = 0
|
|
320
320
|
_x = self
|
|
321
321
|
start = end
|
|
@@ -388,7 +388,7 @@ def _get_struct_B3I():
|
|
|
388
388
|
_struct_B3I = struct.Struct("<B3I")
|
|
389
389
|
return _struct_B3I
|
|
390
390
|
class fkSrv(object):
|
|
391
|
-
_type = '
|
|
391
|
+
_type = 'motion_capture_ik/fkSrv'
|
|
392
392
|
_md5sum = 'b89cc987a02b6d1c2a1588d5659bf064'
|
|
393
393
|
_request_class = fkSrvRequest
|
|
394
394
|
_response_class = fkSrvResponse
|
|
@@ -1,30 +1,29 @@
|
|
|
1
1
|
# This Python file uses the following encoding: utf-8
|
|
2
|
-
"""autogenerated by genpy from
|
|
2
|
+
"""autogenerated by genpy from motion_capture_ik/twoArmHandPoseCmdSrvRequest.msg. Do not edit."""
|
|
3
3
|
import codecs
|
|
4
4
|
import sys
|
|
5
5
|
python3 = True if sys.hexversion > 0x03000000 else False
|
|
6
6
|
import genpy
|
|
7
7
|
import struct
|
|
8
8
|
|
|
9
|
-
import
|
|
9
|
+
import motion_capture_ik.msg
|
|
10
10
|
import std_msgs.msg
|
|
11
11
|
|
|
12
12
|
class twoArmHandPoseCmdSrvRequest(genpy.Message):
|
|
13
|
-
_md5sum = "
|
|
14
|
-
_type = "
|
|
13
|
+
_md5sum = "2b372ee6cf4101587f773b62c6572c72"
|
|
14
|
+
_type = "motion_capture_ik/twoArmHandPoseCmdSrvRequest"
|
|
15
15
|
_has_header = False # flag to mark the presence of a Header object
|
|
16
16
|
_full_text = """twoArmHandPoseCmd twoArmHandPoseCmdRequest
|
|
17
17
|
|
|
18
18
|
================================================================================
|
|
19
|
-
MSG:
|
|
19
|
+
MSG: motion_capture_ik/twoArmHandPoseCmd
|
|
20
20
|
twoArmHandPose hand_poses
|
|
21
21
|
# params for the IK solver
|
|
22
22
|
bool use_custom_ik_param
|
|
23
23
|
bool joint_angles_as_q0
|
|
24
24
|
ikSolveParam ik_param
|
|
25
|
-
int32 frame # 0 keep current frame 1 world frame (based on odom) 2 local frame 3 manipulation world frame
|
|
26
25
|
================================================================================
|
|
27
|
-
MSG:
|
|
26
|
+
MSG: motion_capture_ik/twoArmHandPose
|
|
28
27
|
Header header
|
|
29
28
|
armHandPose left_pose
|
|
30
29
|
armHandPose right_pose
|
|
@@ -45,7 +44,7 @@ time stamp
|
|
|
45
44
|
string frame_id
|
|
46
45
|
|
|
47
46
|
================================================================================
|
|
48
|
-
MSG:
|
|
47
|
+
MSG: motion_capture_ik/armHandPose
|
|
49
48
|
float64[3] pos_xyz
|
|
50
49
|
float64[4] quat_xyzw
|
|
51
50
|
|
|
@@ -53,7 +52,7 @@ float64[3] elbow_pos_xyz
|
|
|
53
52
|
|
|
54
53
|
float64[7] joint_angles
|
|
55
54
|
================================================================================
|
|
56
|
-
MSG:
|
|
55
|
+
MSG: motion_capture_ik/ikSolveParam
|
|
57
56
|
# snopt params
|
|
58
57
|
float64 major_optimality_tol
|
|
59
58
|
float64 major_feasibility_tol
|
|
@@ -64,7 +63,7 @@ float64 oritation_constraint_tol
|
|
|
64
63
|
float64 pos_constraint_tol # work when pos_cost_weight > 0.0
|
|
65
64
|
float64 pos_cost_weight"""
|
|
66
65
|
__slots__ = ['twoArmHandPoseCmdRequest']
|
|
67
|
-
_slot_types = ['
|
|
66
|
+
_slot_types = ['motion_capture_ik/twoArmHandPoseCmd']
|
|
68
67
|
|
|
69
68
|
def __init__(self, *args, **kwds):
|
|
70
69
|
"""
|
|
@@ -84,9 +83,9 @@ float64 pos_cost_weight"""
|
|
|
84
83
|
super(twoArmHandPoseCmdSrvRequest, self).__init__(*args, **kwds)
|
|
85
84
|
# message fields cannot be None, assign default values for those that are
|
|
86
85
|
if self.twoArmHandPoseCmdRequest is None:
|
|
87
|
-
self.twoArmHandPoseCmdRequest =
|
|
86
|
+
self.twoArmHandPoseCmdRequest = motion_capture_ik.msg.twoArmHandPoseCmd()
|
|
88
87
|
else:
|
|
89
|
-
self.twoArmHandPoseCmdRequest =
|
|
88
|
+
self.twoArmHandPoseCmdRequest = motion_capture_ik.msg.twoArmHandPoseCmd()
|
|
90
89
|
|
|
91
90
|
def _get_types(self):
|
|
92
91
|
"""
|
|
@@ -117,7 +116,7 @@ float64 pos_cost_weight"""
|
|
|
117
116
|
buff.write(_get_struct_3d().pack(*self.twoArmHandPoseCmdRequest.hand_poses.right_pose.elbow_pos_xyz))
|
|
118
117
|
buff.write(_get_struct_7d().pack(*self.twoArmHandPoseCmdRequest.hand_poses.right_pose.joint_angles))
|
|
119
118
|
_x = self
|
|
120
|
-
buff.write(
|
|
119
|
+
buff.write(_get_struct_2B7d().pack(_x.twoArmHandPoseCmdRequest.use_custom_ik_param, _x.twoArmHandPoseCmdRequest.joint_angles_as_q0, _x.twoArmHandPoseCmdRequest.ik_param.major_optimality_tol, _x.twoArmHandPoseCmdRequest.ik_param.major_feasibility_tol, _x.twoArmHandPoseCmdRequest.ik_param.minor_feasibility_tol, _x.twoArmHandPoseCmdRequest.ik_param.major_iterations_limit, _x.twoArmHandPoseCmdRequest.ik_param.oritation_constraint_tol, _x.twoArmHandPoseCmdRequest.ik_param.pos_constraint_tol, _x.twoArmHandPoseCmdRequest.ik_param.pos_cost_weight))
|
|
121
120
|
except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
|
|
122
121
|
except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
|
|
123
122
|
|
|
@@ -130,7 +129,7 @@ float64 pos_cost_weight"""
|
|
|
130
129
|
codecs.lookup_error("rosmsg").msg_type = self._type
|
|
131
130
|
try:
|
|
132
131
|
if self.twoArmHandPoseCmdRequest is None:
|
|
133
|
-
self.twoArmHandPoseCmdRequest =
|
|
132
|
+
self.twoArmHandPoseCmdRequest = motion_capture_ik.msg.twoArmHandPoseCmd()
|
|
134
133
|
end = 0
|
|
135
134
|
_x = self
|
|
136
135
|
start = end
|
|
@@ -171,8 +170,8 @@ float64 pos_cost_weight"""
|
|
|
171
170
|
self.twoArmHandPoseCmdRequest.hand_poses.right_pose.joint_angles = _get_struct_7d().unpack(str[start:end])
|
|
172
171
|
_x = self
|
|
173
172
|
start = end
|
|
174
|
-
end +=
|
|
175
|
-
(_x.twoArmHandPoseCmdRequest.use_custom_ik_param, _x.twoArmHandPoseCmdRequest.joint_angles_as_q0, _x.twoArmHandPoseCmdRequest.ik_param.major_optimality_tol, _x.twoArmHandPoseCmdRequest.ik_param.major_feasibility_tol, _x.twoArmHandPoseCmdRequest.ik_param.minor_feasibility_tol, _x.twoArmHandPoseCmdRequest.ik_param.major_iterations_limit, _x.twoArmHandPoseCmdRequest.ik_param.oritation_constraint_tol, _x.twoArmHandPoseCmdRequest.ik_param.pos_constraint_tol, _x.twoArmHandPoseCmdRequest.ik_param.pos_cost_weight,
|
|
173
|
+
end += 58
|
|
174
|
+
(_x.twoArmHandPoseCmdRequest.use_custom_ik_param, _x.twoArmHandPoseCmdRequest.joint_angles_as_q0, _x.twoArmHandPoseCmdRequest.ik_param.major_optimality_tol, _x.twoArmHandPoseCmdRequest.ik_param.major_feasibility_tol, _x.twoArmHandPoseCmdRequest.ik_param.minor_feasibility_tol, _x.twoArmHandPoseCmdRequest.ik_param.major_iterations_limit, _x.twoArmHandPoseCmdRequest.ik_param.oritation_constraint_tol, _x.twoArmHandPoseCmdRequest.ik_param.pos_constraint_tol, _x.twoArmHandPoseCmdRequest.ik_param.pos_cost_weight,) = _get_struct_2B7d().unpack(str[start:end])
|
|
176
175
|
self.twoArmHandPoseCmdRequest.use_custom_ik_param = bool(self.twoArmHandPoseCmdRequest.use_custom_ik_param)
|
|
177
176
|
self.twoArmHandPoseCmdRequest.joint_angles_as_q0 = bool(self.twoArmHandPoseCmdRequest.joint_angles_as_q0)
|
|
178
177
|
return self
|
|
@@ -204,7 +203,7 @@ float64 pos_cost_weight"""
|
|
|
204
203
|
buff.write(self.twoArmHandPoseCmdRequest.hand_poses.right_pose.elbow_pos_xyz.tostring())
|
|
205
204
|
buff.write(self.twoArmHandPoseCmdRequest.hand_poses.right_pose.joint_angles.tostring())
|
|
206
205
|
_x = self
|
|
207
|
-
buff.write(
|
|
206
|
+
buff.write(_get_struct_2B7d().pack(_x.twoArmHandPoseCmdRequest.use_custom_ik_param, _x.twoArmHandPoseCmdRequest.joint_angles_as_q0, _x.twoArmHandPoseCmdRequest.ik_param.major_optimality_tol, _x.twoArmHandPoseCmdRequest.ik_param.major_feasibility_tol, _x.twoArmHandPoseCmdRequest.ik_param.minor_feasibility_tol, _x.twoArmHandPoseCmdRequest.ik_param.major_iterations_limit, _x.twoArmHandPoseCmdRequest.ik_param.oritation_constraint_tol, _x.twoArmHandPoseCmdRequest.ik_param.pos_constraint_tol, _x.twoArmHandPoseCmdRequest.ik_param.pos_cost_weight))
|
|
208
207
|
except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
|
|
209
208
|
except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
|
|
210
209
|
|
|
@@ -218,7 +217,7 @@ float64 pos_cost_weight"""
|
|
|
218
217
|
codecs.lookup_error("rosmsg").msg_type = self._type
|
|
219
218
|
try:
|
|
220
219
|
if self.twoArmHandPoseCmdRequest is None:
|
|
221
|
-
self.twoArmHandPoseCmdRequest =
|
|
220
|
+
self.twoArmHandPoseCmdRequest = motion_capture_ik.msg.twoArmHandPoseCmd()
|
|
222
221
|
end = 0
|
|
223
222
|
_x = self
|
|
224
223
|
start = end
|
|
@@ -259,8 +258,8 @@ float64 pos_cost_weight"""
|
|
|
259
258
|
self.twoArmHandPoseCmdRequest.hand_poses.right_pose.joint_angles = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=7)
|
|
260
259
|
_x = self
|
|
261
260
|
start = end
|
|
262
|
-
end +=
|
|
263
|
-
(_x.twoArmHandPoseCmdRequest.use_custom_ik_param, _x.twoArmHandPoseCmdRequest.joint_angles_as_q0, _x.twoArmHandPoseCmdRequest.ik_param.major_optimality_tol, _x.twoArmHandPoseCmdRequest.ik_param.major_feasibility_tol, _x.twoArmHandPoseCmdRequest.ik_param.minor_feasibility_tol, _x.twoArmHandPoseCmdRequest.ik_param.major_iterations_limit, _x.twoArmHandPoseCmdRequest.ik_param.oritation_constraint_tol, _x.twoArmHandPoseCmdRequest.ik_param.pos_constraint_tol, _x.twoArmHandPoseCmdRequest.ik_param.pos_cost_weight,
|
|
261
|
+
end += 58
|
|
262
|
+
(_x.twoArmHandPoseCmdRequest.use_custom_ik_param, _x.twoArmHandPoseCmdRequest.joint_angles_as_q0, _x.twoArmHandPoseCmdRequest.ik_param.major_optimality_tol, _x.twoArmHandPoseCmdRequest.ik_param.major_feasibility_tol, _x.twoArmHandPoseCmdRequest.ik_param.minor_feasibility_tol, _x.twoArmHandPoseCmdRequest.ik_param.major_iterations_limit, _x.twoArmHandPoseCmdRequest.ik_param.oritation_constraint_tol, _x.twoArmHandPoseCmdRequest.ik_param.pos_constraint_tol, _x.twoArmHandPoseCmdRequest.ik_param.pos_cost_weight,) = _get_struct_2B7d().unpack(str[start:end])
|
|
264
263
|
self.twoArmHandPoseCmdRequest.use_custom_ik_param = bool(self.twoArmHandPoseCmdRequest.use_custom_ik_param)
|
|
265
264
|
self.twoArmHandPoseCmdRequest.joint_angles_as_q0 = bool(self.twoArmHandPoseCmdRequest.joint_angles_as_q0)
|
|
266
265
|
return self
|
|
@@ -271,12 +270,12 @@ _struct_I = genpy.struct_I
|
|
|
271
270
|
def _get_struct_I():
|
|
272
271
|
global _struct_I
|
|
273
272
|
return _struct_I
|
|
274
|
-
|
|
275
|
-
def
|
|
276
|
-
global
|
|
277
|
-
if
|
|
278
|
-
|
|
279
|
-
return
|
|
273
|
+
_struct_2B7d = None
|
|
274
|
+
def _get_struct_2B7d():
|
|
275
|
+
global _struct_2B7d
|
|
276
|
+
if _struct_2B7d is None:
|
|
277
|
+
_struct_2B7d = struct.Struct("<2B7d")
|
|
278
|
+
return _struct_2B7d
|
|
280
279
|
_struct_3I = None
|
|
281
280
|
def _get_struct_3I():
|
|
282
281
|
global _struct_3I
|
|
@@ -302,19 +301,19 @@ def _get_struct_7d():
|
|
|
302
301
|
_struct_7d = struct.Struct("<7d")
|
|
303
302
|
return _struct_7d
|
|
304
303
|
# This Python file uses the following encoding: utf-8
|
|
305
|
-
"""autogenerated by genpy from
|
|
304
|
+
"""autogenerated by genpy from motion_capture_ik/twoArmHandPoseCmdSrvResponse.msg. Do not edit."""
|
|
306
305
|
import codecs
|
|
307
306
|
import sys
|
|
308
307
|
python3 = True if sys.hexversion > 0x03000000 else False
|
|
309
308
|
import genpy
|
|
310
309
|
import struct
|
|
311
310
|
|
|
312
|
-
import
|
|
311
|
+
import motion_capture_ik.msg
|
|
313
312
|
import std_msgs.msg
|
|
314
313
|
|
|
315
314
|
class twoArmHandPoseCmdSrvResponse(genpy.Message):
|
|
316
315
|
_md5sum = "7dba8c11b6c3ac9ec243b4520ad906c7"
|
|
317
|
-
_type = "
|
|
316
|
+
_type = "motion_capture_ik/twoArmHandPoseCmdSrvResponse"
|
|
318
317
|
_has_header = False # flag to mark the presence of a Header object
|
|
319
318
|
_full_text = """bool success
|
|
320
319
|
bool with_torso
|
|
@@ -326,7 +325,7 @@ float64 time_cost # unit: ms
|
|
|
326
325
|
twoArmHandPose hand_poses
|
|
327
326
|
|
|
328
327
|
================================================================================
|
|
329
|
-
MSG:
|
|
328
|
+
MSG: motion_capture_ik/twoArmHandPose
|
|
330
329
|
Header header
|
|
331
330
|
armHandPose left_pose
|
|
332
331
|
armHandPose right_pose
|
|
@@ -347,7 +346,7 @@ time stamp
|
|
|
347
346
|
string frame_id
|
|
348
347
|
|
|
349
348
|
================================================================================
|
|
350
|
-
MSG:
|
|
349
|
+
MSG: motion_capture_ik/armHandPose
|
|
351
350
|
float64[3] pos_xyz
|
|
352
351
|
float64[4] quat_xyzw
|
|
353
352
|
|
|
@@ -355,7 +354,7 @@ float64[3] elbow_pos_xyz
|
|
|
355
354
|
|
|
356
355
|
float64[7] joint_angles"""
|
|
357
356
|
__slots__ = ['success','with_torso','q_arm','q_torso','time_cost','hand_poses']
|
|
358
|
-
_slot_types = ['bool','bool','float64[]','float64[]','float64','
|
|
357
|
+
_slot_types = ['bool','bool','float64[]','float64[]','float64','motion_capture_ik/twoArmHandPose']
|
|
359
358
|
|
|
360
359
|
def __init__(self, *args, **kwds):
|
|
361
360
|
"""
|
|
@@ -385,14 +384,14 @@ float64[7] joint_angles"""
|
|
|
385
384
|
if self.time_cost is None:
|
|
386
385
|
self.time_cost = 0.
|
|
387
386
|
if self.hand_poses is None:
|
|
388
|
-
self.hand_poses =
|
|
387
|
+
self.hand_poses = motion_capture_ik.msg.twoArmHandPose()
|
|
389
388
|
else:
|
|
390
389
|
self.success = False
|
|
391
390
|
self.with_torso = False
|
|
392
391
|
self.q_arm = []
|
|
393
392
|
self.q_torso = []
|
|
394
393
|
self.time_cost = 0.
|
|
395
|
-
self.hand_poses =
|
|
394
|
+
self.hand_poses = motion_capture_ik.msg.twoArmHandPose()
|
|
396
395
|
|
|
397
396
|
def _get_types(self):
|
|
398
397
|
"""
|
|
@@ -444,7 +443,7 @@ float64[7] joint_angles"""
|
|
|
444
443
|
codecs.lookup_error("rosmsg").msg_type = self._type
|
|
445
444
|
try:
|
|
446
445
|
if self.hand_poses is None:
|
|
447
|
-
self.hand_poses =
|
|
446
|
+
self.hand_poses = motion_capture_ik.msg.twoArmHandPose()
|
|
448
447
|
end = 0
|
|
449
448
|
_x = self
|
|
450
449
|
start = end
|
|
@@ -556,7 +555,7 @@ float64[7] joint_angles"""
|
|
|
556
555
|
codecs.lookup_error("rosmsg").msg_type = self._type
|
|
557
556
|
try:
|
|
558
557
|
if self.hand_poses is None:
|
|
559
|
-
self.hand_poses =
|
|
558
|
+
self.hand_poses = motion_capture_ik.msg.twoArmHandPose()
|
|
560
559
|
end = 0
|
|
561
560
|
_x = self
|
|
562
561
|
start = end
|
|
@@ -656,7 +655,7 @@ def _get_struct_d3I():
|
|
|
656
655
|
_struct_d3I = struct.Struct("<d3I")
|
|
657
656
|
return _struct_d3I
|
|
658
657
|
class twoArmHandPoseCmdSrv(object):
|
|
659
|
-
_type = '
|
|
660
|
-
_md5sum = '
|
|
658
|
+
_type = 'motion_capture_ik/twoArmHandPoseCmdSrv'
|
|
659
|
+
_md5sum = '4cedfbf98f38ce7e92b358cb2d3ef39d'
|
|
661
660
|
_request_class = twoArmHandPoseCmdSrvRequest
|
|
662
661
|
_response_class = twoArmHandPoseCmdSrvResponse
|
|
@@ -1,6 +1,6 @@
|
|
|
1
1
|
Metadata-Version: 2.1
|
|
2
2
|
Name: kuavo-humanoid-sdk
|
|
3
|
-
Version: 1.1.
|
|
3
|
+
Version: 1.1.6
|
|
4
4
|
Summary: A Python SDK for kuavo humanoid robot.
|
|
5
5
|
Home-page: https://gitee.com/leju-robot/kuavo-ros-opensource/
|
|
6
6
|
Author: ['lejurobot']
|
|
@@ -22,7 +22,6 @@ Requires-Python: >=3.8
|
|
|
22
22
|
Description-Content-Type: text/markdown
|
|
23
23
|
Requires-Dist: numpy
|
|
24
24
|
Requires-Dist: transitions
|
|
25
|
-
Requires-Dist: roslibpy
|
|
26
25
|
|
|
27
26
|
# Kuavo Humanoid SDK
|
|
28
27
|
|