kuavo-humanoid-sdk 1.2.1b3269__20250911204115-py3-none-any.whl

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

Potentially problematic release.


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

Files changed (184) hide show
  1. kuavo_humanoid_sdk/__init__.py +6 -0
  2. kuavo_humanoid_sdk/common/logger.py +45 -0
  3. kuavo_humanoid_sdk/interfaces/__init__.py +4 -0
  4. kuavo_humanoid_sdk/interfaces/data_types.py +288 -0
  5. kuavo_humanoid_sdk/interfaces/end_effector.py +62 -0
  6. kuavo_humanoid_sdk/interfaces/robot.py +22 -0
  7. kuavo_humanoid_sdk/interfaces/robot_info.py +56 -0
  8. kuavo_humanoid_sdk/kuavo/__init__.py +16 -0
  9. kuavo_humanoid_sdk/kuavo/core/audio.py +32 -0
  10. kuavo_humanoid_sdk/kuavo/core/core.py +666 -0
  11. kuavo_humanoid_sdk/kuavo/core/dex_hand_control.py +114 -0
  12. kuavo_humanoid_sdk/kuavo/core/leju_claw_control.py +67 -0
  13. kuavo_humanoid_sdk/kuavo/core/llm_doubao.py +608 -0
  14. kuavo_humanoid_sdk/kuavo/core/microphone.py +192 -0
  15. kuavo_humanoid_sdk/kuavo/core/navigation.py +70 -0
  16. kuavo_humanoid_sdk/kuavo/core/ros/audio.py +110 -0
  17. kuavo_humanoid_sdk/kuavo/core/ros/control.py +1524 -0
  18. kuavo_humanoid_sdk/kuavo/core/ros/microphone.py +38 -0
  19. kuavo_humanoid_sdk/kuavo/core/ros/navigation.py +217 -0
  20. kuavo_humanoid_sdk/kuavo/core/ros/observation.py +94 -0
  21. kuavo_humanoid_sdk/kuavo/core/ros/param.py +201 -0
  22. kuavo_humanoid_sdk/kuavo/core/ros/sat_utils.py +103 -0
  23. kuavo_humanoid_sdk/kuavo/core/ros/state.py +652 -0
  24. kuavo_humanoid_sdk/kuavo/core/ros/tools.py +220 -0
  25. kuavo_humanoid_sdk/kuavo/core/ros/vision.py +234 -0
  26. kuavo_humanoid_sdk/kuavo/core/ros_env.py +238 -0
  27. kuavo_humanoid_sdk/kuavo/demo_climbstair.py +249 -0
  28. kuavo_humanoid_sdk/kuavo/dexterous_hand.py +238 -0
  29. kuavo_humanoid_sdk/kuavo/leju_claw.py +235 -0
  30. kuavo_humanoid_sdk/kuavo/logger_client.py +80 -0
  31. kuavo_humanoid_sdk/kuavo/robot.py +561 -0
  32. kuavo_humanoid_sdk/kuavo/robot_arm.py +299 -0
  33. kuavo_humanoid_sdk/kuavo/robot_audio.py +39 -0
  34. kuavo_humanoid_sdk/kuavo/robot_blockly.py +1162 -0
  35. kuavo_humanoid_sdk/kuavo/robot_climbstair.py +1607 -0
  36. kuavo_humanoid_sdk/kuavo/robot_head.py +74 -0
  37. kuavo_humanoid_sdk/kuavo/robot_info.py +134 -0
  38. kuavo_humanoid_sdk/kuavo/robot_microphone.py +19 -0
  39. kuavo_humanoid_sdk/kuavo/robot_navigation.py +135 -0
  40. kuavo_humanoid_sdk/kuavo/robot_observation.py +64 -0
  41. kuavo_humanoid_sdk/kuavo/robot_speech.py +24 -0
  42. kuavo_humanoid_sdk/kuavo/robot_state.py +310 -0
  43. kuavo_humanoid_sdk/kuavo/robot_tool.py +109 -0
  44. kuavo_humanoid_sdk/kuavo/robot_vision.py +81 -0
  45. kuavo_humanoid_sdk/kuavo_strategy/__init__.py +2 -0
  46. kuavo_humanoid_sdk/kuavo_strategy/grasp_box/grasp_box_strategy.py +1325 -0
  47. kuavo_humanoid_sdk/kuavo_strategy/kuavo_strategy.py +106 -0
  48. kuavo_humanoid_sdk/kuavo_strategy_v2/common/data_type.py +340 -0
  49. kuavo_humanoid_sdk/kuavo_strategy_v2/common/events/base_event.py +215 -0
  50. kuavo_humanoid_sdk/kuavo_strategy_v2/common/robot_sdk.py +25 -0
  51. kuavo_humanoid_sdk/kuavo_strategy_v2/pick_place_box/case.py +331 -0
  52. kuavo_humanoid_sdk/kuavo_strategy_v2/pick_place_box/strategy.py +504 -0
  53. kuavo_humanoid_sdk/kuavo_strategy_v2/utils/logger_setup.py +40 -0
  54. kuavo_humanoid_sdk/kuavo_strategy_v2/utils/utils.py +88 -0
  55. kuavo_humanoid_sdk/msg/__init__.py +4 -0
  56. kuavo_humanoid_sdk/msg/kuavo_msgs/__init__.py +7 -0
  57. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_AprilTagDetection.py +306 -0
  58. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_AprilTagDetectionArray.py +437 -0
  59. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_AudioReceiverData.py +122 -0
  60. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_FTsensorData.py +260 -0
  61. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_JoySticks.py +191 -0
  62. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_Metadata.py +199 -0
  63. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_MmDetectionMsg.py +264 -0
  64. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_RobotActionState.py +112 -0
  65. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_TFArray.py +323 -0
  66. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_TaskPoint.py +175 -0
  67. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/__init__.py +62 -0
  68. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_armCollisionCheckInfo.py +160 -0
  69. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_armHandPose.py +161 -0
  70. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_armHandPoseFree.py +171 -0
  71. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_armPoseWithTimeStamp.py +168 -0
  72. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_armTargetPoses.py +171 -0
  73. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_bezierCurveCubicPoint.py +178 -0
  74. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_dexhandCommand.py +229 -0
  75. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_dexhandTouchState.py +256 -0
  76. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_endEffectorData.py +227 -0
  77. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPose.py +123 -0
  78. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPose6D.py +123 -0
  79. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPose6DTargetTrajectories.py +320 -0
  80. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPoseTargetTrajectories.py +301 -0
  81. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPoseWithVision.py +136 -0
  82. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPoseWithVisionArray.py +231 -0
  83. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPoses.py +149 -0
  84. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPoses6D.py +149 -0
  85. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_fullBodyTargetTrajectories.py +258 -0
  86. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_gaitTimeName.py +147 -0
  87. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_gestureInfo.py +218 -0
  88. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_gestureTask.py +149 -0
  89. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_handPose.py +136 -0
  90. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_headBodyPose.py +145 -0
  91. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_ikSolveError.py +171 -0
  92. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_ikSolveParam.py +140 -0
  93. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_imuData.py +165 -0
  94. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_jointBezierTrajectory.py +201 -0
  95. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_jointCmd.py +390 -0
  96. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_jointData.py +205 -0
  97. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_kuavoModeSchedule.py +224 -0
  98. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_lejuClawCommand.py +320 -0
  99. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_lejuClawState.py +341 -0
  100. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_motorParam.py +122 -0
  101. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_picoPoseInfo.py +143 -0
  102. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_picoPoseInfoList.py +220 -0
  103. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_planArmState.py +120 -0
  104. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_qv.py +121 -0
  105. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_robotArmQVVD.py +177 -0
  106. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_robotBodyMatrices.py +332 -0
  107. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_robotHandPosition.py +225 -0
  108. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_robotHeadMotionData.py +128 -0
  109. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_robotState.py +222 -0
  110. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_sensorsData.py +655 -0
  111. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_switchGaitByName.py +200 -0
  112. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_tagDataArray.py +216 -0
  113. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_touchSensorStatus.py +162 -0
  114. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_twoArmHandPose.py +273 -0
  115. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_twoArmHandPoseCmd.py +316 -0
  116. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_twoArmHandPoseCmdFree.py +338 -0
  117. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_twoArmHandPoseFree.py +299 -0
  118. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_yoloDetection.py +251 -0
  119. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_yoloOutputData.py +168 -0
  120. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_CreatePath.py +581 -0
  121. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_ExecuteArmAction.py +281 -0
  122. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_GetAllMaps.py +241 -0
  123. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_GetCurrentMap.py +225 -0
  124. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_GetTargetPartPoseInCamera.py +298 -0
  125. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_InitialPoseWithTaskPoint.py +281 -0
  126. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_LoadMap.py +281 -0
  127. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_NavigateToTaskPoint.py +281 -0
  128. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_RepublishTFs.py +373 -0
  129. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_SetInitialPose.py +394 -0
  130. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_SetJoyTopic.py +282 -0
  131. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_SetLEDMode.py +468 -0
  132. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_SetLEDMode_free.py +289 -0
  133. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_SpeechSynthesis.py +270 -0
  134. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_TaskPointOperation.py +536 -0
  135. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/__init__.py +43 -0
  136. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_adjustZeroPoint.py +277 -0
  137. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_changeArmCtrlMode.py +275 -0
  138. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_changeArmCtrlModeKuavo.py +236 -0
  139. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_changeMotorParam.py +299 -0
  140. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_changeTorsoCtrlMode.py +274 -0
  141. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_controlLejuClaw.py +408 -0
  142. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_enableHandTouchSensor.py +304 -0
  143. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_fkSrv.py +395 -0
  144. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_footPose6DTargetTrajectoriesSrv.py +426 -0
  145. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_footPoseTargetTrajectoriesSrv.py +409 -0
  146. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_gestureExecute.py +339 -0
  147. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_gestureExecuteState.py +257 -0
  148. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_gestureList.py +418 -0
  149. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_getCurrentGaitName.py +253 -0
  150. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_getMotorParam.py +299 -0
  151. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_getMotorZeroPoints.py +286 -0
  152. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_handForceLevel.py +330 -0
  153. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_jointMoveTo.py +302 -0
  154. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_planArmTrajectoryBezierCurve.py +422 -0
  155. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_planArmTrajectoryCubicSpline.py +490 -0
  156. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_playmusic.py +268 -0
  157. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_setHwIntialState.py +304 -0
  158. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_setMmCtrlFrame.py +273 -0
  159. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_setMotorEncoderRoundService.py +283 -0
  160. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_setTagId.py +275 -0
  161. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_singleStepControl.py +444 -0
  162. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_twoArmHandPoseCmdFreeSrv.py +716 -0
  163. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_twoArmHandPoseCmdSrv.py +664 -0
  164. kuavo_humanoid_sdk/msg/motion_capture_ik/__init__.py +7 -0
  165. kuavo_humanoid_sdk/msg/ocs2_msgs/__init__.py +7 -0
  166. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/__init__.py +12 -0
  167. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_constraint.py +142 -0
  168. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_controller_data.py +121 -0
  169. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_lagrangian_metrics.py +148 -0
  170. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mode_schedule.py +150 -0
  171. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_flattened_controller.py +666 -0
  172. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_input.py +122 -0
  173. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_observation.py +209 -0
  174. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_performance_indices.py +140 -0
  175. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_solver_data.py +886 -0
  176. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_state.py +122 -0
  177. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_target_trajectories.py +239 -0
  178. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_multiplier.py +148 -0
  179. kuavo_humanoid_sdk/msg/ocs2_msgs/srv/__init__.py +1 -0
  180. kuavo_humanoid_sdk/msg/ocs2_msgs/srv/_reset.py +376 -0
  181. kuavo_humanoid_sdk-1.2.1b3269.dist-info/METADATA +296 -0
  182. kuavo_humanoid_sdk-1.2.1b3269.dist-info/RECORD +184 -0
  183. kuavo_humanoid_sdk-1.2.1b3269.dist-info/WHEEL +6 -0
  184. kuavo_humanoid_sdk-1.2.1b3269.dist-info/top_level.txt +1 -0
