kuavo-humanoid-sdk 1.2.1b3290__20250912184757-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 +6 -0
- kuavo_humanoid_sdk/common/logger.py +45 -0
- kuavo_humanoid_sdk/interfaces/__init__.py +4 -0
- kuavo_humanoid_sdk/interfaces/data_types.py +288 -0
- kuavo_humanoid_sdk/interfaces/end_effector.py +62 -0
- kuavo_humanoid_sdk/interfaces/robot.py +22 -0
- kuavo_humanoid_sdk/interfaces/robot_info.py +56 -0
- kuavo_humanoid_sdk/kuavo/__init__.py +16 -0
- kuavo_humanoid_sdk/kuavo/core/audio.py +32 -0
- kuavo_humanoid_sdk/kuavo/core/core.py +666 -0
- kuavo_humanoid_sdk/kuavo/core/dex_hand_control.py +114 -0
- kuavo_humanoid_sdk/kuavo/core/leju_claw_control.py +67 -0
- kuavo_humanoid_sdk/kuavo/core/llm_doubao.py +608 -0
- kuavo_humanoid_sdk/kuavo/core/microphone.py +192 -0
- kuavo_humanoid_sdk/kuavo/core/navigation.py +70 -0
- kuavo_humanoid_sdk/kuavo/core/ros/audio.py +110 -0
- kuavo_humanoid_sdk/kuavo/core/ros/camera.py +105 -0
- kuavo_humanoid_sdk/kuavo/core/ros/control.py +1524 -0
- kuavo_humanoid_sdk/kuavo/core/ros/microphone.py +38 -0
- kuavo_humanoid_sdk/kuavo/core/ros/navigation.py +217 -0
- kuavo_humanoid_sdk/kuavo/core/ros/observation.py +94 -0
- kuavo_humanoid_sdk/kuavo/core/ros/param.py +201 -0
- kuavo_humanoid_sdk/kuavo/core/ros/sat_utils.py +103 -0
- kuavo_humanoid_sdk/kuavo/core/ros/state.py +652 -0
- kuavo_humanoid_sdk/kuavo/core/ros/tools.py +220 -0
- kuavo_humanoid_sdk/kuavo/core/ros/vision.py +234 -0
- kuavo_humanoid_sdk/kuavo/core/ros_env.py +238 -0
- kuavo_humanoid_sdk/kuavo/core/sdk_deprecated.py +41 -0
- kuavo_humanoid_sdk/kuavo/demo_climbstair.py +249 -0
- kuavo_humanoid_sdk/kuavo/dexterous_hand.py +238 -0
- kuavo_humanoid_sdk/kuavo/leju_claw.py +235 -0
- kuavo_humanoid_sdk/kuavo/logger_client.py +80 -0
- kuavo_humanoid_sdk/kuavo/robot.py +561 -0
- kuavo_humanoid_sdk/kuavo/robot_arm.py +411 -0
- kuavo_humanoid_sdk/kuavo/robot_audio.py +39 -0
- kuavo_humanoid_sdk/kuavo/robot_blockly.py +1154 -0
- kuavo_humanoid_sdk/kuavo/robot_climbstair.py +1607 -0
- kuavo_humanoid_sdk/kuavo/robot_head.py +95 -0
- kuavo_humanoid_sdk/kuavo/robot_info.py +134 -0
- kuavo_humanoid_sdk/kuavo/robot_microphone.py +19 -0
- kuavo_humanoid_sdk/kuavo/robot_navigation.py +135 -0
- kuavo_humanoid_sdk/kuavo/robot_observation.py +64 -0
- kuavo_humanoid_sdk/kuavo/robot_speech.py +24 -0
- kuavo_humanoid_sdk/kuavo/robot_state.py +310 -0
- kuavo_humanoid_sdk/kuavo/robot_tool.py +109 -0
- kuavo_humanoid_sdk/kuavo/robot_vision.py +81 -0
- kuavo_humanoid_sdk/kuavo_strategy/__init__.py +2 -0
- kuavo_humanoid_sdk/kuavo_strategy/grasp_box/grasp_box_strategy.py +1325 -0
- kuavo_humanoid_sdk/kuavo_strategy/kuavo_strategy.py +106 -0
- kuavo_humanoid_sdk/kuavo_strategy_v2/common/data_type.py +340 -0
- kuavo_humanoid_sdk/kuavo_strategy_v2/common/events/base_event.py +215 -0
- kuavo_humanoid_sdk/kuavo_strategy_v2/common/robot_sdk.py +25 -0
- kuavo_humanoid_sdk/kuavo_strategy_v2/pick_place_box/case.py +331 -0
- kuavo_humanoid_sdk/kuavo_strategy_v2/pick_place_box/strategy.py +504 -0
- kuavo_humanoid_sdk/kuavo_strategy_v2/utils/logger_setup.py +40 -0
- kuavo_humanoid_sdk/kuavo_strategy_v2/utils/utils.py +88 -0
- kuavo_humanoid_sdk/msg/__init__.py +4 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/__init__.py +7 -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/_AudioReceiverData.py +122 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_FTsensorData.py +260 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_JoySticks.py +191 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_Metadata.py +199 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_MmDetectionMsg.py +264 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_RobotActionState.py +112 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_TFArray.py +323 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_TaskPoint.py +175 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/__init__.py +62 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_armCollisionCheckInfo.py +160 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_armHandPose.py +161 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_armHandPoseFree.py +171 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_armPoseWithTimeStamp.py +168 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_armTargetPoses.py +171 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_bezierCurveCubicPoint.py +178 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_dexhandCommand.py +229 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_dexhandTouchState.py +256 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_endEffectorData.py +227 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPose.py +123 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPose6D.py +123 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPose6DTargetTrajectories.py +320 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPoseTargetTrajectories.py +301 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPoseWithVision.py +136 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPoseWithVisionArray.py +231 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPoses.py +149 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPoses6D.py +149 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_fullBodyTargetTrajectories.py +258 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_gaitTimeName.py +147 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_gestureInfo.py +218 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_gestureTask.py +149 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_handPose.py +136 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_headBodyPose.py +145 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_ikSolveError.py +171 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_ikSolveParam.py +140 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_imuData.py +165 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_jointBezierTrajectory.py +201 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_jointCmd.py +390 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_jointData.py +205 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_kuavoModeSchedule.py +224 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_lejuClawCommand.py +320 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_lejuClawState.py +341 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_motorParam.py +122 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_picoPoseInfo.py +143 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_picoPoseInfoList.py +220 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_planArmState.py +120 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_qv.py +121 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_robotArmQVVD.py +177 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_robotBodyMatrices.py +332 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_robotHandPosition.py +225 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_robotHeadMotionData.py +128 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_robotState.py +222 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_sensorsData.py +655 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_switchGaitByName.py +200 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_tagDataArray.py +216 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_touchSensorStatus.py +162 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_twoArmHandPose.py +273 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_twoArmHandPoseCmd.py +316 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_twoArmHandPoseCmdFree.py +338 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_twoArmHandPoseFree.py +299 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_yoloDetection.py +251 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_yoloOutputData.py +168 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_CreatePath.py +581 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_ExecuteArmAction.py +281 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_GetAllMaps.py +241 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_GetCurrentMap.py +225 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_GetTargetPartPoseInCamera.py +298 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_InitialPoseWithTaskPoint.py +281 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_LoadMap.py +281 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_NavigateToTaskPoint.py +281 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_RepublishTFs.py +373 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_SetInitialPose.py +394 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_SetJoyTopic.py +282 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_SetLEDMode.py +468 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_SetLEDMode_free.py +289 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_SpeechSynthesis.py +270 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_TaskPointOperation.py +536 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/__init__.py +43 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_adjustZeroPoint.py +277 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_changeArmCtrlMode.py +275 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_changeArmCtrlModeKuavo.py +236 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_changeMotorParam.py +299 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_changeTorsoCtrlMode.py +274 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_controlLejuClaw.py +408 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_enableHandTouchSensor.py +304 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_fkSrv.py +395 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_footPose6DTargetTrajectoriesSrv.py +426 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_footPoseTargetTrajectoriesSrv.py +409 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_gestureExecute.py +339 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_gestureExecuteState.py +257 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_gestureList.py +418 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_getCurrentGaitName.py +253 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_getMotorParam.py +299 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_getMotorZeroPoints.py +286 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_handForceLevel.py +330 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_jointMoveTo.py +302 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_planArmTrajectoryBezierCurve.py +422 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_planArmTrajectoryCubicSpline.py +490 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_playmusic.py +268 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_setHwIntialState.py +304 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_setMmCtrlFrame.py +273 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_setMotorEncoderRoundService.py +283 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_setTagId.py +275 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_singleStepControl.py +444 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_twoArmHandPoseCmdFreeSrv.py +716 -0
- kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_twoArmHandPoseCmdSrv.py +664 -0
- kuavo_humanoid_sdk/msg/motion_capture_ik/__init__.py +7 -0
- kuavo_humanoid_sdk/msg/ocs2_msgs/__init__.py +7 -0
- kuavo_humanoid_sdk/msg/ocs2_msgs/msg/__init__.py +12 -0
- kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_constraint.py +142 -0
- kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_controller_data.py +121 -0
- kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_lagrangian_metrics.py +148 -0
- kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mode_schedule.py +150 -0
- kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_flattened_controller.py +666 -0
- kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_input.py +122 -0
- kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_observation.py +209 -0
- kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_performance_indices.py +140 -0
- kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_solver_data.py +886 -0
- kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_state.py +122 -0
- kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_target_trajectories.py +239 -0
- kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_multiplier.py +148 -0
- kuavo_humanoid_sdk/msg/ocs2_msgs/srv/__init__.py +1 -0
- kuavo_humanoid_sdk/msg/ocs2_msgs/srv/_reset.py +376 -0
- kuavo_humanoid_sdk-1.2.1b3290.dist-info/METADATA +296 -0
- kuavo_humanoid_sdk-1.2.1b3290.dist-info/RECORD +186 -0
- kuavo_humanoid_sdk-1.2.1b3290.dist-info/WHEEL +6 -0
- kuavo_humanoid_sdk-1.2.1b3290.dist-info/top_level.txt +1 -0
|
@@ -0,0 +1,175 @@
|
|
|
1
|
+
# This Python file uses the following encoding: utf-8
|
|
2
|
+
"""autogenerated by genpy from kuavo_msgs/TaskPoint.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
|
+
|
|
11
|
+
class TaskPoint(genpy.Message):
|
|
12
|
+
_md5sum = "f716db42957c7b57682e1bb8a22eae4a"
|
|
13
|
+
_type = "kuavo_msgs/TaskPoint"
|
|
14
|
+
_has_header = False # flag to mark the presence of a Header object
|
|
15
|
+
_full_text = """geometry_msgs/Pose pose
|
|
16
|
+
string name
|
|
17
|
+
================================================================================
|
|
18
|
+
MSG: geometry_msgs/Pose
|
|
19
|
+
# A representation of pose in free space, composed of position and orientation.
|
|
20
|
+
Point position
|
|
21
|
+
Quaternion orientation
|
|
22
|
+
|
|
23
|
+
================================================================================
|
|
24
|
+
MSG: geometry_msgs/Point
|
|
25
|
+
# This contains the position of a point in free space
|
|
26
|
+
float64 x
|
|
27
|
+
float64 y
|
|
28
|
+
float64 z
|
|
29
|
+
|
|
30
|
+
================================================================================
|
|
31
|
+
MSG: geometry_msgs/Quaternion
|
|
32
|
+
# This represents an orientation in free space in quaternion form.
|
|
33
|
+
|
|
34
|
+
float64 x
|
|
35
|
+
float64 y
|
|
36
|
+
float64 z
|
|
37
|
+
float64 w
|
|
38
|
+
"""
|
|
39
|
+
__slots__ = ['pose','name']
|
|
40
|
+
_slot_types = ['geometry_msgs/Pose','string']
|
|
41
|
+
|
|
42
|
+
def __init__(self, *args, **kwds):
|
|
43
|
+
"""
|
|
44
|
+
Constructor. Any message fields that are implicitly/explicitly
|
|
45
|
+
set to None will be assigned a default value. The recommend
|
|
46
|
+
use is keyword arguments as this is more robust to future message
|
|
47
|
+
changes. You cannot mix in-order arguments and keyword arguments.
|
|
48
|
+
|
|
49
|
+
The available fields are:
|
|
50
|
+
pose,name
|
|
51
|
+
|
|
52
|
+
:param args: complete set of field values, in .msg order
|
|
53
|
+
:param kwds: use keyword arguments corresponding to message field names
|
|
54
|
+
to set specific fields.
|
|
55
|
+
"""
|
|
56
|
+
if args or kwds:
|
|
57
|
+
super(TaskPoint, self).__init__(*args, **kwds)
|
|
58
|
+
# message fields cannot be None, assign default values for those that are
|
|
59
|
+
if self.pose is None:
|
|
60
|
+
self.pose = geometry_msgs.msg.Pose()
|
|
61
|
+
if self.name is None:
|
|
62
|
+
self.name = ''
|
|
63
|
+
else:
|
|
64
|
+
self.pose = geometry_msgs.msg.Pose()
|
|
65
|
+
self.name = ''
|
|
66
|
+
|
|
67
|
+
def _get_types(self):
|
|
68
|
+
"""
|
|
69
|
+
internal API method
|
|
70
|
+
"""
|
|
71
|
+
return self._slot_types
|
|
72
|
+
|
|
73
|
+
def serialize(self, buff):
|
|
74
|
+
"""
|
|
75
|
+
serialize message into buffer
|
|
76
|
+
:param buff: buffer, ``StringIO``
|
|
77
|
+
"""
|
|
78
|
+
try:
|
|
79
|
+
_x = self
|
|
80
|
+
buff.write(_get_struct_7d().pack(_x.pose.position.x, _x.pose.position.y, _x.pose.position.z, _x.pose.orientation.x, _x.pose.orientation.y, _x.pose.orientation.z, _x.pose.orientation.w))
|
|
81
|
+
_x = self.name
|
|
82
|
+
length = len(_x)
|
|
83
|
+
if python3 or type(_x) == unicode:
|
|
84
|
+
_x = _x.encode('utf-8')
|
|
85
|
+
length = len(_x)
|
|
86
|
+
buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
|
|
87
|
+
except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
|
|
88
|
+
except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
|
|
89
|
+
|
|
90
|
+
def deserialize(self, str):
|
|
91
|
+
"""
|
|
92
|
+
unpack serialized message in str into this message instance
|
|
93
|
+
:param str: byte array of serialized message, ``str``
|
|
94
|
+
"""
|
|
95
|
+
if python3:
|
|
96
|
+
codecs.lookup_error("rosmsg").msg_type = self._type
|
|
97
|
+
try:
|
|
98
|
+
if self.pose is None:
|
|
99
|
+
self.pose = geometry_msgs.msg.Pose()
|
|
100
|
+
end = 0
|
|
101
|
+
_x = self
|
|
102
|
+
start = end
|
|
103
|
+
end += 56
|
|
104
|
+
(_x.pose.position.x, _x.pose.position.y, _x.pose.position.z, _x.pose.orientation.x, _x.pose.orientation.y, _x.pose.orientation.z, _x.pose.orientation.w,) = _get_struct_7d().unpack(str[start:end])
|
|
105
|
+
start = end
|
|
106
|
+
end += 4
|
|
107
|
+
(length,) = _struct_I.unpack(str[start:end])
|
|
108
|
+
start = end
|
|
109
|
+
end += length
|
|
110
|
+
if python3:
|
|
111
|
+
self.name = str[start:end].decode('utf-8', 'rosmsg')
|
|
112
|
+
else:
|
|
113
|
+
self.name = str[start:end]
|
|
114
|
+
return self
|
|
115
|
+
except struct.error as e:
|
|
116
|
+
raise genpy.DeserializationError(e) # most likely buffer underfill
|
|
117
|
+
|
|
118
|
+
|
|
119
|
+
def serialize_numpy(self, buff, numpy):
|
|
120
|
+
"""
|
|
121
|
+
serialize message with numpy array types into buffer
|
|
122
|
+
:param buff: buffer, ``StringIO``
|
|
123
|
+
:param numpy: numpy python module
|
|
124
|
+
"""
|
|
125
|
+
try:
|
|
126
|
+
_x = self
|
|
127
|
+
buff.write(_get_struct_7d().pack(_x.pose.position.x, _x.pose.position.y, _x.pose.position.z, _x.pose.orientation.x, _x.pose.orientation.y, _x.pose.orientation.z, _x.pose.orientation.w))
|
|
128
|
+
_x = self.name
|
|
129
|
+
length = len(_x)
|
|
130
|
+
if python3 or type(_x) == unicode:
|
|
131
|
+
_x = _x.encode('utf-8')
|
|
132
|
+
length = len(_x)
|
|
133
|
+
buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
|
|
134
|
+
except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
|
|
135
|
+
except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
|
|
136
|
+
|
|
137
|
+
def deserialize_numpy(self, str, numpy):
|
|
138
|
+
"""
|
|
139
|
+
unpack serialized message in str into this message instance using numpy for array types
|
|
140
|
+
:param str: byte array of serialized message, ``str``
|
|
141
|
+
:param numpy: numpy python module
|
|
142
|
+
"""
|
|
143
|
+
if python3:
|
|
144
|
+
codecs.lookup_error("rosmsg").msg_type = self._type
|
|
145
|
+
try:
|
|
146
|
+
if self.pose is None:
|
|
147
|
+
self.pose = geometry_msgs.msg.Pose()
|
|
148
|
+
end = 0
|
|
149
|
+
_x = self
|
|
150
|
+
start = end
|
|
151
|
+
end += 56
|
|
152
|
+
(_x.pose.position.x, _x.pose.position.y, _x.pose.position.z, _x.pose.orientation.x, _x.pose.orientation.y, _x.pose.orientation.z, _x.pose.orientation.w,) = _get_struct_7d().unpack(str[start:end])
|
|
153
|
+
start = end
|
|
154
|
+
end += 4
|
|
155
|
+
(length,) = _struct_I.unpack(str[start:end])
|
|
156
|
+
start = end
|
|
157
|
+
end += length
|
|
158
|
+
if python3:
|
|
159
|
+
self.name = str[start:end].decode('utf-8', 'rosmsg')
|
|
160
|
+
else:
|
|
161
|
+
self.name = str[start:end]
|
|
162
|
+
return self
|
|
163
|
+
except struct.error as e:
|
|
164
|
+
raise genpy.DeserializationError(e) # most likely buffer underfill
|
|
165
|
+
|
|
166
|
+
_struct_I = genpy.struct_I
|
|
167
|
+
def _get_struct_I():
|
|
168
|
+
global _struct_I
|
|
169
|
+
return _struct_I
|
|
170
|
+
_struct_7d = None
|
|
171
|
+
def _get_struct_7d():
|
|
172
|
+
global _struct_7d
|
|
173
|
+
if _struct_7d is None:
|
|
174
|
+
_struct_7d = struct.Struct("<7d")
|
|
175
|
+
return _struct_7d
|
|
@@ -0,0 +1,62 @@
|
|
|
1
|
+
from ._AprilTagDetection import *
|
|
2
|
+
from ._AprilTagDetectionArray import *
|
|
3
|
+
from ._AudioReceiverData import *
|
|
4
|
+
from ._FTsensorData import *
|
|
5
|
+
from ._JoySticks import *
|
|
6
|
+
from ._Metadata import *
|
|
7
|
+
from ._MmDetectionMsg import *
|
|
8
|
+
from ._RobotActionState import *
|
|
9
|
+
from ._TFArray import *
|
|
10
|
+
from ._TaskPoint import *
|
|
11
|
+
from ._armCollisionCheckInfo import *
|
|
12
|
+
from ._armHandPose import *
|
|
13
|
+
from ._armHandPoseFree import *
|
|
14
|
+
from ._armPoseWithTimeStamp import *
|
|
15
|
+
from ._armTargetPoses import *
|
|
16
|
+
from ._bezierCurveCubicPoint import *
|
|
17
|
+
from ._dexhandCommand import *
|
|
18
|
+
from ._dexhandTouchState import *
|
|
19
|
+
from ._endEffectorData import *
|
|
20
|
+
from ._footPose import *
|
|
21
|
+
from ._footPose6D import *
|
|
22
|
+
from ._footPose6DTargetTrajectories import *
|
|
23
|
+
from ._footPoseTargetTrajectories import *
|
|
24
|
+
from ._footPoseWithVision import *
|
|
25
|
+
from ._footPoseWithVisionArray import *
|
|
26
|
+
from ._footPoses import *
|
|
27
|
+
from ._footPoses6D import *
|
|
28
|
+
from ._fullBodyTargetTrajectories import *
|
|
29
|
+
from ._gaitTimeName import *
|
|
30
|
+
from ._gestureInfo import *
|
|
31
|
+
from ._gestureTask import *
|
|
32
|
+
from ._handPose import *
|
|
33
|
+
from ._headBodyPose import *
|
|
34
|
+
from ._ikSolveError import *
|
|
35
|
+
from ._ikSolveParam import *
|
|
36
|
+
from ._imuData import *
|
|
37
|
+
from ._jointBezierTrajectory import *
|
|
38
|
+
from ._jointCmd import *
|
|
39
|
+
from ._jointData import *
|
|
40
|
+
from ._kuavoModeSchedule import *
|
|
41
|
+
from ._lejuClawCommand import *
|
|
42
|
+
from ._lejuClawState import *
|
|
43
|
+
from ._motorParam import *
|
|
44
|
+
from ._picoPoseInfo import *
|
|
45
|
+
from ._picoPoseInfoList import *
|
|
46
|
+
from ._planArmState import *
|
|
47
|
+
from ._qv import *
|
|
48
|
+
from ._robotArmQVVD import *
|
|
49
|
+
from ._robotBodyMatrices import *
|
|
50
|
+
from ._robotHandPosition import *
|
|
51
|
+
from ._robotHeadMotionData import *
|
|
52
|
+
from ._robotState import *
|
|
53
|
+
from ._sensorsData import *
|
|
54
|
+
from ._switchGaitByName import *
|
|
55
|
+
from ._tagDataArray import *
|
|
56
|
+
from ._touchSensorStatus import *
|
|
57
|
+
from ._twoArmHandPose import *
|
|
58
|
+
from ._twoArmHandPoseCmd import *
|
|
59
|
+
from ._twoArmHandPoseCmdFree import *
|
|
60
|
+
from ._twoArmHandPoseFree import *
|
|
61
|
+
from ._yoloDetection import *
|
|
62
|
+
from ._yoloOutputData import *
|
|
@@ -0,0 +1,160 @@
|
|
|
1
|
+
# This Python file uses the following encoding: utf-8
|
|
2
|
+
"""autogenerated by genpy from kuavo_msgs/armCollisionCheckInfo.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 armCollisionCheckInfo(genpy.Message):
|
|
11
|
+
_md5sum = "3e16b9e5b24ce4c5edc785f54e5f8d73"
|
|
12
|
+
_type = "kuavo_msgs/armCollisionCheckInfo"
|
|
13
|
+
_has_header = False # flag to mark the presence of a Header object
|
|
14
|
+
_full_text = """string link1_name
|
|
15
|
+
string link2_name"""
|
|
16
|
+
__slots__ = ['link1_name','link2_name']
|
|
17
|
+
_slot_types = ['string','string']
|
|
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
|
+
link1_name,link2_name
|
|
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(armCollisionCheckInfo, self).__init__(*args, **kwds)
|
|
35
|
+
# message fields cannot be None, assign default values for those that are
|
|
36
|
+
if self.link1_name is None:
|
|
37
|
+
self.link1_name = ''
|
|
38
|
+
if self.link2_name is None:
|
|
39
|
+
self.link2_name = ''
|
|
40
|
+
else:
|
|
41
|
+
self.link1_name = ''
|
|
42
|
+
self.link2_name = ''
|
|
43
|
+
|
|
44
|
+
def _get_types(self):
|
|
45
|
+
"""
|
|
46
|
+
internal API method
|
|
47
|
+
"""
|
|
48
|
+
return self._slot_types
|
|
49
|
+
|
|
50
|
+
def serialize(self, buff):
|
|
51
|
+
"""
|
|
52
|
+
serialize message into buffer
|
|
53
|
+
:param buff: buffer, ``StringIO``
|
|
54
|
+
"""
|
|
55
|
+
try:
|
|
56
|
+
_x = self.link1_name
|
|
57
|
+
length = len(_x)
|
|
58
|
+
if python3 or type(_x) == unicode:
|
|
59
|
+
_x = _x.encode('utf-8')
|
|
60
|
+
length = len(_x)
|
|
61
|
+
buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
|
|
62
|
+
_x = self.link2_name
|
|
63
|
+
length = len(_x)
|
|
64
|
+
if python3 or type(_x) == unicode:
|
|
65
|
+
_x = _x.encode('utf-8')
|
|
66
|
+
length = len(_x)
|
|
67
|
+
buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
|
|
68
|
+
except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
|
|
69
|
+
except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
|
|
70
|
+
|
|
71
|
+
def deserialize(self, str):
|
|
72
|
+
"""
|
|
73
|
+
unpack serialized message in str into this message instance
|
|
74
|
+
:param str: byte array of serialized message, ``str``
|
|
75
|
+
"""
|
|
76
|
+
if python3:
|
|
77
|
+
codecs.lookup_error("rosmsg").msg_type = self._type
|
|
78
|
+
try:
|
|
79
|
+
end = 0
|
|
80
|
+
start = end
|
|
81
|
+
end += 4
|
|
82
|
+
(length,) = _struct_I.unpack(str[start:end])
|
|
83
|
+
start = end
|
|
84
|
+
end += length
|
|
85
|
+
if python3:
|
|
86
|
+
self.link1_name = str[start:end].decode('utf-8', 'rosmsg')
|
|
87
|
+
else:
|
|
88
|
+
self.link1_name = str[start:end]
|
|
89
|
+
start = end
|
|
90
|
+
end += 4
|
|
91
|
+
(length,) = _struct_I.unpack(str[start:end])
|
|
92
|
+
start = end
|
|
93
|
+
end += length
|
|
94
|
+
if python3:
|
|
95
|
+
self.link2_name = str[start:end].decode('utf-8', 'rosmsg')
|
|
96
|
+
else:
|
|
97
|
+
self.link2_name = str[start:end]
|
|
98
|
+
return self
|
|
99
|
+
except struct.error as e:
|
|
100
|
+
raise genpy.DeserializationError(e) # most likely buffer underfill
|
|
101
|
+
|
|
102
|
+
|
|
103
|
+
def serialize_numpy(self, buff, numpy):
|
|
104
|
+
"""
|
|
105
|
+
serialize message with numpy array types into buffer
|
|
106
|
+
:param buff: buffer, ``StringIO``
|
|
107
|
+
:param numpy: numpy python module
|
|
108
|
+
"""
|
|
109
|
+
try:
|
|
110
|
+
_x = self.link1_name
|
|
111
|
+
length = len(_x)
|
|
112
|
+
if python3 or type(_x) == unicode:
|
|
113
|
+
_x = _x.encode('utf-8')
|
|
114
|
+
length = len(_x)
|
|
115
|
+
buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
|
|
116
|
+
_x = self.link2_name
|
|
117
|
+
length = len(_x)
|
|
118
|
+
if python3 or type(_x) == unicode:
|
|
119
|
+
_x = _x.encode('utf-8')
|
|
120
|
+
length = len(_x)
|
|
121
|
+
buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
|
|
122
|
+
except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
|
|
123
|
+
except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
|
|
124
|
+
|
|
125
|
+
def deserialize_numpy(self, str, numpy):
|
|
126
|
+
"""
|
|
127
|
+
unpack serialized message in str into this message instance using numpy for array types
|
|
128
|
+
:param str: byte array of serialized message, ``str``
|
|
129
|
+
:param numpy: numpy python module
|
|
130
|
+
"""
|
|
131
|
+
if python3:
|
|
132
|
+
codecs.lookup_error("rosmsg").msg_type = self._type
|
|
133
|
+
try:
|
|
134
|
+
end = 0
|
|
135
|
+
start = end
|
|
136
|
+
end += 4
|
|
137
|
+
(length,) = _struct_I.unpack(str[start:end])
|
|
138
|
+
start = end
|
|
139
|
+
end += length
|
|
140
|
+
if python3:
|
|
141
|
+
self.link1_name = str[start:end].decode('utf-8', 'rosmsg')
|
|
142
|
+
else:
|
|
143
|
+
self.link1_name = str[start:end]
|
|
144
|
+
start = end
|
|
145
|
+
end += 4
|
|
146
|
+
(length,) = _struct_I.unpack(str[start:end])
|
|
147
|
+
start = end
|
|
148
|
+
end += length
|
|
149
|
+
if python3:
|
|
150
|
+
self.link2_name = str[start:end].decode('utf-8', 'rosmsg')
|
|
151
|
+
else:
|
|
152
|
+
self.link2_name = str[start:end]
|
|
153
|
+
return self
|
|
154
|
+
except struct.error as e:
|
|
155
|
+
raise genpy.DeserializationError(e) # most likely buffer underfill
|
|
156
|
+
|
|
157
|
+
_struct_I = genpy.struct_I
|
|
158
|
+
def _get_struct_I():
|
|
159
|
+
global _struct_I
|
|
160
|
+
return _struct_I
|
|
@@ -0,0 +1,161 @@
|
|
|
1
|
+
# This Python file uses the following encoding: utf-8
|
|
2
|
+
"""autogenerated by genpy from kuavo_msgs/armHandPose.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 armHandPose(genpy.Message):
|
|
11
|
+
_md5sum = "4f28a253cb60d59c6491569369f38f4d"
|
|
12
|
+
_type = "kuavo_msgs/armHandPose"
|
|
13
|
+
_has_header = False # flag to mark the presence of a Header object
|
|
14
|
+
_full_text = """float64[3] pos_xyz
|
|
15
|
+
float64[4] quat_xyzw
|
|
16
|
+
|
|
17
|
+
float64[3] elbow_pos_xyz
|
|
18
|
+
|
|
19
|
+
float64[7] joint_angles
|
|
20
|
+
"""
|
|
21
|
+
__slots__ = ['pos_xyz','quat_xyzw','elbow_pos_xyz','joint_angles']
|
|
22
|
+
_slot_types = ['float64[3]','float64[4]','float64[3]','float64[7]']
|
|
23
|
+
|
|
24
|
+
def __init__(self, *args, **kwds):
|
|
25
|
+
"""
|
|
26
|
+
Constructor. Any message fields that are implicitly/explicitly
|
|
27
|
+
set to None will be assigned a default value. The recommend
|
|
28
|
+
use is keyword arguments as this is more robust to future message
|
|
29
|
+
changes. You cannot mix in-order arguments and keyword arguments.
|
|
30
|
+
|
|
31
|
+
The available fields are:
|
|
32
|
+
pos_xyz,quat_xyzw,elbow_pos_xyz,joint_angles
|
|
33
|
+
|
|
34
|
+
:param args: complete set of field values, in .msg order
|
|
35
|
+
:param kwds: use keyword arguments corresponding to message field names
|
|
36
|
+
to set specific fields.
|
|
37
|
+
"""
|
|
38
|
+
if args or kwds:
|
|
39
|
+
super(armHandPose, self).__init__(*args, **kwds)
|
|
40
|
+
# message fields cannot be None, assign default values for those that are
|
|
41
|
+
if self.pos_xyz is None:
|
|
42
|
+
self.pos_xyz = [0.] * 3
|
|
43
|
+
if self.quat_xyzw is None:
|
|
44
|
+
self.quat_xyzw = [0.] * 4
|
|
45
|
+
if self.elbow_pos_xyz is None:
|
|
46
|
+
self.elbow_pos_xyz = [0.] * 3
|
|
47
|
+
if self.joint_angles is None:
|
|
48
|
+
self.joint_angles = [0.] * 7
|
|
49
|
+
else:
|
|
50
|
+
self.pos_xyz = [0.] * 3
|
|
51
|
+
self.quat_xyzw = [0.] * 4
|
|
52
|
+
self.elbow_pos_xyz = [0.] * 3
|
|
53
|
+
self.joint_angles = [0.] * 7
|
|
54
|
+
|
|
55
|
+
def _get_types(self):
|
|
56
|
+
"""
|
|
57
|
+
internal API method
|
|
58
|
+
"""
|
|
59
|
+
return self._slot_types
|
|
60
|
+
|
|
61
|
+
def serialize(self, buff):
|
|
62
|
+
"""
|
|
63
|
+
serialize message into buffer
|
|
64
|
+
:param buff: buffer, ``StringIO``
|
|
65
|
+
"""
|
|
66
|
+
try:
|
|
67
|
+
buff.write(_get_struct_3d().pack(*self.pos_xyz))
|
|
68
|
+
buff.write(_get_struct_4d().pack(*self.quat_xyzw))
|
|
69
|
+
buff.write(_get_struct_3d().pack(*self.elbow_pos_xyz))
|
|
70
|
+
buff.write(_get_struct_7d().pack(*self.joint_angles))
|
|
71
|
+
except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
|
|
72
|
+
except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
|
|
73
|
+
|
|
74
|
+
def deserialize(self, str):
|
|
75
|
+
"""
|
|
76
|
+
unpack serialized message in str into this message instance
|
|
77
|
+
:param str: byte array of serialized message, ``str``
|
|
78
|
+
"""
|
|
79
|
+
if python3:
|
|
80
|
+
codecs.lookup_error("rosmsg").msg_type = self._type
|
|
81
|
+
try:
|
|
82
|
+
end = 0
|
|
83
|
+
start = end
|
|
84
|
+
end += 24
|
|
85
|
+
self.pos_xyz = _get_struct_3d().unpack(str[start:end])
|
|
86
|
+
start = end
|
|
87
|
+
end += 32
|
|
88
|
+
self.quat_xyzw = _get_struct_4d().unpack(str[start:end])
|
|
89
|
+
start = end
|
|
90
|
+
end += 24
|
|
91
|
+
self.elbow_pos_xyz = _get_struct_3d().unpack(str[start:end])
|
|
92
|
+
start = end
|
|
93
|
+
end += 56
|
|
94
|
+
self.joint_angles = _get_struct_7d().unpack(str[start:end])
|
|
95
|
+
return self
|
|
96
|
+
except struct.error as e:
|
|
97
|
+
raise genpy.DeserializationError(e) # most likely buffer underfill
|
|
98
|
+
|
|
99
|
+
|
|
100
|
+
def serialize_numpy(self, buff, numpy):
|
|
101
|
+
"""
|
|
102
|
+
serialize message with numpy array types into buffer
|
|
103
|
+
:param buff: buffer, ``StringIO``
|
|
104
|
+
:param numpy: numpy python module
|
|
105
|
+
"""
|
|
106
|
+
try:
|
|
107
|
+
buff.write(self.pos_xyz.tostring())
|
|
108
|
+
buff.write(self.quat_xyzw.tostring())
|
|
109
|
+
buff.write(self.elbow_pos_xyz.tostring())
|
|
110
|
+
buff.write(self.joint_angles.tostring())
|
|
111
|
+
except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
|
|
112
|
+
except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
|
|
113
|
+
|
|
114
|
+
def deserialize_numpy(self, str, numpy):
|
|
115
|
+
"""
|
|
116
|
+
unpack serialized message in str into this message instance using numpy for array types
|
|
117
|
+
:param str: byte array of serialized message, ``str``
|
|
118
|
+
:param numpy: numpy python module
|
|
119
|
+
"""
|
|
120
|
+
if python3:
|
|
121
|
+
codecs.lookup_error("rosmsg").msg_type = self._type
|
|
122
|
+
try:
|
|
123
|
+
end = 0
|
|
124
|
+
start = end
|
|
125
|
+
end += 24
|
|
126
|
+
self.pos_xyz = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=3)
|
|
127
|
+
start = end
|
|
128
|
+
end += 32
|
|
129
|
+
self.quat_xyzw = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=4)
|
|
130
|
+
start = end
|
|
131
|
+
end += 24
|
|
132
|
+
self.elbow_pos_xyz = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=3)
|
|
133
|
+
start = end
|
|
134
|
+
end += 56
|
|
135
|
+
self.joint_angles = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=7)
|
|
136
|
+
return self
|
|
137
|
+
except struct.error as e:
|
|
138
|
+
raise genpy.DeserializationError(e) # most likely buffer underfill
|
|
139
|
+
|
|
140
|
+
_struct_I = genpy.struct_I
|
|
141
|
+
def _get_struct_I():
|
|
142
|
+
global _struct_I
|
|
143
|
+
return _struct_I
|
|
144
|
+
_struct_3d = None
|
|
145
|
+
def _get_struct_3d():
|
|
146
|
+
global _struct_3d
|
|
147
|
+
if _struct_3d is None:
|
|
148
|
+
_struct_3d = struct.Struct("<3d")
|
|
149
|
+
return _struct_3d
|
|
150
|
+
_struct_4d = None
|
|
151
|
+
def _get_struct_4d():
|
|
152
|
+
global _struct_4d
|
|
153
|
+
if _struct_4d is None:
|
|
154
|
+
_struct_4d = struct.Struct("<4d")
|
|
155
|
+
return _struct_4d
|
|
156
|
+
_struct_7d = None
|
|
157
|
+
def _get_struct_7d():
|
|
158
|
+
global _struct_7d
|
|
159
|
+
if _struct_7d is None:
|
|
160
|
+
_struct_7d = struct.Struct("<7d")
|
|
161
|
+
return _struct_7d
|