kuavo-humanoid-sdk 1.2.1b3279__20250911210455-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.1b3279.dist-info/METADATA +296 -0
  182. kuavo_humanoid_sdk-1.2.1b3279.dist-info/RECORD +184 -0
  183. kuavo_humanoid_sdk-1.2.1b3279.dist-info/WHEEL +6 -0
  184. kuavo_humanoid_sdk-1.2.1b3279.dist-info/top_level.txt +1 -0
@@ -0,0 +1,306 @@
1
+ # This Python file uses the following encoding: utf-8
2
+ """autogenerated by genpy from kuavo_msgs/AprilTagDetection.msg. Do not edit."""
3
+ import codecs
4
+ import sys
5
+ python3 = True if sys.hexversion > 0x03000000 else False
6
+ import genpy
7
+ import struct
8
+
9
+ import geometry_msgs.msg
10
+ import std_msgs.msg
11
+
12
+ class AprilTagDetection(genpy.Message):
13
+ _md5sum = "090173a6e2b6c8fd96ce000fe9378b4e"
14
+ _type = "kuavo_msgs/AprilTagDetection"
15
+ _has_header = False # flag to mark the presence of a Header object
16
+ _full_text = """# Tag ID(s). If a standalone tag, this is a vector of size 1. If a tag bundle,
17
+ # this is a vector containing the IDs of each tag in the bundle.
18
+ int32[] id
19
+
20
+ # Tag size(s). If a standalone tag, this is a vector of size 1. If a tag bundle,
21
+ # this is a vector containing the sizes of each tag in the bundle, in the same
22
+ # order as the IDs above.
23
+ float64[] size
24
+
25
+ # Pose in the camera frame, obtained from homography transform. If a standalone
26
+ # tag, the homography is from the four tag corners. If a tag bundle, the
27
+ # homography is from at least the four corners of one member tag and at most the
28
+ # four corners of all member tags.
29
+ geometry_msgs/PoseWithCovarianceStamped pose
30
+ ================================================================================
31
+ MSG: geometry_msgs/PoseWithCovarianceStamped
32
+ # This expresses an estimated pose with a reference coordinate frame and timestamp
33
+
34
+ Header header
35
+ PoseWithCovariance pose
36
+
37
+ ================================================================================
38
+ MSG: std_msgs/Header
39
+ # Standard metadata for higher-level stamped data types.
40
+ # This is generally used to communicate timestamped data
41
+ # in a particular coordinate frame.
42
+ #
43
+ # sequence ID: consecutively increasing ID
44
+ uint32 seq
45
+ #Two-integer timestamp that is expressed as:
46
+ # * stamp.sec: seconds (stamp_secs) since epoch (in Python the variable is called 'secs')
47
+ # * stamp.nsec: nanoseconds since stamp_secs (in Python the variable is called 'nsecs')
48
+ # time-handling sugar is provided by the client library
49
+ time stamp
50
+ #Frame this data is associated with
51
+ string frame_id
52
+
53
+ ================================================================================
54
+ MSG: geometry_msgs/PoseWithCovariance
55
+ # This represents a pose in free space with uncertainty.
56
+
57
+ Pose pose
58
+
59
+ # Row-major representation of the 6x6 covariance matrix
60
+ # The orientation parameters use a fixed-axis representation.
61
+ # In order, the parameters are:
62
+ # (x, y, z, rotation about X axis, rotation about Y axis, rotation about Z axis)
63
+ float64[36] covariance
64
+
65
+ ================================================================================
66
+ MSG: geometry_msgs/Pose
67
+ # A representation of pose in free space, composed of position and orientation.
68
+ Point position
69
+ Quaternion orientation
70
+
71
+ ================================================================================
72
+ MSG: geometry_msgs/Point
73
+ # This contains the position of a point in free space
74
+ float64 x
75
+ float64 y
76
+ float64 z
77
+
78
+ ================================================================================
79
+ MSG: geometry_msgs/Quaternion
80
+ # This represents an orientation in free space in quaternion form.
81
+
82
+ float64 x
83
+ float64 y
84
+ float64 z
85
+ float64 w
86
+ """
87
+ __slots__ = ['id','size','pose']
88
+ _slot_types = ['int32[]','float64[]','geometry_msgs/PoseWithCovarianceStamped']
89
+
90
+ def __init__(self, *args, **kwds):
91
+ """
92
+ Constructor. Any message fields that are implicitly/explicitly
93
+ set to None will be assigned a default value. The recommend
94
+ use is keyword arguments as this is more robust to future message
95
+ changes. You cannot mix in-order arguments and keyword arguments.
96
+
97
+ The available fields are:
98
+ id,size,pose
99
+
100
+ :param args: complete set of field values, in .msg order
101
+ :param kwds: use keyword arguments corresponding to message field names
102
+ to set specific fields.
103
+ """
104
+ if args or kwds:
105
+ super(AprilTagDetection, self).__init__(*args, **kwds)
106
+ # message fields cannot be None, assign default values for those that are
107
+ if self.id is None:
108
+ self.id = []
109
+ if self.size is None:
110
+ self.size = []
111
+ if self.pose is None:
112
+ self.pose = geometry_msgs.msg.PoseWithCovarianceStamped()
113
+ else:
114
+ self.id = []
115
+ self.size = []
116
+ self.pose = geometry_msgs.msg.PoseWithCovarianceStamped()
117
+
118
+ def _get_types(self):
119
+ """
120
+ internal API method
121
+ """
122
+ return self._slot_types
123
+
124
+ def serialize(self, buff):
125
+ """
126
+ serialize message into buffer
127
+ :param buff: buffer, ``StringIO``
128
+ """
129
+ try:
130
+ length = len(self.id)
131
+ buff.write(_struct_I.pack(length))
132
+ pattern = '<%si'%length
133
+ buff.write(struct.Struct(pattern).pack(*self.id))
134
+ length = len(self.size)
135
+ buff.write(_struct_I.pack(length))
136
+ pattern = '<%sd'%length
137
+ buff.write(struct.Struct(pattern).pack(*self.size))
138
+ _x = self
139
+ buff.write(_get_struct_3I().pack(_x.pose.header.seq, _x.pose.header.stamp.secs, _x.pose.header.stamp.nsecs))
140
+ _x = self.pose.header.frame_id
141
+ length = len(_x)
142
+ if python3 or type(_x) == unicode:
143
+ _x = _x.encode('utf-8')
144
+ length = len(_x)
145
+ buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
146
+ _x = self
147
+ buff.write(_get_struct_7d().pack(_x.pose.pose.pose.position.x, _x.pose.pose.pose.position.y, _x.pose.pose.pose.position.z, _x.pose.pose.pose.orientation.x, _x.pose.pose.pose.orientation.y, _x.pose.pose.pose.orientation.z, _x.pose.pose.pose.orientation.w))
148
+ buff.write(_get_struct_36d().pack(*self.pose.pose.covariance))
149
+ except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
150
+ except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
151
+
152
+ def deserialize(self, str):
153
+ """
154
+ unpack serialized message in str into this message instance
155
+ :param str: byte array of serialized message, ``str``
156
+ """
157
+ if python3:
158
+ codecs.lookup_error("rosmsg").msg_type = self._type
159
+ try:
160
+ if self.pose is None:
161
+ self.pose = geometry_msgs.msg.PoseWithCovarianceStamped()
162
+ end = 0
163
+ start = end
164
+ end += 4
165
+ (length,) = _struct_I.unpack(str[start:end])
166
+ pattern = '<%si'%length
167
+ start = end
168
+ s = struct.Struct(pattern)
169
+ end += s.size
170
+ self.id = s.unpack(str[start:end])
171
+ start = end
172
+ end += 4
173
+ (length,) = _struct_I.unpack(str[start:end])
174
+ pattern = '<%sd'%length
175
+ start = end
176
+ s = struct.Struct(pattern)
177
+ end += s.size
178
+ self.size = s.unpack(str[start:end])
179
+ _x = self
180
+ start = end
181
+ end += 12
182
+ (_x.pose.header.seq, _x.pose.header.stamp.secs, _x.pose.header.stamp.nsecs,) = _get_struct_3I().unpack(str[start:end])
183
+ start = end
184
+ end += 4
185
+ (length,) = _struct_I.unpack(str[start:end])
186
+ start = end
187
+ end += length
188
+ if python3:
189
+ self.pose.header.frame_id = str[start:end].decode('utf-8', 'rosmsg')
190
+ else:
191
+ self.pose.header.frame_id = str[start:end]
192
+ _x = self
193
+ start = end
194
+ end += 56
195
+ (_x.pose.pose.pose.position.x, _x.pose.pose.pose.position.y, _x.pose.pose.pose.position.z, _x.pose.pose.pose.orientation.x, _x.pose.pose.pose.orientation.y, _x.pose.pose.pose.orientation.z, _x.pose.pose.pose.orientation.w,) = _get_struct_7d().unpack(str[start:end])
196
+ start = end
197
+ end += 288
198
+ self.pose.pose.covariance = _get_struct_36d().unpack(str[start:end])
199
+ return self
200
+ except struct.error as e:
201
+ raise genpy.DeserializationError(e) # most likely buffer underfill
202
+
203
+
204
+ def serialize_numpy(self, buff, numpy):
205
+ """
206
+ serialize message with numpy array types into buffer
207
+ :param buff: buffer, ``StringIO``
208
+ :param numpy: numpy python module
209
+ """
210
+ try:
211
+ length = len(self.id)
212
+ buff.write(_struct_I.pack(length))
213
+ pattern = '<%si'%length
214
+ buff.write(self.id.tostring())
215
+ length = len(self.size)
216
+ buff.write(_struct_I.pack(length))
217
+ pattern = '<%sd'%length
218
+ buff.write(self.size.tostring())
219
+ _x = self
220
+ buff.write(_get_struct_3I().pack(_x.pose.header.seq, _x.pose.header.stamp.secs, _x.pose.header.stamp.nsecs))
221
+ _x = self.pose.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
+ _x = self
228
+ buff.write(_get_struct_7d().pack(_x.pose.pose.pose.position.x, _x.pose.pose.pose.position.y, _x.pose.pose.pose.position.z, _x.pose.pose.pose.orientation.x, _x.pose.pose.pose.orientation.y, _x.pose.pose.pose.orientation.z, _x.pose.pose.pose.orientation.w))
229
+ buff.write(self.pose.pose.covariance.tostring())
230
+ except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
231
+ except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
232
+
233
+ def deserialize_numpy(self, str, numpy):
234
+ """
235
+ unpack serialized message in str into this message instance using numpy for array types
236
+ :param str: byte array of serialized message, ``str``
237
+ :param numpy: numpy python module
238
+ """
239
+ if python3:
240
+ codecs.lookup_error("rosmsg").msg_type = self._type
241
+ try:
242
+ if self.pose is None:
243
+ self.pose = geometry_msgs.msg.PoseWithCovarianceStamped()
244
+ end = 0
245
+ start = end
246
+ end += 4
247
+ (length,) = _struct_I.unpack(str[start:end])
248
+ pattern = '<%si'%length
249
+ start = end
250
+ s = struct.Struct(pattern)
251
+ end += s.size
252
+ self.id = numpy.frombuffer(str[start:end], dtype=numpy.int32, count=length)
253
+ start = end
254
+ end += 4
255
+ (length,) = _struct_I.unpack(str[start:end])
256
+ pattern = '<%sd'%length
257
+ start = end
258
+ s = struct.Struct(pattern)
259
+ end += s.size
260
+ self.size = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length)
261
+ _x = self
262
+ start = end
263
+ end += 12
264
+ (_x.pose.header.seq, _x.pose.header.stamp.secs, _x.pose.header.stamp.nsecs,) = _get_struct_3I().unpack(str[start:end])
265
+ start = end
266
+ end += 4
267
+ (length,) = _struct_I.unpack(str[start:end])
268
+ start = end
269
+ end += length
270
+ if python3:
271
+ self.pose.header.frame_id = str[start:end].decode('utf-8', 'rosmsg')
272
+ else:
273
+ self.pose.header.frame_id = str[start:end]
274
+ _x = self
275
+ start = end
276
+ end += 56
277
+ (_x.pose.pose.pose.position.x, _x.pose.pose.pose.position.y, _x.pose.pose.pose.position.z, _x.pose.pose.pose.orientation.x, _x.pose.pose.pose.orientation.y, _x.pose.pose.pose.orientation.z, _x.pose.pose.pose.orientation.w,) = _get_struct_7d().unpack(str[start:end])
278
+ start = end
279
+ end += 288
280
+ self.pose.pose.covariance = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=36)
281
+ return self
282
+ except struct.error as e:
283
+ raise genpy.DeserializationError(e) # most likely buffer underfill
284
+
285
+ _struct_I = genpy.struct_I
286
+ def _get_struct_I():
287
+ global _struct_I
288
+ return _struct_I
289
+ _struct_36d = None
290
+ def _get_struct_36d():
291
+ global _struct_36d
292
+ if _struct_36d is None:
293
+ _struct_36d = struct.Struct("<36d")
294
+ return _struct_36d
295
+ _struct_3I = None
296
+ def _get_struct_3I():
297
+ global _struct_3I
298
+ if _struct_3I is None:
299
+ _struct_3I = struct.Struct("<3I")
300
+ return _struct_3I
301
+ _struct_7d = None
302
+ def _get_struct_7d():
303
+ global _struct_7d
304
+ if _struct_7d is None:
305
+ _struct_7d = struct.Struct("<7d")
306
+ return _struct_7d