@@ -0,0 +1,224 @@
1
+ # This Python file uses the following encoding: utf-8
2
+ """autogenerated by genpy from kuavo_msgs/kuavoModeSchedule.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 kuavo_msgs.msg
10
+
11
+ class kuavoModeSchedule(genpy.Message):
12
+ _md5sum = "3a05d2a24adeeaae6461a9cca85c3ce9"
13
+ _type = "kuavo_msgs/kuavoModeSchedule"
14
+ _has_header = False # flag to mark the presence of a Header object
15
+ _full_text = """float64 currentTime
16
+ footPose6D[] footPoseSequence
17
+ float64[] eventTimes
18
+ float64[] modeSequence
19
+ ================================================================================
20
+ MSG: kuavo_msgs/footPose6D
21
+ float64[6] footPose6D # x, y, z, yaw
22
+ float64[6] torsoPose6D # x, y, z, yaw
23
+ """
24
+ __slots__ = ['currentTime','footPoseSequence','eventTimes','modeSequence']
25
+ _slot_types = ['float64','kuavo_msgs/footPose6D[]','float64[]','float64[]']
26
+
27
+ def __init__(self, *args, **kwds):
28
+ """
29
+ Constructor. Any message fields that are implicitly/explicitly
30
+ set to None will be assigned a default value. The recommend
31
+ use is keyword arguments as this is more robust to future message
32
+ changes. You cannot mix in-order arguments and keyword arguments.
33
+
34
+ The available fields are:
35
+ currentTime,footPoseSequence,eventTimes,modeSequence
36
+
37
+ :param args: complete set of field values, in .msg order
38
+ :param kwds: use keyword arguments corresponding to message field names
39
+ to set specific fields.
40
+ """
41
+ if args or kwds:
42
+ super(kuavoModeSchedule, self).__init__(*args, **kwds)
43
+ # message fields cannot be None, assign default values for those that are
44
+ if self.currentTime is None:
45
+ self.currentTime = 0.
46
+ if self.footPoseSequence is None:
47
+ self.footPoseSequence = []
48
+ if self.eventTimes is None:
49
+ self.eventTimes = []
50
+ if self.modeSequence is None:
51
+ self.modeSequence = []
52
+ else:
53
+ self.currentTime = 0.
54
+ self.footPoseSequence = []
55
+ self.eventTimes = []
56
+ self.modeSequence = []
57
+
58
+ def _get_types(self):
59
+ """
60
+ internal API method
61
+ """
62
+ return self._slot_types
63
+
64
+ def serialize(self, buff):
65
+ """
66
+ serialize message into buffer
67
+ :param buff: buffer, ``StringIO``
68
+ """
69
+ try:
70
+ _x = self.currentTime
71
+ buff.write(_get_struct_d().pack(_x))
72
+ length = len(self.footPoseSequence)
73
+ buff.write(_struct_I.pack(length))
74
+ for val1 in self.footPoseSequence:
75
+ buff.write(_get_struct_6d().pack(*val1.footPose6D))
76
+ buff.write(_get_struct_6d().pack(*val1.torsoPose6D))
77
+ length = len(self.eventTimes)
78
+ buff.write(_struct_I.pack(length))
79
+ pattern = '<%sd'%length
80
+ buff.write(struct.Struct(pattern).pack(*self.eventTimes))
81
+ length = len(self.modeSequence)
82
+ buff.write(_struct_I.pack(length))
83
+ pattern = '<%sd'%length
84
+ buff.write(struct.Struct(pattern).pack(*self.modeSequence))
85
+ except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
86
+ except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
87
+
88
+ def deserialize(self, str):
89
+ """
90
+ unpack serialized message in str into this message instance
91
+ :param str: byte array of serialized message, ``str``
92
+ """
93
+ if python3:
94
+ codecs.lookup_error("rosmsg").msg_type = self._type
95
+ try:
96
+ if self.footPoseSequence is None:
97
+ self.footPoseSequence = None
98
+ end = 0
99
+ start = end
100
+ end += 8
101
+ (self.currentTime,) = _get_struct_d().unpack(str[start:end])
102
+ start = end
103
+ end += 4
104
+ (length,) = _struct_I.unpack(str[start:end])
105
+ self.footPoseSequence = []
106
+ for i in range(0, length):
107
+ val1 = kuavo_msgs.msg.footPose6D()
108
+ start = end
109
+ end += 48
110
+ val1.footPose6D = _get_struct_6d().unpack(str[start:end])
111
+ start = end
112
+ end += 48
113
+ val1.torsoPose6D = _get_struct_6d().unpack(str[start:end])
114
+ self.footPoseSequence.append(val1)
115
+ start = end
116
+ end += 4
117
+ (length,) = _struct_I.unpack(str[start:end])
118
+ pattern = '<%sd'%length
119
+ start = end
120
+ s = struct.Struct(pattern)
121
+ end += s.size
122
+ self.eventTimes = s.unpack(str[start:end])
123
+ start = end
124
+ end += 4
125
+ (length,) = _struct_I.unpack(str[start:end])
126
+ pattern = '<%sd'%length
127
+ start = end
128
+ s = struct.Struct(pattern)
129
+ end += s.size
130
+ self.modeSequence = s.unpack(str[start:end])
131
+ return self
132
+ except struct.error as e:
133
+ raise genpy.DeserializationError(e) # most likely buffer underfill
134
+
135
+
136
+ def serialize_numpy(self, buff, numpy):
137
+ """
138
+ serialize message with numpy array types into buffer
139
+ :param buff: buffer, ``StringIO``
140
+ :param numpy: numpy python module
141
+ """
142
+ try:
143
+ _x = self.currentTime
144
+ buff.write(_get_struct_d().pack(_x))
145
+ length = len(self.footPoseSequence)
146
+ buff.write(_struct_I.pack(length))
147
+ for val1 in self.footPoseSequence:
148
+ buff.write(val1.footPose6D.tostring())
149
+ buff.write(val1.torsoPose6D.tostring())
150
+ length = len(self.eventTimes)
151
+ buff.write(_struct_I.pack(length))
152
+ pattern = '<%sd'%length
153
+ buff.write(self.eventTimes.tostring())
154
+ length = len(self.modeSequence)
155
+ buff.write(_struct_I.pack(length))
156
+ pattern = '<%sd'%length
157
+ buff.write(self.modeSequence.tostring())
158
+ except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
159
+ except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
160
+
161
+ def deserialize_numpy(self, str, numpy):
162
+ """
163
+ unpack serialized message in str into this message instance using numpy for array types
164
+ :param str: byte array of serialized message, ``str``
165
+ :param numpy: numpy python module
166
+ """
167
+ if python3:
168
+ codecs.lookup_error("rosmsg").msg_type = self._type
169
+ try:
170
+ if self.footPoseSequence is None:
171
+ self.footPoseSequence = None
172
+ end = 0
173
+ start = end
174
+ end += 8
175
+ (self.currentTime,) = _get_struct_d().unpack(str[start:end])
176
+ start = end
177
+ end += 4
178
+ (length,) = _struct_I.unpack(str[start:end])
179
+ self.footPoseSequence = []
180
+ for i in range(0, length):
181
+ val1 = kuavo_msgs.msg.footPose6D()
182
+ start = end
183
+ end += 48
184
+ val1.footPose6D = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=6)
185
+ start = end
186
+ end += 48
187
+ val1.torsoPose6D = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=6)
188
+ self.footPoseSequence.append(val1)
189
+ start = end
190
+ end += 4
191
+ (length,) = _struct_I.unpack(str[start:end])
192
+ pattern = '<%sd'%length
193
+ start = end
194
+ s = struct.Struct(pattern)
195
+ end += s.size
196
+ self.eventTimes = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length)
197
+ start = end
198
+ end += 4
199
+ (length,) = _struct_I.unpack(str[start:end])
200
+ pattern = '<%sd'%length
201
+ start = end
202
+ s = struct.Struct(pattern)
203
+ end += s.size
204
+ self.modeSequence = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length)
205
+ return self
206
+ except struct.error as e:
207
+ raise genpy.DeserializationError(e) # most likely buffer underfill
208
+
209
+ _struct_I = genpy.struct_I
210
+ def _get_struct_I():
211
+ global _struct_I
212
+ return _struct_I
213
+ _struct_6d = None
214
+ def _get_struct_6d():
215
+ global _struct_6d
216
+ if _struct_6d is None:
217
+ _struct_6d = struct.Struct("<6d")
218
+ return _struct_6d
219
+ _struct_d = None
220
+ def _get_struct_d():
221
+ global _struct_d
222
+ if _struct_d is None:
223
+ _struct_d = struct.Struct("<d")
224
+ return _struct_d
@@ -0,0 +1,320 @@
1
+ # This Python file uses the following encoding: utf-8
2
+ """autogenerated by genpy from kuavo_msgs/lejuClawCommand.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 kuavo_msgs.msg
10
+ import std_msgs.msg
11
+
12
+ class lejuClawCommand(genpy.Message):
13
+ _md5sum = "57c40e80f90e7a289ae0b2488552e043"
14
+ _type = "kuavo_msgs/lejuClawCommand"
15
+ _has_header = True # flag to mark the presence of a Header object
16
+ _full_text = """# kuavo_msgs/endEffectorData:
17
+ # string[] name
18
+ # float64[] position
19
+ # float64[] velocity
20
+ # float64[] effort
21
+ #
22
+ # ** For the Topic Notes **
23
+ #
24
+ # name : 'left_claw' , 'right_claw'
25
+ # position : 0 ~ 100, the percentage of the claw's opening angle
26
+ # 0: closed, 100: open
27
+ # velocity : 0 ~ 100, if size is 0, will use default `50.0`.
28
+ # effort : torque/current, better 1A ~ 2A, if size is 0, will use default `1.0`.
29
+ #
30
+ # ** Example **
31
+ # data:
32
+ # - name: ['left_claw', 'right_claw']
33
+ # position: [20.0, 20.0]
34
+ # velocity: [50.0, 50.0]
35
+ # effort: [1.0, 1.0]
36
+
37
+ std_msgs/Header header
38
+ kuavo_msgs/endEffectorData data
39
+ ================================================================================
40
+ MSG: std_msgs/Header
41
+ # Standard metadata for higher-level stamped data types.
42
+ # This is generally used to communicate timestamped data
43
+ # in a particular coordinate frame.
44
+ #
45
+ # sequence ID: consecutively increasing ID
46
+ uint32 seq
47
+ #Two-integer timestamp that is expressed as:
48
+ # * stamp.sec: seconds (stamp_secs) since epoch (in Python the variable is called 'secs')
49
+ # * stamp.nsec: nanoseconds since stamp_secs (in Python the variable is called 'nsecs')
50
+ # time-handling sugar is provided by the client library
51
+ time stamp
52
+ #Frame this data is associated with
53
+ string frame_id
54
+
55
+ ================================================================================
56
+ MSG: kuavo_msgs/endEffectorData
57
+ string[] name
58
+ float64[] position
59
+ float64[] velocity
60
+ float64[] effort
61
+ """
62
+ __slots__ = ['header','data']
63
+ _slot_types = ['std_msgs/Header','kuavo_msgs/endEffectorData']
64
+
65
+ def __init__(self, *args, **kwds):
66
+ """
67
+ Constructor. Any message fields that are implicitly/explicitly
68
+ set to None will be assigned a default value. The recommend
69
+ use is keyword arguments as this is more robust to future message
70
+ changes. You cannot mix in-order arguments and keyword arguments.
71
+
72
+ The available fields are:
73
+ header,data
74
+
75
+ :param args: complete set of field values, in .msg order
76
+ :param kwds: use keyword arguments corresponding to message field names
77
+ to set specific fields.
78
+ """
79
+ if args or kwds:
80
+ super(lejuClawCommand, self).__init__(*args, **kwds)
81
+ # message fields cannot be None, assign default values for those that are
82
+ if self.header is None:
83
+ self.header = std_msgs.msg.Header()
84
+ if self.data is None:
85
+ self.data = kuavo_msgs.msg.endEffectorData()
86
+ else:
87
+ self.header = std_msgs.msg.Header()
88
+ self.data = kuavo_msgs.msg.endEffectorData()
89
+
90
+ def _get_types(self):
91
+ """
92
+ internal API method
93
+ """
94
+ return self._slot_types
95
+
96
+ def serialize(self, buff):
97
+ """
98
+ serialize message into buffer
99
+ :param buff: buffer, ``StringIO``
100
+ """
101
+ try:
102
+ _x = self
103
+ buff.write(_get_struct_3I().pack(_x.header.seq, _x.header.stamp.secs, _x.header.stamp.nsecs))
104
+ _x = self.header.frame_id
105
+ length = len(_x)
106
+ if python3 or type(_x) == unicode:
107
+ _x = _x.encode('utf-8')
108
+ length = len(_x)
109
+ buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
110
+ length = len(self.data.name)
111
+ buff.write(_struct_I.pack(length))
112
+ for val1 in self.data.name:
113
+ length = len(val1)
114
+ if python3 or type(val1) == unicode:
115
+ val1 = val1.encode('utf-8')
116
+ length = len(val1)
117
+ buff.write(struct.Struct('<I%ss'%length).pack(length, val1))
118
+ length = len(self.data.position)
119
+ buff.write(_struct_I.pack(length))
120
+ pattern = '<%sd'%length
121
+ buff.write(struct.Struct(pattern).pack(*self.data.position))
122
+ length = len(self.data.velocity)
123
+ buff.write(_struct_I.pack(length))
124
+ pattern = '<%sd'%length
125
+ buff.write(struct.Struct(pattern).pack(*self.data.velocity))
126
+ length = len(self.data.effort)
127
+ buff.write(_struct_I.pack(length))
128
+ pattern = '<%sd'%length
129
+ buff.write(struct.Struct(pattern).pack(*self.data.effort))
130
+ except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
131
+ except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
132
+
133
+ def deserialize(self, str):
134
+ """
135
+ unpack serialized message in str into this message instance
136
+ :param str: byte array of serialized message, ``str``
137
+ """
138
+ if python3:
139
+ codecs.lookup_error("rosmsg").msg_type = self._type
140
+ try:
141
+ if self.header is None:
142
+ self.header = std_msgs.msg.Header()
143
+ if self.data is None:
144
+ self.data = kuavo_msgs.msg.endEffectorData()
145
+ end = 0
146
+ _x = self
147
+ start = end
148
+ end += 12
149
+ (_x.header.seq, _x.header.stamp.secs, _x.header.stamp.nsecs,) = _get_struct_3I().unpack(str[start:end])
150
+ start = end
151
+ end += 4
152
+ (length,) = _struct_I.unpack(str[start:end])
153
+ start = end
154
+ end += length
155
+ if python3:
156
+ self.header.frame_id = str[start:end].decode('utf-8', 'rosmsg')
157
+ else:
158
+ self.header.frame_id = str[start:end]
159
+ start = end
160
+ end += 4
161
+ (length,) = _struct_I.unpack(str[start:end])
162
+ self.data.name = []
163
+ for i in range(0, length):
164
+ start = end
165
+ end += 4
166
+ (length,) = _struct_I.unpack(str[start:end])
167
+ start = end
168
+ end += length
169
+ if python3:
170
+ val1 = str[start:end].decode('utf-8', 'rosmsg')
171
+ else:
172
+ val1 = str[start:end]
173
+ self.data.name.append(val1)
174
+ start = end
175
+ end += 4
176
+ (length,) = _struct_I.unpack(str[start:end])
177
+ pattern = '<%sd'%length
178
+ start = end
179
+ s = struct.Struct(pattern)
180
+ end += s.size
181
+ self.data.position = s.unpack(str[start:end])
182
+ start = end
183
+ end += 4
184
+ (length,) = _struct_I.unpack(str[start:end])
185
+ pattern = '<%sd'%length
186
+ start = end
187
+ s = struct.Struct(pattern)
188
+ end += s.size
189
+ self.data.velocity = s.unpack(str[start:end])
190
+ start = end
191
+ end += 4
192
+ (length,) = _struct_I.unpack(str[start:end])
193
+ pattern = '<%sd'%length
194
+ start = end
195
+ s = struct.Struct(pattern)
196
+ end += s.size
197
+ self.data.effort = s.unpack(str[start:end])
198
+ return self
199
+ except struct.error as e:
200
+ raise genpy.DeserializationError(e) # most likely buffer underfill
201
+
202
+
203
+ def serialize_numpy(self, buff, numpy):
204
+ """
205
+ serialize message with numpy array types into buffer
206
+ :param buff: buffer, ``StringIO``
207
+ :param numpy: numpy python module
208
+ """
209
+ try:
210
+ _x = self
211
+ buff.write(_get_struct_3I().pack(_x.header.seq, _x.header.stamp.secs, _x.header.stamp.nsecs))
212
+ _x = self.header.frame_id
213
+ length = len(_x)
214
+ if python3 or type(_x) == unicode:
215
+ _x = _x.encode('utf-8')
216
+ length = len(_x)
217
+ buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
218
+ length = len(self.data.name)
219
+ buff.write(_struct_I.pack(length))
220
+ for val1 in self.data.name:
221
+ length = len(val1)
222
+ if python3 or type(val1) == unicode:
223
+ val1 = val1.encode('utf-8')
224
+ length = len(val1)
225
+ buff.write(struct.Struct('<I%ss'%length).pack(length, val1))
226
+ length = len(self.data.position)
227
+ buff.write(_struct_I.pack(length))
228
+ pattern = '<%sd'%length
229
+ buff.write(self.data.position.tostring())
230
+ length = len(self.data.velocity)
231
+ buff.write(_struct_I.pack(length))
232
+ pattern = '<%sd'%length
233
+ buff.write(self.data.velocity.tostring())
234
+ length = len(self.data.effort)
235
+ buff.write(_struct_I.pack(length))
236
+ pattern = '<%sd'%length
237
+ buff.write(self.data.effort.tostring())
238
+ except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
239
+ except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
240
+
241
+ def deserialize_numpy(self, str, numpy):
242
+ """
243
+ unpack serialized message in str into this message instance using numpy for array types
244
+ :param str: byte array of serialized message, ``str``
245
+ :param numpy: numpy python module
246
+ """
247
+ if python3:
248
+ codecs.lookup_error("rosmsg").msg_type = self._type
249
+ try:
250
+ if self.header is None:
251
+ self.header = std_msgs.msg.Header()
252
+ if self.data is None:
253
+ self.data = kuavo_msgs.msg.endEffectorData()
254
+ end = 0
255
+ _x = self
256
+ start = end
257
+ end += 12
258
+ (_x.header.seq, _x.header.stamp.secs, _x.header.stamp.nsecs,) = _get_struct_3I().unpack(str[start:end])
259
+ start = end
260
+ end += 4
261
+ (length,) = _struct_I.unpack(str[start:end])
262
+ start = end
263
+ end += length
264
+ if python3:
265
+ self.header.frame_id = str[start:end].decode('utf-8', 'rosmsg')
266
+ else:
267
+ self.header.frame_id = str[start:end]
268
+ start = end
269
+ end += 4
270
+ (length,) = _struct_I.unpack(str[start:end])
271
+ self.data.name = []
272
+ for i in range(0, length):
273
+ start = end
274
+ end += 4
275
+ (length,) = _struct_I.unpack(str[start:end])
276
+ start = end
277
+ end += length
278
+ if python3:
279
+ val1 = str[start:end].decode('utf-8', 'rosmsg')
280
+ else:
281
+ val1 = str[start:end]
282
+ self.data.name.append(val1)
283
+ start = end
284
+ end += 4
285
+ (length,) = _struct_I.unpack(str[start:end])
286
+ pattern = '<%sd'%length
287
+ start = end
288
+ s = struct.Struct(pattern)
289
+ end += s.size
290
+ self.data.position = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length)
291
+ start = end
292
+ end += 4
293
+ (length,) = _struct_I.unpack(str[start:end])
294
+ pattern = '<%sd'%length
295
+ start = end
296
+ s = struct.Struct(pattern)
297
+ end += s.size
298
+ self.data.velocity = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length)
299
+ start = end
300
+ end += 4
301
+ (length,) = _struct_I.unpack(str[start:end])
302
+ pattern = '<%sd'%length
303
+ start = end
304
+ s = struct.Struct(pattern)
305
+ end += s.size
306
+ self.data.effort = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length)
307
+ return self
308
+ except struct.error as e:
309
+ raise genpy.DeserializationError(e) # most likely buffer underfill
310
+
311
+ _struct_I = genpy.struct_I
312
+ def _get_struct_I():
313
+ global _struct_I
314
+ return _struct_I
315
+ _struct_3I = None
316
+ def _get_struct_3I():
317
+ global _struct_3I
318
+ if _struct_3I is None:
319
+ _struct_3I = struct.Struct("<3I")
320
+ return _struct_3I