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