kuavo-humanoid-sdk 1.1.2a922__py3-none-any.whl → 1.1.3a1226__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/common/global_config.py +15 -0
- kuavo_humanoid_sdk/common/websocket_kuavo_sdk.py +23 -0
- kuavo_humanoid_sdk/interfaces/data_types.py +46 -0
- kuavo_humanoid_sdk/kuavo/__init__.py +3 -0
- kuavo_humanoid_sdk/kuavo/core/audio.py +33 -0
- kuavo_humanoid_sdk/kuavo/core/core.py +16 -6
- kuavo_humanoid_sdk/kuavo/core/ros/audio.py +87 -0
- kuavo_humanoid_sdk/kuavo/core/ros/control.py +645 -19
- kuavo_humanoid_sdk/kuavo/core/ros/param.py +142 -4
- kuavo_humanoid_sdk/kuavo/core/ros/state.py +329 -15
- kuavo_humanoid_sdk/kuavo/core/ros/tools.py +149 -0
- kuavo_humanoid_sdk/kuavo/core/ros/vision.py +272 -0
- kuavo_humanoid_sdk/kuavo/core/ros_env.py +229 -1
- kuavo_humanoid_sdk/kuavo/dexterous_hand.py +6 -2
- kuavo_humanoid_sdk/kuavo/leju_claw.py +6 -2
- kuavo_humanoid_sdk/kuavo/robot.py +43 -22
- kuavo_humanoid_sdk/kuavo/robot_audio.py +39 -0
- kuavo_humanoid_sdk/kuavo/robot_info.py +7 -2
- kuavo_humanoid_sdk/kuavo/robot_state.py +6 -2
- kuavo_humanoid_sdk/kuavo/robot_tool.py +62 -0
- kuavo_humanoid_sdk/kuavo/robot_vision.py +87 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_AprilTagDetection.py +306 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_AprilTagDetectionArray.py +437 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/__init__.py +9 -0
- kuavo_humanoid_sdk/msg/{motion_capture_ik → kuavo_msgs}/msg/_armHandPose.py +2 -2
- kuavo_humanoid_sdk/msg/{motion_capture_ik → kuavo_msgs}/msg/_handPose.py +2 -2
- kuavo_humanoid_sdk/msg/{motion_capture_ik → kuavo_msgs}/msg/_ikSolveError.py +13 -13
- kuavo_humanoid_sdk/msg/{motion_capture_ik → kuavo_msgs}/msg/_ikSolveParam.py +2 -2
- kuavo_humanoid_sdk/msg/{motion_capture_ik → kuavo_msgs}/msg/_robotArmQVVD.py +2 -2
- kuavo_humanoid_sdk/msg/{motion_capture_ik → kuavo_msgs}/msg/_twoArmHandPose.py +13 -13
- kuavo_humanoid_sdk/msg/{motion_capture_ik → kuavo_msgs}/msg/_twoArmHandPoseCmd.py +15 -15
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_SpeechSynthesis.py +270 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/__init__.py +5 -0
- kuavo_humanoid_sdk/msg/{motion_capture_ik → kuavo_msgs}/srv/_changeArmCtrlModeKuavo.py +5 -5
- kuavo_humanoid_sdk/msg/{motion_capture_ik → kuavo_msgs}/srv/_fkSrv.py +13 -13
- kuavo_humanoid_sdk/msg/{motion_capture_ik/srv/_changeArmCtrlMode.py → kuavo_msgs/srv/_playmusic.py} +97 -98
- kuavo_humanoid_sdk/msg/{motion_capture_ik → kuavo_msgs}/srv/_twoArmHandPoseCmdSrv.py +23 -23
- {kuavo_humanoid_sdk-1.1.2a922.dist-info → kuavo_humanoid_sdk-1.1.3a1226.dist-info}/METADATA +2 -1
- {kuavo_humanoid_sdk-1.1.2a922.dist-info → kuavo_humanoid_sdk-1.1.3a1226.dist-info}/RECORD +41 -33
- kuavo_humanoid_sdk/msg/motion_capture_ik/msg/__init__.py +0 -9
- kuavo_humanoid_sdk/msg/motion_capture_ik/msg/_headBodyPose.py +0 -145
- kuavo_humanoid_sdk/msg/motion_capture_ik/msg/_robotHandPosition.py +0 -225
- kuavo_humanoid_sdk/msg/motion_capture_ik/srv/__init__.py +0 -4
- {kuavo_humanoid_sdk-1.1.2a922.dist-info → kuavo_humanoid_sdk-1.1.3a1226.dist-info}/WHEEL +0 -0
- {kuavo_humanoid_sdk-1.1.2a922.dist-info → kuavo_humanoid_sdk-1.1.3a1226.dist-info}/top_level.txt +0 -0
|
@@ -0,0 +1,437 @@
|
|
|
1
|
+
# This Python file uses the following encoding: utf-8
|
|
2
|
+
"""autogenerated by genpy from kuavo_msgs/AprilTagDetectionArray.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 geometry_msgs.msg
|
|
10
|
+
import kuavo_msgs.msg
|
|
11
|
+
import std_msgs.msg
|
|
12
|
+
|
|
13
|
+
class AprilTagDetectionArray(genpy.Message):
|
|
14
|
+
_md5sum = "2b6c03434883a5c9897c13b5594dbd91"
|
|
15
|
+
_type = "kuavo_msgs/AprilTagDetectionArray"
|
|
16
|
+
_has_header = True # flag to mark the presence of a Header object
|
|
17
|
+
_full_text = """std_msgs/Header header
|
|
18
|
+
AprilTagDetection[] detections
|
|
19
|
+
|
|
20
|
+
================================================================================
|
|
21
|
+
MSG: std_msgs/Header
|
|
22
|
+
# Standard metadata for higher-level stamped data types.
|
|
23
|
+
# This is generally used to communicate timestamped data
|
|
24
|
+
# in a particular coordinate frame.
|
|
25
|
+
#
|
|
26
|
+
# sequence ID: consecutively increasing ID
|
|
27
|
+
uint32 seq
|
|
28
|
+
#Two-integer timestamp that is expressed as:
|
|
29
|
+
# * stamp.sec: seconds (stamp_secs) since epoch (in Python the variable is called 'secs')
|
|
30
|
+
# * stamp.nsec: nanoseconds since stamp_secs (in Python the variable is called 'nsecs')
|
|
31
|
+
# time-handling sugar is provided by the client library
|
|
32
|
+
time stamp
|
|
33
|
+
#Frame this data is associated with
|
|
34
|
+
string frame_id
|
|
35
|
+
|
|
36
|
+
================================================================================
|
|
37
|
+
MSG: kuavo_msgs/AprilTagDetection
|
|
38
|
+
# Tag ID(s). If a standalone tag, this is a vector of size 1. If a tag bundle,
|
|
39
|
+
# this is a vector containing the IDs of each tag in the bundle.
|
|
40
|
+
int32[] id
|
|
41
|
+
|
|
42
|
+
# Tag size(s). If a standalone tag, this is a vector of size 1. If a tag bundle,
|
|
43
|
+
# this is a vector containing the sizes of each tag in the bundle, in the same
|
|
44
|
+
# order as the IDs above.
|
|
45
|
+
float64[] size
|
|
46
|
+
|
|
47
|
+
# Pose in the camera frame, obtained from homography transform. If a standalone
|
|
48
|
+
# tag, the homography is from the four tag corners. If a tag bundle, the
|
|
49
|
+
# homography is from at least the four corners of one member tag and at most the
|
|
50
|
+
# four corners of all member tags.
|
|
51
|
+
geometry_msgs/PoseWithCovarianceStamped pose
|
|
52
|
+
================================================================================
|
|
53
|
+
MSG: geometry_msgs/PoseWithCovarianceStamped
|
|
54
|
+
# This expresses an estimated pose with a reference coordinate frame and timestamp
|
|
55
|
+
|
|
56
|
+
Header header
|
|
57
|
+
PoseWithCovariance pose
|
|
58
|
+
|
|
59
|
+
================================================================================
|
|
60
|
+
MSG: geometry_msgs/PoseWithCovariance
|
|
61
|
+
# This represents a pose in free space with uncertainty.
|
|
62
|
+
|
|
63
|
+
Pose pose
|
|
64
|
+
|
|
65
|
+
# Row-major representation of the 6x6 covariance matrix
|
|
66
|
+
# The orientation parameters use a fixed-axis representation.
|
|
67
|
+
# In order, the parameters are:
|
|
68
|
+
# (x, y, z, rotation about X axis, rotation about Y axis, rotation about Z axis)
|
|
69
|
+
float64[36] covariance
|
|
70
|
+
|
|
71
|
+
================================================================================
|
|
72
|
+
MSG: geometry_msgs/Pose
|
|
73
|
+
# A representation of pose in free space, composed of position and orientation.
|
|
74
|
+
Point position
|
|
75
|
+
Quaternion orientation
|
|
76
|
+
|
|
77
|
+
================================================================================
|
|
78
|
+
MSG: geometry_msgs/Point
|
|
79
|
+
# This contains the position of a point in free space
|
|
80
|
+
float64 x
|
|
81
|
+
float64 y
|
|
82
|
+
float64 z
|
|
83
|
+
|
|
84
|
+
================================================================================
|
|
85
|
+
MSG: geometry_msgs/Quaternion
|
|
86
|
+
# This represents an orientation in free space in quaternion form.
|
|
87
|
+
|
|
88
|
+
float64 x
|
|
89
|
+
float64 y
|
|
90
|
+
float64 z
|
|
91
|
+
float64 w
|
|
92
|
+
"""
|
|
93
|
+
__slots__ = ['header','detections']
|
|
94
|
+
_slot_types = ['std_msgs/Header','kuavo_msgs/AprilTagDetection[]']
|
|
95
|
+
|
|
96
|
+
def __init__(self, *args, **kwds):
|
|
97
|
+
"""
|
|
98
|
+
Constructor. Any message fields that are implicitly/explicitly
|
|
99
|
+
set to None will be assigned a default value. The recommend
|
|
100
|
+
use is keyword arguments as this is more robust to future message
|
|
101
|
+
changes. You cannot mix in-order arguments and keyword arguments.
|
|
102
|
+
|
|
103
|
+
The available fields are:
|
|
104
|
+
header,detections
|
|
105
|
+
|
|
106
|
+
:param args: complete set of field values, in .msg order
|
|
107
|
+
:param kwds: use keyword arguments corresponding to message field names
|
|
108
|
+
to set specific fields.
|
|
109
|
+
"""
|
|
110
|
+
if args or kwds:
|
|
111
|
+
super(AprilTagDetectionArray, self).__init__(*args, **kwds)
|
|
112
|
+
# message fields cannot be None, assign default values for those that are
|
|
113
|
+
if self.header is None:
|
|
114
|
+
self.header = std_msgs.msg.Header()
|
|
115
|
+
if self.detections is None:
|
|
116
|
+
self.detections = []
|
|
117
|
+
else:
|
|
118
|
+
self.header = std_msgs.msg.Header()
|
|
119
|
+
self.detections = []
|
|
120
|
+
|
|
121
|
+
def _get_types(self):
|
|
122
|
+
"""
|
|
123
|
+
internal API method
|
|
124
|
+
"""
|
|
125
|
+
return self._slot_types
|
|
126
|
+
|
|
127
|
+
def serialize(self, buff):
|
|
128
|
+
"""
|
|
129
|
+
serialize message into buffer
|
|
130
|
+
:param buff: buffer, ``StringIO``
|
|
131
|
+
"""
|
|
132
|
+
try:
|
|
133
|
+
_x = self
|
|
134
|
+
buff.write(_get_struct_3I().pack(_x.header.seq, _x.header.stamp.secs, _x.header.stamp.nsecs))
|
|
135
|
+
_x = self.header.frame_id
|
|
136
|
+
length = len(_x)
|
|
137
|
+
if python3 or type(_x) == unicode:
|
|
138
|
+
_x = _x.encode('utf-8')
|
|
139
|
+
length = len(_x)
|
|
140
|
+
buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
|
|
141
|
+
length = len(self.detections)
|
|
142
|
+
buff.write(_struct_I.pack(length))
|
|
143
|
+
for val1 in self.detections:
|
|
144
|
+
length = len(val1.id)
|
|
145
|
+
buff.write(_struct_I.pack(length))
|
|
146
|
+
pattern = '<%si'%length
|
|
147
|
+
buff.write(struct.Struct(pattern).pack(*val1.id))
|
|
148
|
+
length = len(val1.size)
|
|
149
|
+
buff.write(_struct_I.pack(length))
|
|
150
|
+
pattern = '<%sd'%length
|
|
151
|
+
buff.write(struct.Struct(pattern).pack(*val1.size))
|
|
152
|
+
_v1 = val1.pose
|
|
153
|
+
_v2 = _v1.header
|
|
154
|
+
_x = _v2.seq
|
|
155
|
+
buff.write(_get_struct_I().pack(_x))
|
|
156
|
+
_v3 = _v2.stamp
|
|
157
|
+
_x = _v3
|
|
158
|
+
buff.write(_get_struct_2I().pack(_x.secs, _x.nsecs))
|
|
159
|
+
_x = _v2.frame_id
|
|
160
|
+
length = len(_x)
|
|
161
|
+
if python3 or type(_x) == unicode:
|
|
162
|
+
_x = _x.encode('utf-8')
|
|
163
|
+
length = len(_x)
|
|
164
|
+
buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
|
|
165
|
+
_v4 = _v1.pose
|
|
166
|
+
_v5 = _v4.pose
|
|
167
|
+
_v6 = _v5.position
|
|
168
|
+
_x = _v6
|
|
169
|
+
buff.write(_get_struct_3d().pack(_x.x, _x.y, _x.z))
|
|
170
|
+
_v7 = _v5.orientation
|
|
171
|
+
_x = _v7
|
|
172
|
+
buff.write(_get_struct_4d().pack(_x.x, _x.y, _x.z, _x.w))
|
|
173
|
+
buff.write(_get_struct_36d().pack(*_v4.covariance))
|
|
174
|
+
except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
|
|
175
|
+
except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
|
|
176
|
+
|
|
177
|
+
def deserialize(self, str):
|
|
178
|
+
"""
|
|
179
|
+
unpack serialized message in str into this message instance
|
|
180
|
+
:param str: byte array of serialized message, ``str``
|
|
181
|
+
"""
|
|
182
|
+
if python3:
|
|
183
|
+
codecs.lookup_error("rosmsg").msg_type = self._type
|
|
184
|
+
try:
|
|
185
|
+
if self.header is None:
|
|
186
|
+
self.header = std_msgs.msg.Header()
|
|
187
|
+
if self.detections is None:
|
|
188
|
+
self.detections = None
|
|
189
|
+
end = 0
|
|
190
|
+
_x = self
|
|
191
|
+
start = end
|
|
192
|
+
end += 12
|
|
193
|
+
(_x.header.seq, _x.header.stamp.secs, _x.header.stamp.nsecs,) = _get_struct_3I().unpack(str[start:end])
|
|
194
|
+
start = end
|
|
195
|
+
end += 4
|
|
196
|
+
(length,) = _struct_I.unpack(str[start:end])
|
|
197
|
+
start = end
|
|
198
|
+
end += length
|
|
199
|
+
if python3:
|
|
200
|
+
self.header.frame_id = str[start:end].decode('utf-8', 'rosmsg')
|
|
201
|
+
else:
|
|
202
|
+
self.header.frame_id = str[start:end]
|
|
203
|
+
start = end
|
|
204
|
+
end += 4
|
|
205
|
+
(length,) = _struct_I.unpack(str[start:end])
|
|
206
|
+
self.detections = []
|
|
207
|
+
for i in range(0, length):
|
|
208
|
+
val1 = kuavo_msgs.msg.AprilTagDetection()
|
|
209
|
+
start = end
|
|
210
|
+
end += 4
|
|
211
|
+
(length,) = _struct_I.unpack(str[start:end])
|
|
212
|
+
pattern = '<%si'%length
|
|
213
|
+
start = end
|
|
214
|
+
s = struct.Struct(pattern)
|
|
215
|
+
end += s.size
|
|
216
|
+
val1.id = s.unpack(str[start:end])
|
|
217
|
+
start = end
|
|
218
|
+
end += 4
|
|
219
|
+
(length,) = _struct_I.unpack(str[start:end])
|
|
220
|
+
pattern = '<%sd'%length
|
|
221
|
+
start = end
|
|
222
|
+
s = struct.Struct(pattern)
|
|
223
|
+
end += s.size
|
|
224
|
+
val1.size = s.unpack(str[start:end])
|
|
225
|
+
_v8 = val1.pose
|
|
226
|
+
_v9 = _v8.header
|
|
227
|
+
start = end
|
|
228
|
+
end += 4
|
|
229
|
+
(_v9.seq,) = _get_struct_I().unpack(str[start:end])
|
|
230
|
+
_v10 = _v9.stamp
|
|
231
|
+
_x = _v10
|
|
232
|
+
start = end
|
|
233
|
+
end += 8
|
|
234
|
+
(_x.secs, _x.nsecs,) = _get_struct_2I().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
|
+
_v9.frame_id = str[start:end].decode('utf-8', 'rosmsg')
|
|
242
|
+
else:
|
|
243
|
+
_v9.frame_id = str[start:end]
|
|
244
|
+
_v11 = _v8.pose
|
|
245
|
+
_v12 = _v11.pose
|
|
246
|
+
_v13 = _v12.position
|
|
247
|
+
_x = _v13
|
|
248
|
+
start = end
|
|
249
|
+
end += 24
|
|
250
|
+
(_x.x, _x.y, _x.z,) = _get_struct_3d().unpack(str[start:end])
|
|
251
|
+
_v14 = _v12.orientation
|
|
252
|
+
_x = _v14
|
|
253
|
+
start = end
|
|
254
|
+
end += 32
|
|
255
|
+
(_x.x, _x.y, _x.z, _x.w,) = _get_struct_4d().unpack(str[start:end])
|
|
256
|
+
start = end
|
|
257
|
+
end += 288
|
|
258
|
+
_v11.covariance = _get_struct_36d().unpack(str[start:end])
|
|
259
|
+
self.detections.append(val1)
|
|
260
|
+
return self
|
|
261
|
+
except struct.error as e:
|
|
262
|
+
raise genpy.DeserializationError(e) # most likely buffer underfill
|
|
263
|
+
|
|
264
|
+
|
|
265
|
+
def serialize_numpy(self, buff, numpy):
|
|
266
|
+
"""
|
|
267
|
+
serialize message with numpy array types into buffer
|
|
268
|
+
:param buff: buffer, ``StringIO``
|
|
269
|
+
:param numpy: numpy python module
|
|
270
|
+
"""
|
|
271
|
+
try:
|
|
272
|
+
_x = self
|
|
273
|
+
buff.write(_get_struct_3I().pack(_x.header.seq, _x.header.stamp.secs, _x.header.stamp.nsecs))
|
|
274
|
+
_x = self.header.frame_id
|
|
275
|
+
length = len(_x)
|
|
276
|
+
if python3 or type(_x) == unicode:
|
|
277
|
+
_x = _x.encode('utf-8')
|
|
278
|
+
length = len(_x)
|
|
279
|
+
buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
|
|
280
|
+
length = len(self.detections)
|
|
281
|
+
buff.write(_struct_I.pack(length))
|
|
282
|
+
for val1 in self.detections:
|
|
283
|
+
length = len(val1.id)
|
|
284
|
+
buff.write(_struct_I.pack(length))
|
|
285
|
+
pattern = '<%si'%length
|
|
286
|
+
buff.write(val1.id.tostring())
|
|
287
|
+
length = len(val1.size)
|
|
288
|
+
buff.write(_struct_I.pack(length))
|
|
289
|
+
pattern = '<%sd'%length
|
|
290
|
+
buff.write(val1.size.tostring())
|
|
291
|
+
_v15 = val1.pose
|
|
292
|
+
_v16 = _v15.header
|
|
293
|
+
_x = _v16.seq
|
|
294
|
+
buff.write(_get_struct_I().pack(_x))
|
|
295
|
+
_v17 = _v16.stamp
|
|
296
|
+
_x = _v17
|
|
297
|
+
buff.write(_get_struct_2I().pack(_x.secs, _x.nsecs))
|
|
298
|
+
_x = _v16.frame_id
|
|
299
|
+
length = len(_x)
|
|
300
|
+
if python3 or type(_x) == unicode:
|
|
301
|
+
_x = _x.encode('utf-8')
|
|
302
|
+
length = len(_x)
|
|
303
|
+
buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
|
|
304
|
+
_v18 = _v15.pose
|
|
305
|
+
_v19 = _v18.pose
|
|
306
|
+
_v20 = _v19.position
|
|
307
|
+
_x = _v20
|
|
308
|
+
buff.write(_get_struct_3d().pack(_x.x, _x.y, _x.z))
|
|
309
|
+
_v21 = _v19.orientation
|
|
310
|
+
_x = _v21
|
|
311
|
+
buff.write(_get_struct_4d().pack(_x.x, _x.y, _x.z, _x.w))
|
|
312
|
+
buff.write(_v18.covariance.tostring())
|
|
313
|
+
except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
|
|
314
|
+
except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
|
|
315
|
+
|
|
316
|
+
def deserialize_numpy(self, str, numpy):
|
|
317
|
+
"""
|
|
318
|
+
unpack serialized message in str into this message instance using numpy for array types
|
|
319
|
+
:param str: byte array of serialized message, ``str``
|
|
320
|
+
:param numpy: numpy python module
|
|
321
|
+
"""
|
|
322
|
+
if python3:
|
|
323
|
+
codecs.lookup_error("rosmsg").msg_type = self._type
|
|
324
|
+
try:
|
|
325
|
+
if self.header is None:
|
|
326
|
+
self.header = std_msgs.msg.Header()
|
|
327
|
+
if self.detections is None:
|
|
328
|
+
self.detections = None
|
|
329
|
+
end = 0
|
|
330
|
+
_x = self
|
|
331
|
+
start = end
|
|
332
|
+
end += 12
|
|
333
|
+
(_x.header.seq, _x.header.stamp.secs, _x.header.stamp.nsecs,) = _get_struct_3I().unpack(str[start:end])
|
|
334
|
+
start = end
|
|
335
|
+
end += 4
|
|
336
|
+
(length,) = _struct_I.unpack(str[start:end])
|
|
337
|
+
start = end
|
|
338
|
+
end += length
|
|
339
|
+
if python3:
|
|
340
|
+
self.header.frame_id = str[start:end].decode('utf-8', 'rosmsg')
|
|
341
|
+
else:
|
|
342
|
+
self.header.frame_id = str[start:end]
|
|
343
|
+
start = end
|
|
344
|
+
end += 4
|
|
345
|
+
(length,) = _struct_I.unpack(str[start:end])
|
|
346
|
+
self.detections = []
|
|
347
|
+
for i in range(0, length):
|
|
348
|
+
val1 = kuavo_msgs.msg.AprilTagDetection()
|
|
349
|
+
start = end
|
|
350
|
+
end += 4
|
|
351
|
+
(length,) = _struct_I.unpack(str[start:end])
|
|
352
|
+
pattern = '<%si'%length
|
|
353
|
+
start = end
|
|
354
|
+
s = struct.Struct(pattern)
|
|
355
|
+
end += s.size
|
|
356
|
+
val1.id = numpy.frombuffer(str[start:end], dtype=numpy.int32, count=length)
|
|
357
|
+
start = end
|
|
358
|
+
end += 4
|
|
359
|
+
(length,) = _struct_I.unpack(str[start:end])
|
|
360
|
+
pattern = '<%sd'%length
|
|
361
|
+
start = end
|
|
362
|
+
s = struct.Struct(pattern)
|
|
363
|
+
end += s.size
|
|
364
|
+
val1.size = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length)
|
|
365
|
+
_v22 = val1.pose
|
|
366
|
+
_v23 = _v22.header
|
|
367
|
+
start = end
|
|
368
|
+
end += 4
|
|
369
|
+
(_v23.seq,) = _get_struct_I().unpack(str[start:end])
|
|
370
|
+
_v24 = _v23.stamp
|
|
371
|
+
_x = _v24
|
|
372
|
+
start = end
|
|
373
|
+
end += 8
|
|
374
|
+
(_x.secs, _x.nsecs,) = _get_struct_2I().unpack(str[start:end])
|
|
375
|
+
start = end
|
|
376
|
+
end += 4
|
|
377
|
+
(length,) = _struct_I.unpack(str[start:end])
|
|
378
|
+
start = end
|
|
379
|
+
end += length
|
|
380
|
+
if python3:
|
|
381
|
+
_v23.frame_id = str[start:end].decode('utf-8', 'rosmsg')
|
|
382
|
+
else:
|
|
383
|
+
_v23.frame_id = str[start:end]
|
|
384
|
+
_v25 = _v22.pose
|
|
385
|
+
_v26 = _v25.pose
|
|
386
|
+
_v27 = _v26.position
|
|
387
|
+
_x = _v27
|
|
388
|
+
start = end
|
|
389
|
+
end += 24
|
|
390
|
+
(_x.x, _x.y, _x.z,) = _get_struct_3d().unpack(str[start:end])
|
|
391
|
+
_v28 = _v26.orientation
|
|
392
|
+
_x = _v28
|
|
393
|
+
start = end
|
|
394
|
+
end += 32
|
|
395
|
+
(_x.x, _x.y, _x.z, _x.w,) = _get_struct_4d().unpack(str[start:end])
|
|
396
|
+
start = end
|
|
397
|
+
end += 288
|
|
398
|
+
_v25.covariance = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=36)
|
|
399
|
+
self.detections.append(val1)
|
|
400
|
+
return self
|
|
401
|
+
except struct.error as e:
|
|
402
|
+
raise genpy.DeserializationError(e) # most likely buffer underfill
|
|
403
|
+
|
|
404
|
+
_struct_I = genpy.struct_I
|
|
405
|
+
def _get_struct_I():
|
|
406
|
+
global _struct_I
|
|
407
|
+
return _struct_I
|
|
408
|
+
_struct_2I = None
|
|
409
|
+
def _get_struct_2I():
|
|
410
|
+
global _struct_2I
|
|
411
|
+
if _struct_2I is None:
|
|
412
|
+
_struct_2I = struct.Struct("<2I")
|
|
413
|
+
return _struct_2I
|
|
414
|
+
_struct_36d = None
|
|
415
|
+
def _get_struct_36d():
|
|
416
|
+
global _struct_36d
|
|
417
|
+
if _struct_36d is None:
|
|
418
|
+
_struct_36d = struct.Struct("<36d")
|
|
419
|
+
return _struct_36d
|
|
420
|
+
_struct_3I = None
|
|
421
|
+
def _get_struct_3I():
|
|
422
|
+
global _struct_3I
|
|
423
|
+
if _struct_3I is None:
|
|
424
|
+
_struct_3I = struct.Struct("<3I")
|
|
425
|
+
return _struct_3I
|
|
426
|
+
_struct_3d = None
|
|
427
|
+
def _get_struct_3d():
|
|
428
|
+
global _struct_3d
|
|
429
|
+
if _struct_3d is None:
|
|
430
|
+
_struct_3d = struct.Struct("<3d")
|
|
431
|
+
return _struct_3d
|
|
432
|
+
_struct_4d = None
|
|
433
|
+
def _get_struct_4d():
|
|
434
|
+
global _struct_4d
|
|
435
|
+
if _struct_4d is None:
|
|
436
|
+
_struct_4d = struct.Struct("<4d")
|
|
437
|
+
return _struct_4d
|
|
@@ -1,4 +1,7 @@
|
|
|
1
|
+
from ._AprilTagDetection import *
|
|
2
|
+
from ._AprilTagDetectionArray import *
|
|
1
3
|
from ._Metadata import *
|
|
4
|
+
from ._armHandPose import *
|
|
2
5
|
from ._armPoseWithTimeStamp import *
|
|
3
6
|
from ._armTargetPoses import *
|
|
4
7
|
from ._dexhandCommand import *
|
|
@@ -9,18 +12,24 @@ from ._footPoseTargetTrajectories import *
|
|
|
9
12
|
from ._gaitTimeName import *
|
|
10
13
|
from ._gestureInfo import *
|
|
11
14
|
from ._gestureTask import *
|
|
15
|
+
from ._handPose import *
|
|
12
16
|
from ._headBodyPose import *
|
|
17
|
+
from ._ikSolveError import *
|
|
18
|
+
from ._ikSolveParam import *
|
|
13
19
|
from ._imuData import *
|
|
14
20
|
from ._jointCmd import *
|
|
15
21
|
from ._jointData import *
|
|
16
22
|
from ._lejuClawCommand import *
|
|
17
23
|
from ._lejuClawState import *
|
|
18
24
|
from ._questJoySticks import *
|
|
25
|
+
from ._robotArmQVVD import *
|
|
19
26
|
from ._robotHandPosition import *
|
|
20
27
|
from ._robotHeadMotionData import *
|
|
21
28
|
from ._robotState import *
|
|
22
29
|
from ._sensorsData import *
|
|
23
30
|
from ._switchGaitByName import *
|
|
24
31
|
from ._touchSensorStatus import *
|
|
32
|
+
from ._twoArmHandPose import *
|
|
33
|
+
from ._twoArmHandPoseCmd import *
|
|
25
34
|
from ._yoloDetection import *
|
|
26
35
|
from ._yoloOutputData import *
|
|
@@ -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 kuavo_msgs/armHandPose.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 armHandPose(genpy.Message):
|
|
11
11
|
_md5sum = "4f28a253cb60d59c6491569369f38f4d"
|
|
12
|
-
_type = "
|
|
12
|
+
_type = "kuavo_msgs/armHandPose"
|
|
13
13
|
_has_header = False # flag to mark the presence of a Header object
|
|
14
14
|
_full_text = """float64[3] pos_xyz
|
|
15
15
|
float64[4] quat_xyzw
|
|
@@ -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 kuavo_msgs/handPose.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 handPose(genpy.Message):
|
|
11
11
|
_md5sum = "1a83f0bdabe750ce0cfb45a14ec63457"
|
|
12
|
-
_type = "
|
|
12
|
+
_type = "kuavo_msgs/handPose"
|
|
13
13
|
_has_header = False # flag to mark the presence of a Header object
|
|
14
14
|
_full_text = """# pos
|
|
15
15
|
float64 x
|
|
@@ -1,22 +1,22 @@
|
|
|
1
1
|
# This Python file uses the following encoding: utf-8
|
|
2
|
-
"""autogenerated by genpy from
|
|
2
|
+
"""autogenerated by genpy from kuavo_msgs/ikSolveError.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 kuavo_msgs.msg
|
|
10
10
|
|
|
11
11
|
class ikSolveError(genpy.Message):
|
|
12
12
|
_md5sum = "06c12c0e6e08f286627a6f856e26223c"
|
|
13
|
-
_type = "
|
|
13
|
+
_type = "kuavo_msgs/ikSolveError"
|
|
14
14
|
_has_header = False # flag to mark the presence of a Header object
|
|
15
15
|
_full_text = """string ik_type
|
|
16
16
|
handPose left_pose_error
|
|
17
17
|
handPose right_pose_error
|
|
18
18
|
================================================================================
|
|
19
|
-
MSG:
|
|
19
|
+
MSG: kuavo_msgs/handPose
|
|
20
20
|
# pos
|
|
21
21
|
float64 x
|
|
22
22
|
float64 y
|
|
@@ -26,7 +26,7 @@ float64 roll
|
|
|
26
26
|
float64 pitch
|
|
27
27
|
float64 yaw"""
|
|
28
28
|
__slots__ = ['ik_type','left_pose_error','right_pose_error']
|
|
29
|
-
_slot_types = ['string','
|
|
29
|
+
_slot_types = ['string','kuavo_msgs/handPose','kuavo_msgs/handPose']
|
|
30
30
|
|
|
31
31
|
def __init__(self, *args, **kwds):
|
|
32
32
|
"""
|
|
@@ -48,13 +48,13 @@ float64 yaw"""
|
|
|
48
48
|
if self.ik_type is None:
|
|
49
49
|
self.ik_type = ''
|
|
50
50
|
if self.left_pose_error is None:
|
|
51
|
-
self.left_pose_error =
|
|
51
|
+
self.left_pose_error = kuavo_msgs.msg.handPose()
|
|
52
52
|
if self.right_pose_error is None:
|
|
53
|
-
self.right_pose_error =
|
|
53
|
+
self.right_pose_error = kuavo_msgs.msg.handPose()
|
|
54
54
|
else:
|
|
55
55
|
self.ik_type = ''
|
|
56
|
-
self.left_pose_error =
|
|
57
|
-
self.right_pose_error =
|
|
56
|
+
self.left_pose_error = kuavo_msgs.msg.handPose()
|
|
57
|
+
self.right_pose_error = kuavo_msgs.msg.handPose()
|
|
58
58
|
|
|
59
59
|
def _get_types(self):
|
|
60
60
|
"""
|
|
@@ -88,9 +88,9 @@ float64 yaw"""
|
|
|
88
88
|
codecs.lookup_error("rosmsg").msg_type = self._type
|
|
89
89
|
try:
|
|
90
90
|
if self.left_pose_error is None:
|
|
91
|
-
self.left_pose_error =
|
|
91
|
+
self.left_pose_error = kuavo_msgs.msg.handPose()
|
|
92
92
|
if self.right_pose_error is None:
|
|
93
|
-
self.right_pose_error =
|
|
93
|
+
self.right_pose_error = kuavo_msgs.msg.handPose()
|
|
94
94
|
end = 0
|
|
95
95
|
start = end
|
|
96
96
|
end += 4
|
|
@@ -138,9 +138,9 @@ float64 yaw"""
|
|
|
138
138
|
codecs.lookup_error("rosmsg").msg_type = self._type
|
|
139
139
|
try:
|
|
140
140
|
if self.left_pose_error is None:
|
|
141
|
-
self.left_pose_error =
|
|
141
|
+
self.left_pose_error = kuavo_msgs.msg.handPose()
|
|
142
142
|
if self.right_pose_error is None:
|
|
143
|
-
self.right_pose_error =
|
|
143
|
+
self.right_pose_error = kuavo_msgs.msg.handPose()
|
|
144
144
|
end = 0
|
|
145
145
|
start = end
|
|
146
146
|
end += 4
|
|
@@ -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 kuavo_msgs/ikSolveParam.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 ikSolveParam(genpy.Message):
|
|
11
11
|
_md5sum = "be29d8b02ad14da680464b8c4f590f98"
|
|
12
|
-
_type = "
|
|
12
|
+
_type = "kuavo_msgs/ikSolveParam"
|
|
13
13
|
_has_header = False # flag to mark the presence of a Header object
|
|
14
14
|
_full_text = """# snopt params
|
|
15
15
|
float64 major_optimality_tol
|
|
@@ -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 kuavo_msgs/robotArmQVVD.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 robotArmQVVD(genpy.Message):
|
|
11
11
|
_md5sum = "f2840165d02c529a8a4e8e04370a219b"
|
|
12
|
-
_type = "
|
|
12
|
+
_type = "kuavo_msgs/robotArmQVVD"
|
|
13
13
|
_has_header = False # flag to mark the presence of a Header object
|
|
14
14
|
_full_text = """float64[] q
|
|
15
15
|
float64[] v
|
|
@@ -1,17 +1,17 @@
|
|
|
1
1
|
# This Python file uses the following encoding: utf-8
|
|
2
|
-
"""autogenerated by genpy from
|
|
2
|
+
"""autogenerated by genpy from kuavo_msgs/twoArmHandPose.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 kuavo_msgs.msg
|
|
10
10
|
import std_msgs.msg
|
|
11
11
|
|
|
12
12
|
class twoArmHandPose(genpy.Message):
|
|
13
13
|
_md5sum = "5bdb1e027f430369b6f88e5e2f5d31ca"
|
|
14
|
-
_type = "
|
|
14
|
+
_type = "kuavo_msgs/twoArmHandPose"
|
|
15
15
|
_has_header = True # flag to mark the presence of a Header object
|
|
16
16
|
_full_text = """Header header
|
|
17
17
|
armHandPose left_pose
|
|
@@ -33,7 +33,7 @@ time stamp
|
|
|
33
33
|
string frame_id
|
|
34
34
|
|
|
35
35
|
================================================================================
|
|
36
|
-
MSG:
|
|
36
|
+
MSG: kuavo_msgs/armHandPose
|
|
37
37
|
float64[3] pos_xyz
|
|
38
38
|
float64[4] quat_xyzw
|
|
39
39
|
|
|
@@ -41,7 +41,7 @@ float64[3] elbow_pos_xyz
|
|
|
41
41
|
|
|
42
42
|
float64[7] joint_angles"""
|
|
43
43
|
__slots__ = ['header','left_pose','right_pose']
|
|
44
|
-
_slot_types = ['std_msgs/Header','
|
|
44
|
+
_slot_types = ['std_msgs/Header','kuavo_msgs/armHandPose','kuavo_msgs/armHandPose']
|
|
45
45
|
|
|
46
46
|
def __init__(self, *args, **kwds):
|
|
47
47
|
"""
|
|
@@ -63,13 +63,13 @@ float64[7] joint_angles"""
|
|
|
63
63
|
if self.header is None:
|
|
64
64
|
self.header = std_msgs.msg.Header()
|
|
65
65
|
if self.left_pose is None:
|
|
66
|
-
self.left_pose =
|
|
66
|
+
self.left_pose = kuavo_msgs.msg.armHandPose()
|
|
67
67
|
if self.right_pose is None:
|
|
68
|
-
self.right_pose =
|
|
68
|
+
self.right_pose = kuavo_msgs.msg.armHandPose()
|
|
69
69
|
else:
|
|
70
70
|
self.header = std_msgs.msg.Header()
|
|
71
|
-
self.left_pose =
|
|
72
|
-
self.right_pose =
|
|
71
|
+
self.left_pose = kuavo_msgs.msg.armHandPose()
|
|
72
|
+
self.right_pose = kuavo_msgs.msg.armHandPose()
|
|
73
73
|
|
|
74
74
|
def _get_types(self):
|
|
75
75
|
"""
|
|
@@ -113,9 +113,9 @@ float64[7] joint_angles"""
|
|
|
113
113
|
if self.header is None:
|
|
114
114
|
self.header = std_msgs.msg.Header()
|
|
115
115
|
if self.left_pose is None:
|
|
116
|
-
self.left_pose =
|
|
116
|
+
self.left_pose = kuavo_msgs.msg.armHandPose()
|
|
117
117
|
if self.right_pose is None:
|
|
118
|
-
self.right_pose =
|
|
118
|
+
self.right_pose = kuavo_msgs.msg.armHandPose()
|
|
119
119
|
end = 0
|
|
120
120
|
_x = self
|
|
121
121
|
start = end
|
|
@@ -197,9 +197,9 @@ float64[7] joint_angles"""
|
|
|
197
197
|
if self.header is None:
|
|
198
198
|
self.header = std_msgs.msg.Header()
|
|
199
199
|
if self.left_pose is None:
|
|
200
|
-
self.left_pose =
|
|
200
|
+
self.left_pose = kuavo_msgs.msg.armHandPose()
|
|
201
201
|
if self.right_pose is None:
|
|
202
|
-
self.right_pose =
|
|
202
|
+
self.right_pose = kuavo_msgs.msg.armHandPose()
|
|
203
203
|
end = 0
|
|
204
204
|
_x = self
|
|
205
205
|
start = end
|