kuavo-humanoid-sdk 1.2.1__20250728145438-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 (132) 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 +276 -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 +11 -0
  9. kuavo_humanoid_sdk/kuavo/core/audio.py +32 -0
  10. kuavo_humanoid_sdk/kuavo/core/core.py +612 -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/ros/audio.py +92 -0
  14. kuavo_humanoid_sdk/kuavo/core/ros/control.py +1309 -0
  15. kuavo_humanoid_sdk/kuavo/core/ros/observation.py +94 -0
  16. kuavo_humanoid_sdk/kuavo/core/ros/param.py +183 -0
  17. kuavo_humanoid_sdk/kuavo/core/ros/sat_utils.py +103 -0
  18. kuavo_humanoid_sdk/kuavo/core/ros/state.py +605 -0
  19. kuavo_humanoid_sdk/kuavo/core/ros/tools.py +219 -0
  20. kuavo_humanoid_sdk/kuavo/core/ros/vision.py +234 -0
  21. kuavo_humanoid_sdk/kuavo/core/ros_env.py +237 -0
  22. kuavo_humanoid_sdk/kuavo/dexterous_hand.py +201 -0
  23. kuavo_humanoid_sdk/kuavo/leju_claw.py +235 -0
  24. kuavo_humanoid_sdk/kuavo/robot.py +465 -0
  25. kuavo_humanoid_sdk/kuavo/robot_arm.py +210 -0
  26. kuavo_humanoid_sdk/kuavo/robot_audio.py +39 -0
  27. kuavo_humanoid_sdk/kuavo/robot_head.py +50 -0
  28. kuavo_humanoid_sdk/kuavo/robot_info.py +113 -0
  29. kuavo_humanoid_sdk/kuavo/robot_observation.py +64 -0
  30. kuavo_humanoid_sdk/kuavo/robot_state.py +299 -0
  31. kuavo_humanoid_sdk/kuavo/robot_tool.py +82 -0
  32. kuavo_humanoid_sdk/kuavo/robot_vision.py +83 -0
  33. kuavo_humanoid_sdk/kuavo_strategy/__init__.py +2 -0
  34. kuavo_humanoid_sdk/kuavo_strategy/grasp_box/grasp_box_strategy.py +1126 -0
  35. kuavo_humanoid_sdk/kuavo_strategy/kuavo_strategy.py +104 -0
  36. kuavo_humanoid_sdk/msg/__init__.py +4 -0
  37. kuavo_humanoid_sdk/msg/kuavo_msgs/__init__.py +7 -0
  38. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_AprilTagDetection.py +306 -0
  39. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_AprilTagDetectionArray.py +437 -0
  40. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_Metadata.py +199 -0
  41. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_RobotActionState.py +112 -0
  42. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_TFArray.py +323 -0
  43. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/__init__.py +44 -0
  44. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_armHandPose.py +160 -0
  45. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_armPoseWithTimeStamp.py +168 -0
  46. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_armTargetPoses.py +151 -0
  47. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_bezierCurveCubicPoint.py +178 -0
  48. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_dexhandCommand.py +229 -0
  49. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_dexhandTouchState.py +256 -0
  50. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_endEffectorData.py +227 -0
  51. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPose.py +123 -0
  52. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPoseTargetTrajectories.py +301 -0
  53. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_footPoses.py +149 -0
  54. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_fullBodyTargetTrajectories.py +258 -0
  55. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_gaitTimeName.py +147 -0
  56. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_gestureInfo.py +218 -0
  57. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_gestureTask.py +149 -0
  58. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_handPose.py +136 -0
  59. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_headBodyPose.py +145 -0
  60. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_ikSolveError.py +171 -0
  61. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_ikSolveParam.py +140 -0
  62. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_imuData.py +165 -0
  63. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_jointBezierTrajectory.py +201 -0
  64. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_jointCmd.py +390 -0
  65. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_jointData.py +205 -0
  66. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_lejuClawCommand.py +320 -0
  67. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_lejuClawState.py +341 -0
  68. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_motorParam.py +122 -0
  69. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_planArmState.py +120 -0
  70. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_questJoySticks.py +191 -0
  71. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_qv.py +121 -0
  72. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_robotArmQVVD.py +177 -0
  73. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_robotHandPosition.py +225 -0
  74. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_robotHeadMotionData.py +128 -0
  75. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_robotState.py +222 -0
  76. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_sensorsData.py +495 -0
  77. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_switchGaitByName.py +200 -0
  78. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_touchSensorStatus.py +162 -0
  79. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_twoArmHandPose.py +272 -0
  80. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_twoArmHandPoseCmd.py +315 -0
  81. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_yoloDetection.py +251 -0
  82. kuavo_humanoid_sdk/msg/kuavo_msgs/msg/_yoloOutputData.py +168 -0
  83. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_ExecuteArmAction.py +281 -0
  84. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_RepublishTFs.py +373 -0
  85. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_SetJoyTopic.py +282 -0
  86. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_SpeechSynthesis.py +270 -0
  87. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/__init__.py +28 -0
  88. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_changeArmCtrlMode.py +275 -0
  89. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_changeArmCtrlModeKuavo.py +236 -0
  90. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_changeMotorParam.py +299 -0
  91. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_changeTorsoCtrlMode.py +274 -0
  92. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_controlLejuClaw.py +408 -0
  93. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_enableHandTouchSensor.py +304 -0
  94. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_fkSrv.py +394 -0
  95. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_footPoseTargetTrajectoriesSrv.py +409 -0
  96. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_gestureExecute.py +339 -0
  97. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_gestureExecuteState.py +257 -0
  98. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_gestureList.py +418 -0
  99. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_getCurrentGaitName.py +253 -0
  100. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_getMotorParam.py +299 -0
  101. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_handForceLevel.py +330 -0
  102. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_jointMoveTo.py +302 -0
  103. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_planArmTrajectoryBezierCurve.py +421 -0
  104. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_planArmTrajectoryCubicSpline.py +490 -0
  105. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_playmusic.py +268 -0
  106. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_setHwIntialState.py +304 -0
  107. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_setMmCtrlFrame.py +273 -0
  108. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_setMotorEncoderRoundService.py +283 -0
  109. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_setTagId.py +275 -0
  110. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_singleStepControl.py +444 -0
  111. kuavo_humanoid_sdk/msg/kuavo_msgs/srv/_twoArmHandPoseCmdSrv.py +662 -0
  112. kuavo_humanoid_sdk/msg/motion_capture_ik/__init__.py +7 -0
  113. kuavo_humanoid_sdk/msg/ocs2_msgs/__init__.py +7 -0
  114. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/__init__.py +12 -0
  115. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_constraint.py +142 -0
  116. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_controller_data.py +121 -0
  117. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_lagrangian_metrics.py +148 -0
  118. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mode_schedule.py +150 -0
  119. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_flattened_controller.py +666 -0
  120. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_input.py +122 -0
  121. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_observation.py +209 -0
  122. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_performance_indices.py +140 -0
  123. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_solver_data.py +886 -0
  124. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_state.py +122 -0
  125. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_mpc_target_trajectories.py +239 -0
  126. kuavo_humanoid_sdk/msg/ocs2_msgs/msg/_multiplier.py +148 -0
  127. kuavo_humanoid_sdk/msg/ocs2_msgs/srv/__init__.py +1 -0
  128. kuavo_humanoid_sdk/msg/ocs2_msgs/srv/_reset.py +376 -0
  129. kuavo_humanoid_sdk-1.2.1.dist-info/METADATA +291 -0
  130. kuavo_humanoid_sdk-1.2.1.dist-info/RECORD +132 -0
  131. kuavo_humanoid_sdk-1.2.1.dist-info/WHEEL +6 -0
  132. kuavo_humanoid_sdk-1.2.1.dist-info/top_level.txt +1 -0
