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