@@ -0,0 +1,149 @@
1
+ # This Python file uses the following encoding: utf-8
2
+ """autogenerated by genpy from kuavo_msgs/footPoses.msg. Do not edit."""
3
+ import codecs
4
+ import sys
5
+ python3 = True if sys.hexversion > 0x03000000 else False
6
+ import genpy
7
+ import struct
8
+
9
+ import kuavo_msgs.msg
10
+
11
+ class footPoses(genpy.Message):
12
+ _md5sum = "2fad89e6e8a2f3c5d0ec891cc7c76c35"
13
+ _type = "kuavo_msgs/footPoses"
14
+ _has_header = False # flag to mark the presence of a Header object
15
+ _full_text = """footPose[] data
16
+
17
+ ================================================================================
18
+ MSG: kuavo_msgs/footPose
19
+ float64[4] footPose # x, y, z, yaw
20
+ float64[4] torsoPose # x, y, z, yaw
21
+ """
22
+ __slots__ = ['data']
23
+ _slot_types = ['kuavo_msgs/footPose[]']
24
+
25
+ def __init__(self, *args, **kwds):
26
+ """
27
+ Constructor. Any message fields that are implicitly/explicitly
28
+ set to None will be assigned a default value. The recommend
29
+ use is keyword arguments as this is more robust to future message
30
+ changes. You cannot mix in-order arguments and keyword arguments.
31
+
32
+ The available fields are:
33
+ data
34
+
35
+ :param args: complete set of field values, in .msg order
36
+ :param kwds: use keyword arguments corresponding to message field names
37
+ to set specific fields.
38
+ """
39
+ if args or kwds:
40
+ super(footPoses, self).__init__(*args, **kwds)
41
+ # message fields cannot be None, assign default values for those that are
42
+ if self.data is None:
43
+ self.data = []
44
+ else:
45
+ self.data = []
46
+
47
+ def _get_types(self):
48
+ """
49
+ internal API method
50
+ """
51
+ return self._slot_types
52
+
53
+ def serialize(self, buff):
54
+ """
55
+ serialize message into buffer
56
+ :param buff: buffer, ``StringIO``
57
+ """
58
+ try:
59
+ length = len(self.data)
60
+ buff.write(_struct_I.pack(length))
61
+ for val1 in self.data:
62
+ buff.write(_get_struct_4d().pack(*val1.footPose))
63
+ buff.write(_get_struct_4d().pack(*val1.torsoPose))
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
+ if self.data is None:
76
+ self.data = None
77
+ end = 0
78
+ start = end
79
+ end += 4
80
+ (length,) = _struct_I.unpack(str[start:end])
81
+ self.data = []
82
+ for i in range(0, length):
83
+ val1 = kuavo_msgs.msg.footPose()
84
+ start = end
85
+ end += 32
86
+ val1.footPose = _get_struct_4d().unpack(str[start:end])
87
+ start = end
88
+ end += 32
89
+ val1.torsoPose = _get_struct_4d().unpack(str[start:end])
90
+ self.data.append(val1)
91
+ return self
92
+ except struct.error as e:
93
+ raise genpy.DeserializationError(e) # most likely buffer underfill
94
+
95
+
96
+ def serialize_numpy(self, buff, numpy):
97
+ """
98
+ serialize message with numpy array types into buffer
99
+ :param buff: buffer, ``StringIO``
100
+ :param numpy: numpy python module
101
+ """
102
+ try:
103
+ length = len(self.data)
104
+ buff.write(_struct_I.pack(length))
105
+ for val1 in self.data:
106
+ buff.write(val1.footPose.tostring())
107
+ buff.write(val1.torsoPose.tostring())
108
+ except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
109
+ except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
110
+
111
+ def deserialize_numpy(self, str, numpy):
112
+ """
113
+ unpack serialized message in str into this message instance using numpy for array types
114
+ :param str: byte array of serialized message, ``str``
115
+ :param numpy: numpy python module
116
+ """
117
+ if python3:
118
+ codecs.lookup_error("rosmsg").msg_type = self._type
119
+ try:
120
+ if self.data is None:
121
+ self.data = None
122
+ end = 0
123
+ start = end
124
+ end += 4
125
+ (length,) = _struct_I.unpack(str[start:end])
126
+ self.data = []
127
+ for i in range(0, length):
128
+ val1 = kuavo_msgs.msg.footPose()
129
+ start = end
130
+ end += 32
131
+ val1.footPose = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=4)
132
+ start = end
133
+ end += 32
134
+ val1.torsoPose = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=4)
135
+ self.data.append(val1)
136
+ return self
137
+ except struct.error as e:
138
+ raise genpy.DeserializationError(e) # most likely buffer underfill
139
+
140
+ _struct_I = genpy.struct_I
141
+ def _get_struct_I():
142
+ global _struct_I
143
+ return _struct_I
144
+ _struct_4d = None
145
+ def _get_struct_4d():
146
+ global _struct_4d
147
+ if _struct_4d is None:
148
+ _struct_4d = struct.Struct("<4d")
149
+ return _struct_4d
@@ -0,0 +1,258 @@
1
+ # This Python file uses the following encoding: utf-8
2
+ """autogenerated by genpy from kuavo_msgs/fullBodyTargetTrajectories.msg. Do not edit."""
3
+ import codecs
4
+ import sys
5
+ python3 = True if sys.hexversion > 0x03000000 else False
6
+ import genpy
7
+ import struct
8
+
9
+ import kuavo_msgs.msg
10
+
11
+ class fullBodyTargetTrajectories(genpy.Message):
12
+ _md5sum = "047ea9aebee29073b8b35a2cfc80bda7"
13
+ _type = "kuavo_msgs/fullBodyTargetTrajectories"
14
+ _has_header = False # flag to mark the presence of a Header object
15
+ _full_text = """float64[] timeTrajectory #时间序列
16
+ int32[] footIndexTrajectory #mode
17
+ qv[] fullBodyQTrajectory #包含广义位置轨迹, 直接指定全身轨迹
18
+ qv[] fullBodyVTrajectory #全身广义速度轨迹
19
+
20
+ ================================================================================
21
+ MSG: kuavo_msgs/qv
22
+ float64[] value
23
+ """
24
+ __slots__ = ['timeTrajectory','footIndexTrajectory','fullBodyQTrajectory','fullBodyVTrajectory']
25
+ _slot_types = ['float64[]','int32[]','kuavo_msgs/qv[]','kuavo_msgs/qv[]']
26
+
27
+ def __init__(self, *args, **kwds):
28
+ """
29
+ Constructor. Any message fields that are implicitly/explicitly
30
+ set to None will be assigned a default value. The recommend
31
+ use is keyword arguments as this is more robust to future message
32
+ changes. You cannot mix in-order arguments and keyword arguments.
33
+
34
+ The available fields are:
35
+ timeTrajectory,footIndexTrajectory,fullBodyQTrajectory,fullBodyVTrajectory
36
+
37
+ :param args: complete set of field values, in .msg order
38
+ :param kwds: use keyword arguments corresponding to message field names
39
+ to set specific fields.
40
+ """
41
+ if args or kwds:
42
+ super(fullBodyTargetTrajectories, self).__init__(*args, **kwds)
43
+ # message fields cannot be None, assign default values for those that are
44
+ if self.timeTrajectory is None:
45
+ self.timeTrajectory = []
46
+ if self.footIndexTrajectory is None:
47
+ self.footIndexTrajectory = []
48
+ if self.fullBodyQTrajectory is None:
49
+ self.fullBodyQTrajectory = []
50
+ if self.fullBodyVTrajectory is None:
51
+ self.fullBodyVTrajectory = []
52
+ else:
53
+ self.timeTrajectory = []
54
+ self.footIndexTrajectory = []
55
+ self.fullBodyQTrajectory = []
56
+ self.fullBodyVTrajectory = []
57
+
58
+ def _get_types(self):
59
+ """
60
+ internal API method
61
+ """
62
+ return self._slot_types
63
+
64
+ def serialize(self, buff):
65
+ """
66
+ serialize message into buffer
67
+ :param buff: buffer, ``StringIO``
68
+ """
69
+ try:
70
+ length = len(self.timeTrajectory)
71
+ buff.write(_struct_I.pack(length))
72
+ pattern = '<%sd'%length
73
+ buff.write(struct.Struct(pattern).pack(*self.timeTrajectory))
74
+ length = len(self.footIndexTrajectory)
75
+ buff.write(_struct_I.pack(length))
76
+ pattern = '<%si'%length
77
+ buff.write(struct.Struct(pattern).pack(*self.footIndexTrajectory))
78
+ length = len(self.fullBodyQTrajectory)
79
+ buff.write(_struct_I.pack(length))
80
+ for val1 in self.fullBodyQTrajectory:
81
+ length = len(val1.value)
82
+ buff.write(_struct_I.pack(length))
83
+ pattern = '<%sd'%length
84
+ buff.write(struct.Struct(pattern).pack(*val1.value))
85
+ length = len(self.fullBodyVTrajectory)
86
+ buff.write(_struct_I.pack(length))
87
+ for val1 in self.fullBodyVTrajectory:
88
+ length = len(val1.value)
89
+ buff.write(_struct_I.pack(length))
90
+ pattern = '<%sd'%length
91
+ buff.write(struct.Struct(pattern).pack(*val1.value))
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(self, str):
96
+ """
97
+ unpack serialized message in str into this message instance
98
+ :param str: byte array of serialized message, ``str``
99
+ """
100
+ if python3:
101
+ codecs.lookup_error("rosmsg").msg_type = self._type
102
+ try:
103
+ if self.fullBodyQTrajectory is None:
104
+ self.fullBodyQTrajectory = None
105
+ if self.fullBodyVTrajectory is None:
106
+ self.fullBodyVTrajectory = None
107
+ end = 0
108
+ start = end
109
+ end += 4
110
+ (length,) = _struct_I.unpack(str[start:end])
111
+ pattern = '<%sd'%length
112
+ start = end
113
+ s = struct.Struct(pattern)
114
+ end += s.size
115
+ self.timeTrajectory = s.unpack(str[start:end])
116
+ start = end
117
+ end += 4
118
+ (length,) = _struct_I.unpack(str[start:end])
119
+ pattern = '<%si'%length
120
+ start = end
121
+ s = struct.Struct(pattern)
122
+ end += s.size
123
+ self.footIndexTrajectory = s.unpack(str[start:end])
124
+ start = end
125
+ end += 4
126
+ (length,) = _struct_I.unpack(str[start:end])
127
+ self.fullBodyQTrajectory = []
128
+ for i in range(0, length):
129
+ val1 = kuavo_msgs.msg.qv()
130
+ start = end
131
+ end += 4
132
+ (length,) = _struct_I.unpack(str[start:end])
133
+ pattern = '<%sd'%length
134
+ start = end
135
+ s = struct.Struct(pattern)
136
+ end += s.size
137
+ val1.value = s.unpack(str[start:end])
138
+ self.fullBodyQTrajectory.append(val1)
139
+ start = end
140
+ end += 4
141
+ (length,) = _struct_I.unpack(str[start:end])
142
+ self.fullBodyVTrajectory = []
143
+ for i in range(0, length):
144
+ val1 = kuavo_msgs.msg.qv()
145
+ start = end
146
+ end += 4
147
+ (length,) = _struct_I.unpack(str[start:end])
148
+ pattern = '<%sd'%length
149
+ start = end
150
+ s = struct.Struct(pattern)
151
+ end += s.size
152
+ val1.value = s.unpack(str[start:end])
153
+ self.fullBodyVTrajectory.append(val1)
154
+ return self
155
+ except struct.error as e:
156
+ raise genpy.DeserializationError(e) # most likely buffer underfill
157
+
158
+
159
+ def serialize_numpy(self, buff, numpy):
160
+ """
161
+ serialize message with numpy array types into buffer
162
+ :param buff: buffer, ``StringIO``
163
+ :param numpy: numpy python module
164
+ """
165
+ try:
166
+ length = len(self.timeTrajectory)
167
+ buff.write(_struct_I.pack(length))
168
+ pattern = '<%sd'%length
169
+ buff.write(self.timeTrajectory.tostring())
170
+ length = len(self.footIndexTrajectory)
171
+ buff.write(_struct_I.pack(length))
172
+ pattern = '<%si'%length
173
+ buff.write(self.footIndexTrajectory.tostring())
174
+ length = len(self.fullBodyQTrajectory)
175
+ buff.write(_struct_I.pack(length))
176
+ for val1 in self.fullBodyQTrajectory:
177
+ length = len(val1.value)
178
+ buff.write(_struct_I.pack(length))
179
+ pattern = '<%sd'%length
180
+ buff.write(val1.value.tostring())
181
+ length = len(self.fullBodyVTrajectory)
182
+ buff.write(_struct_I.pack(length))
183
+ for val1 in self.fullBodyVTrajectory:
184
+ length = len(val1.value)
185
+ buff.write(_struct_I.pack(length))
186
+ pattern = '<%sd'%length
187
+ buff.write(val1.value.tostring())
188
+ except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
189
+ except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
190
+
191
+ def deserialize_numpy(self, str, numpy):
192
+ """
193
+ unpack serialized message in str into this message instance using numpy for array types
194
+ :param str: byte array of serialized message, ``str``
195
+ :param numpy: numpy python module
196
+ """
197
+ if python3:
198
+ codecs.lookup_error("rosmsg").msg_type = self._type
199
+ try:
200
+ if self.fullBodyQTrajectory is None:
201
+ self.fullBodyQTrajectory = None
202
+ if self.fullBodyVTrajectory is None:
203
+ self.fullBodyVTrajectory = None
204
+ end = 0
205
+ start = end
206
+ end += 4
207
+ (length,) = _struct_I.unpack(str[start:end])
208
+ pattern = '<%sd'%length
209
+ start = end
210
+ s = struct.Struct(pattern)
211
+ end += s.size
212
+ self.timeTrajectory = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length)
213
+ start = end
214
+ end += 4
215
+ (length,) = _struct_I.unpack(str[start:end])
216
+ pattern = '<%si'%length
217
+ start = end
218
+ s = struct.Struct(pattern)
219
+ end += s.size
220
+ self.footIndexTrajectory = numpy.frombuffer(str[start:end], dtype=numpy.int32, count=length)
221
+ start = end
222
+ end += 4
223
+ (length,) = _struct_I.unpack(str[start:end])
224
+ self.fullBodyQTrajectory = []
225
+ for i in range(0, length):
226
+ val1 = kuavo_msgs.msg.qv()
227
+ start = end
228
+ end += 4
229
+ (length,) = _struct_I.unpack(str[start:end])
230
+ pattern = '<%sd'%length
231
+ start = end
232
+ s = struct.Struct(pattern)
233
+ end += s.size
234
+ val1.value = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length)
235
+ self.fullBodyQTrajectory.append(val1)
236
+ start = end
237
+ end += 4
238
+ (length,) = _struct_I.unpack(str[start:end])
239
+ self.fullBodyVTrajectory = []
240
+ for i in range(0, length):
241
+ val1 = kuavo_msgs.msg.qv()
242
+ start = end
243
+ end += 4
244
+ (length,) = _struct_I.unpack(str[start:end])
245
+ pattern = '<%sd'%length
246
+ start = end
247
+ s = struct.Struct(pattern)
248
+ end += s.size
249
+ val1.value = numpy.frombuffer(str[start:end], dtype=numpy.float64, count=length)
250
+ self.fullBodyVTrajectory.append(val1)
251
+ return self
252
+ except struct.error as e:
253
+ raise genpy.DeserializationError(e) # most likely buffer underfill
254
+
255
+ _struct_I = genpy.struct_I
256
+ def _get_struct_I():
257
+ global _struct_I
258
+ return _struct_I
@@ -0,0 +1,147 @@
1
+ # This Python file uses the following encoding: utf-8
2
+ """autogenerated by genpy from kuavo_msgs/gaitTimeName.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 gaitTimeName(genpy.Message):
11
+ _md5sum = "c694c8dbb2e8c9d73614407bfe314692"
12
+ _type = "kuavo_msgs/gaitTimeName"
13
+ _has_header = False # flag to mark the presence of a Header object
14
+ _full_text = """float32 start_time
15
+ string gait_name
16
+ """
17
+ __slots__ = ['start_time','gait_name']
18
+ _slot_types = ['float32','string']
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
+ start_time,gait_name
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(gaitTimeName, self).__init__(*args, **kwds)
36
+ # message fields cannot be None, assign default values for those that are
37
+ if self.start_time is None:
38
+ self.start_time = 0.
39
+ if self.gait_name is None:
40
+ self.gait_name = ''
41
+ else:
42
+ self.start_time = 0.
43
+ self.gait_name = ''
44
+
45
+ def _get_types(self):
46
+ """
47
+ internal API method
48
+ """
49
+ return self._slot_types
50
+
51
+ def serialize(self, buff):
52
+ """
53
+ serialize message into buffer
54
+ :param buff: buffer, ``StringIO``
55
+ """
56
+ try:
57
+ _x = self.start_time
58
+ buff.write(_get_struct_f().pack(_x))
59
+ _x = self.gait_name
60
+ length = len(_x)
61
+ if python3 or type(_x) == unicode:
62
+ _x = _x.encode('utf-8')
63
+ length = len(_x)
64
+ buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
65
+ except struct.error as se: self._check_types(struct.error("%s: '%s' when writing '%s'" % (type(se), str(se), str(locals().get('_x', self)))))
66
+ except TypeError as te: self._check_types(ValueError("%s: '%s' when writing '%s'" % (type(te), str(te), str(locals().get('_x', self)))))
67
+
68
+ def deserialize(self, str):
69
+ """
70
+ unpack serialized message in str into this message instance
71
+ :param str: byte array of serialized message, ``str``
72
+ """
73
+ if python3:
74
+ codecs.lookup_error("rosmsg").msg_type = self._type
75
+ try:
76
+ end = 0
77
+ start = end
78
+ end += 4
79
+ (self.start_time,) = _get_struct_f().unpack(str[start:end])
80
+ start = end
81
+ end += 4
82
+ (length,) = _struct_I.unpack(str[start:end])
83
+ start = end
84
+ end += length
85
+ if python3:
86
+ self.gait_name = str[start:end].decode('utf-8', 'rosmsg')
87
+ else:
88
+ self.gait_name = str[start:end]
89
+ return self
90
+ except struct.error as e:
91
+ raise genpy.DeserializationError(e) # most likely buffer underfill
92
+
93
+
94
+ def serialize_numpy(self, buff, numpy):
95
+ """
96
+ serialize message with numpy array types into buffer
97
+ :param buff: buffer, ``StringIO``
98
+ :param numpy: numpy python module
99
+ """
100
+ try:
101
+ _x = self.start_time
102
+ buff.write(_get_struct_f().pack(_x))
103
+ _x = self.gait_name
104
+ length = len(_x)
105
+ if python3 or type(_x) == unicode:
106
+ _x = _x.encode('utf-8')
107
+ length = len(_x)
108
+ buff.write(struct.Struct('<I%ss'%length).pack(length, _x))
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
+ end = 0
122
+ start = end
123
+ end += 4
124
+ (self.start_time,) = _get_struct_f().unpack(str[start:end])
125
+ start = end
126
+ end += 4
127
+ (length,) = _struct_I.unpack(str[start:end])
128
+ start = end
129
+ end += length
130
+ if python3:
131
+ self.gait_name = str[start:end].decode('utf-8', 'rosmsg')
132
+ else:
133
+ self.gait_name = str[start:end]
134
+ return self
135
+ except struct.error as e:
136
+ raise genpy.DeserializationError(e) # most likely buffer underfill
137
+
138
+ _struct_I = genpy.struct_I
139
+ def _get_struct_I():
140
+ global _struct_I
141
+ return _struct_I
142
+ _struct_f = None
143
+ def _get_struct_f():
144
+ global _struct_f
145
+ if _struct_f is None:
146
+ _struct_f = struct.Struct("<f")
147
+ return _struct_f