A dual-arm load-bearing, attitude-stabilized humanoid robot
By incorporating a floating shoulder stabilizing device into a humanoid robot and utilizing common-mode and differential-mode compensation assemblies to adjust the position of the robotic arm, the impact of torso floating and tilting on the load was resolved, thereby improving the stability of the load posture.
Patent Information
- Application Number
- CN202611227202.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2026-08-13
- Publication Date
- 2026-11-17
AI Technical Summary
When existing dual-arm humanoid robots walk, the up-and-down movement of the torso and the left-and-right tilting cause the goods being carried by both arms to swing frequently. Ordinary joint compensation increases the joint load, while spring damping structures are difficult to compensate in a directional manner, resulting in unstable load.
A floating shoulder stabilizing device is installed between the torso assembly and the robotic arm assembly. The vertical position of the robotic arm is adjusted by the common mode compensation assembly and the differential mode compensation assembly. The common mode guide rail and the differential rocker arm are used to achieve vertical compensation in the same direction and opposite direction, reducing the transmission of load by the torso movement.
Without restricting the robotic arm's operational degrees of freedom, it improves the load's height and tilt stability, and reduces the impact of torso rise and fall and lateral tilt during walking on the load.
Smart Images

Figure CN123103586A_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the field of humanoid robot technology, and more specifically to a dual-arm, load-bearing, posture-stabilized humanoid robot. Background Technology
[0002] With the development of humanoid robot technology, dual-arm humanoid robots are gradually being applied to scenarios such as warehousing and logistics, material handling, production assistance, and hazardous environment operations. In these applications, dual-arm humanoid robots typically need to use their left and right robotic arms to jointly grasp boxes, pallets, or other loads, and perform actions such as starting, walking in a straight line, turning, overcoming obstacles, and stopping while maintaining the grasping state.
[0003] Existing dual-arm humanoid robots typically have elbow and wrist joints in their left and right robotic arms, which are mounted to the torso via shoulder joints. The movement of each joint adjusts the position and posture of the end effector. When a dual-arm humanoid robot walks, its left and right feet periodically switch between a bipedal and monopedal support state. To maintain overall balance, the robot's leg joints, waist, and torso need to move accordingly with the support state and the shift of the center of gravity. Therefore, the torso usually experiences vertical rise and fall, lateral tilt, and corresponding changes in linear acceleration and angular velocity relative to the ground. When the left and right end effectors grip the same load together, the changes in the height and tilt angle of the torso are transmitted to the left and right robotic arms via the shoulder joints, causing the load to roll, swing, and undergo other changes, which is especially noticeable when the robot is monopedal, the foot touches the ground, it accelerates or decelerates, or the surface is uneven.
[0004] Existing technologies generally maintain the balance of humanoid robots by adjusting the movement of the legs, waist, and other joints, or by adjusting the shoulder, elbow, and wrist joints to compensate for motion deviations at the end of the operation. However, the overall balance control can only prevent the robot from tipping over, but cannot guarantee that the load remains stable relative to the ground. Relying on the joints of the robotic arm to perform motion compensation will occupy the available degrees of freedom of the robotic arm, increase the joint load and the complexity of the control algorithm. When the left and right robotic arms grasp the same rigid cargo, the two arms and the cargo form a closed motion constraint structure. If the compensation actions of the two robotic arms are not synchronized, additional tension, pressure or torque may be generated between the robotic arm and the workpiece.
[0005] In addition, conventional springs, balancers, and dampers are usually installed between the robotic arm and the torso to absorb impact and reduce vibration to a certain extent. However, such passive elastic damping structures can only passively deform according to the applied force. Their displacement direction, displacement amount, and response phase are affected by factors such as load weight, spring stiffness, damping coefficient, and gait frequency. When the load weight or walking speed changes, problems such as insufficient compensation, response lag, or even vibration amplification are likely to occur. If the left and right robotic arms adopt independent floating support structures, asynchronous movement may occur due to differences in left and right support stiffness, friction, and load distribution. This will further aggravate the internal forces in the closed motion constraint structure of the two arms, making it difficult to simultaneously ensure the stability of the gripped load height and the stability of the left and right horizontal posture. Summary of the Invention
[0006] In response to the above issues, and to overcome the problems of the torso's vertical and horizontal tilting during walking, which transmits the load to the arms and causes frequent swaying of goods carried by both arms, while ordinary joint compensation easily increases joint load and spring damping structures are difficult to compensate in a directional manner, the purpose of this invention is to provide a humanoid robot that reduces the transmission of torso's vertical and horizontal tilting to the arms and goods during walking without occupying the main operating degrees of freedom of the robotic arm, while also taking into account the impact buffering of the feet landing, thereby maintaining the stability of the goods' posture.
[0007] To achieve the above objectives, the technical solution of the present invention is: A dual-arm load-bearing, posture-stabilized humanoid robot includes a humanoid robot body. The humanoid robot body includes a torso assembly, lower limbs connected to the lower part of the torso assembly, and two robotic arm assemblies located on the left and right sides. A floating shoulder stabilization device is provided between the upper part of the torso assembly and the two robotic arm assemblies. The floating shoulder stabilization device includes a fixed support frame fixedly connected to the torso assembly. Common-mode guide rails extending vertically are provided on the left and right sides of the fixed support frame. Each common-mode guide rail is slidably fitted with a common-mode slider. The two common-mode sliders are respectively fixed to the left and right sides of a floating load-bearing frame. Shoulder vertical guide rails are provided on the left and right sides of the floating load-bearing frame. Each shoulder vertical guide rail is slidably fitted with a shoulder slider. The two shoulder sliders respectively support the corresponding robotic arm assemblies. The floating support frame is rotatably supported by a central rotating shaft extending in the front-to-back direction. The central rotating shaft is fixedly connected to a differential rocker arm. Transmission arms are formed on both sides of the differential rocker arm. The transmission arms are connected to the corresponding shoulder sliders through connecting rods. A common mode compensation assembly is connected between the fixed support frame and the floating support frame. The common mode compensation assembly drives the floating support frame to move up and down along the common mode guide rail, thereby causing the two shoulder sliders and the corresponding robotic arm assemblies to produce vertical displacement in the same direction, thus realizing vertical compensation of the common mode. The central rotating shaft is driven by the differential mode compensation assembly to drive the differential rocker arm to rotate, and through the transmission arms on both sides and the connecting rods, it drives the two shoulder sliders to move in opposite directions along the corresponding shoulder vertical guide rail, thereby causing the two robotic arm assemblies to produce vertical displacement in opposite directions, thus realizing vertical compensation of the differential mode.
[0008] Preferably, the torso assembly includes a torso frame, a thoracic mounting frame is fixed on the torso frame, a waist connecting seat for connecting to the lower limbs is provided at the lower part of the torso frame, a torso connecting plate is provided on the fixed support frame, the torso connecting plate is fixedly connected to the thoracic mounting frame through a fixed connector, and each common mode guide rail has an upper stroke limiter at the upper end and a lower stroke limiter at the lower end.
[0009] Preferably, a central bearing seat is fixed in the middle of the floating load frame, the central shaft is rotatably supported by the central bearing seat, two shoulder vertical guide rails are fixed on the left and right sides of the floating load frame respectively, and a shoulder elastic buffer is provided at the lower end of each shoulder vertical guide rail. A common mode actuator connection part connected to the common mode compensation assembly is fixed at the lower part of the floating load frame.
[0010] Preferably, a differential rocker arm is fixed to the front end of the central rotating shaft, and a transmission arm is provided on both sides of the differential rocker arm. Each transmission arm has a ball joint at its end, which connects to one end of a corresponding connecting rod. The other end of the connecting rod is hinged to the corresponding shoulder slider. The two transmission arms are located on both sides of the axis of the central rotating shaft. An encoder component that rotates synchronously with the central rotating shaft is fixed on the central rotating shaft. A rocker arm angle sensor is fixed on the central bearing seat, and the detection end of the rocker arm angle sensor is opposite to the rotation path of the encoder component.
[0011] Preferably, each shoulder slider is fixedly connected to a shoulder mounting base, and a connecting rod mounting part is provided on the side of the shoulder slider facing the middle of the floating support frame. The corresponding connecting rod is hinged to the connecting rod mounting part by a pin. A shoulder position sensor is provided between the shoulder slider and the floating support frame. The fixed end of the shoulder position sensor is connected to the floating support frame, and the detection end is set correspondingly to the shoulder slider. The upper end of the corresponding shoulder vertical guide rail is provided with a shoulder upper limit member, and the lower end is provided with a shoulder lower limit member.
[0012] Preferably, the common mode compensation assembly includes a common mode drive motor fixedly mounted on a fixed support frame. The output end of the common mode drive motor is driven by a common mode transmission screw that is rotatably supported on the fixed support frame in the vertical direction. The common mode transmission screw is threaded with a common mode nut seat, which is fixedly connected to the common mode actuator connection part and moves axially when the common mode transmission screw rotates. This causes the floating load frame to move up and down along the common mode guide rail via the common mode actuator connection part. A common mode elastic element and a common mode damper are arranged side by side below the floating load frame. One end of the common mode elastic element is connected to the fixed support frame through a common mode preload seat, and the other end is connected to the floating load frame. The common mode preload seat is adjustablely positioned on the fixed support frame along the axial direction of the common mode elastic element. One end of the common mode damper is connected to the fixed support frame, and the other end is connected to the floating load frame. A common mode displacement sensor is provided between the fixed support frame and the floating load frame. The fixed end of the common mode displacement sensor is connected to the fixed support frame, and the detection end is correspondingly set with the floating load frame.
[0013] Preferably, the differential mode compensation assembly includes a differential mode servo motor and a differential mode reducer fixedly mounted on the floating support frame. The output end of the differential mode servo motor is connected to the input end of the differential mode reducer, and the output end of the differential mode reducer is coaxially connected to the central rotating shaft to drive the central rotating shaft to rotate.
[0014] Preferably, each robotic arm assembly includes an upper arm, one end of which is connected to a corresponding shoulder mount via a shoulder joint module, and the other end is connected to a forearm via an elbow joint. The forearm is connected to an end effector via a wrist joint. A six-dimensional force sensor is provided between the wrist joint and the end effector. The shoulder joint module, elbow joint, and wrist joint are all equipped with joint drive motors. Each joint drive motor is respectively connected to the corresponding shoulder joint module, elbow joint, and wrist joint to drive the corresponding joint to rotate.
[0015] Preferably, the humanoid robot body also includes a state detection assembly and a control assembly, which are communicatively connected. The torso assembly is equipped with a torso inertial sensor. The lower limbs include two feet and lower limb joints located between the torso assembly and the two feet. Each foot is equipped with a foot contact sensor and a foot pressure sensor. At least one lower limb joint is equipped with a joint state sensor. Each joint drive motor is equipped with a motor state sensor. At least one end effector is equipped with a load posture sensor. The detection end of the load posture sensor faces the load gripping area between the two end effectors. The humanoid robot body is equipped with a vision detection device, and each end effector is equipped with a load presence detector.
[0016] Preferably, the main controller of the control assembly is equipped with a gait state acquisition module, a trunk posture estimation module, a common-mode compensation control module, a differential-mode compensation control module, a load posture feedback module, and a dual-arm internal force coordination module. The gait state acquisition module determines the gait state based on foot contact sensors, foot pressure sensors, and joint state sensors. The trunk posture estimation module determines the trunk heave and tilt states based on trunk inertial sensors and the gait state. The load posture feedback module determines the load height deviation and load tilt deviation based on load posture sensors and a visual detection device. The common-mode compensation control module controls the common-mode compensation assembly to perform unidirectional vertical compensation based on the trunk heave, foot pressure sensors, and load height deviation. The differential-mode compensation control module... The block controls the differential mode compensation assembly to perform reverse vertical compensation based on the torso tilt state and load tilt deviation, and limits the differential mode compensation range based on the center shaft rotation angle detected by the rocker arm angle sensor; the dual-arm internal force coordination module unifies the force and torque components of the two wrist six-dimensional force sensors to the load coordinate system. After both load presence detectors confirm the grip, they establish the force reference for each component and compare the same component with the corresponding reference; when the same component on both sides deviates in the opposite direction from its respective reference and at least one side exceeds the allowable range, the shoulder joint module and elbow joint joint drive motor are adjusted when the force component is abnormal, and the wrist joint joint drive motor is adjusted when the torque component is abnormal, so that the corresponding component is restored to the allowable range; the main controller is also connected to the motor status sensor.
[0017] Compared with the prior art, the advantages of the present invention are as follows: This invention incorporates a floating shoulder stabilizing device between the torso assembly and the two robotic arm assemblies. A common-mode compensation assembly drives the floating load-bearing frame to move vertically relative to the fixed support frame, causing the two robotic arm assemblies to generate vertical compensation in the same direction. A differential-mode compensation assembly drives the central rotating shaft and differential rocker arm to rotate, which in turn drives the two shoulder sliders to generate vertical compensation in opposite directions via the transmission arm and connecting rod. This corresponds to the torso heave and tilt states generated during robot walking, respectively, and adjusts the overall and relative vertical positions of the two robotic arm assemblies. This reduces the transmission of torso movement to the load being carried by the arms, and improves the stability of the height and tilt posture of the carried load. Attached Figure Description
[0018] Figure 1 This is a schematic diagram of the overall structure of the humanoid robot of the present invention when it is carrying a load (standing state); Figure 2 This is a schematic diagram of the overall structure of the humanoid robot of the present invention when it is carrying a load (walking state); Figure 3 This is a schematic diagram of the internal structure of the thoracic cavity mounting frame of the present invention; Figure 4 This is a schematic diagram of the overall structure of the differential mode reducer, differential rocker arm and its auxiliary components for the humanoid robot of the present invention. Figure 5 This is a schematic diagram of the overall structure of the humanoid robot robotic arm assembly of the present invention; Figure 6 This is a complete control principle diagram of the humanoid robot of this invention.
[0019] Figure label: 100. Humanoid robot body; 110. Torso assembly; 120. Lower limbs; 121. Feet; 122. Lower limb joints; 200. Floating shoulder stabilizer; 300. Robotic arm assembly; 400. Status detection assembly; 500. Control assembly; 111. Torso skeleton; 112. Thoracic cavity mounting frame; 113. Waist connector; 201. Fixed support frame; 202. Common mode guide rail; 203. Common mode slider; 204. Floating load-bearing frame; 205. Upper stroke limiter; 206. Lower stroke limiter; 207. Torso connecting plate; 2 08. Fixed connector; 209. Central bearing housing; 210. Central pivot; 211. Differential rocker arm; 212. Transmission arm; 213. Connecting rod; 214. Ball joint; 215. Encoder; 216. Rocker arm angle sensor; 217. Shoulder vertical guide rail; 218. Shoulder elastic buffer; 219. Shoulder slider; 220. Shoulder mounting base; 221. Shoulder joint module; 222. Shoulder position sensor; 223. Shoulder upper limit stop; 224. Shoulder lower limit stop; 225. Connecting rod mounting part; 226. Common mode actuator connector 227. Common mode compensation assembly; 228. Common mode drive motor; 229. Common mode transmission screw; 230. Common mode nut seat; 231. Common mode elastic element; 232. Common mode damper; 233. Common mode preload seat; 234. Common mode displacement sensor; 235. Differential mode compensation assembly; 236. Differential mode servo motor; 237. Differential mode reducer; 301. Upper arm; 302. Elbow joint; 303. Forearm; 304. Wrist joint; 305. End effector; 306. Wrist six-dimensional force sensor; 307. Joint drive motor; 401. 402. Torso inertial sensor; 403. Foot contact sensor; 404. Foot pressure sensor; 405. Joint status sensor; 406. Motor status sensor; 407. Load posture sensor; 408. Visual inspection device; 509. Load presence detector; 500. Main controller; 501. Gait status acquisition module; 502. Torso posture estimation module; 503. Common mode compensation control module; 504. Differential mode compensation control module; 505. Load posture feedback module; 506. Arm internal force coordination module; 600. Load being transported. Detailed Implementation
[0020] To make the objectives, technical solutions, and advantages of this application clearer, the technical solutions of this application and how they solve the aforementioned technical problems will be clearly and completely described below with reference to specific embodiments and the accompanying drawings. Obviously, the described embodiments are only a part of the embodiments of this application, not all of them. All other embodiments obtained by those skilled in the art based on the embodiments of this application without creative effort are within the scope of protection of this application.
[0021] The technical solution of this application will be further described below with reference to the embodiments. It should be understood that the embodiments are used to illustrate this application and not to limit the scope of protection of this application. The following structural features, detection features and control features can be used in combination without contradiction.
[0022] For ease of description, the vertical direction is defined as the height of the humanoid robot when it is standing normally, the direction the humanoid robot is facing is defined as the front, the opposite direction is defined as the back, and the directions on both sides of the humanoid robot are defined as the left and right directions.
[0023] like Figure 1 and Figure 2 As shown, this embodiment provides a dual-arm load-bearing posture-stabilized humanoid robot, including a humanoid robot body 100. The humanoid robot body 100 includes a torso assembly 110, lower limbs 120 connected to the lower part of the torso assembly 110, and two robotic arm assemblies 300 respectively disposed on the left and right sides of the torso assembly 110. A floating shoulder stabilizing device 200 is provided between the upper part of the torso assembly 110 and the two robotic arm assemblies 300.
[0024] like Figure 3 and Figure 4 As shown, the floating shoulder stabilization device 200 includes a fixed support frame 201, which is fixedly connected to the torso assembly 110. Common mode guide rails 202 extending vertically are respectively provided on the left and right sides of the fixed support frame 201. Each common mode guide rail 202 is slidably fitted with a common mode slider 203. The two common mode sliders 203 are respectively fixed on the left and right sides of the floating support frame 204. Thus, when the two common mode sliders 203 move along the corresponding common mode guide rails 202, they drive the floating support frame 204 to move vertically relative to the fixed support frame 201.
[0025] The floating support frame 204 is provided with shoulder vertical guide rails 217 extending in the vertical direction on the left and right sides respectively. Each shoulder vertical guide rail 217 is slidably fitted with a shoulder slider 219. The two shoulder sliders 219 respectively support the corresponding robotic arm assembly 300. Therefore, when the floating support frame 204 moves along the two common mode guide rails 202, the two shoulder sliders 219 and the two robotic arm assemblies 300 supported by the two shoulder sliders 219 move synchronously in the vertical direction with the floating support frame 204.
[0026] like Figure 3 and Figure 4As shown, a central pivot 210 is provided in the middle of the floating support frame 204. The central pivot 210 extends along the front-back direction of the humanoid robot body 100 and is rotatably supported on the floating support frame 204. A differential rocker arm 211 is fixedly connected to the central pivot 210. The two sides of the differential rocker arm 211 are connected to the corresponding shoulder slider 219 through a transmission arm 212 and a connecting rod 213, respectively.
[0027] When the central rotating shaft 210 drives the differential rocker arm 211 to rotate, the two transmission arms 212 located on both sides of the axis of the central rotating shaft 210 generate vertical motion components in opposite directions, and respectively act on the corresponding shoulder sliders 219 through the corresponding connecting rods 213, causing one shoulder slider 219 to move upward along the corresponding shoulder vertical guide rail 217, and at the same time causing the other shoulder slider 219 to move downward along the corresponding shoulder vertical guide rail 217. When the central rotating shaft 210 rotates in opposite directions, the vertical movement directions of the two shoulder sliders 219 are exchanged accordingly.
[0028] like Figure 3 As shown, a common mode compensation assembly 227 is connected between the fixed support frame 201 and the floating support frame 204. The common mode compensation assembly 227 drives the floating support frame 204 to move vertically relative to the fixed support frame 201, so that the two shoulder sliders 219 and the two robotic arm assemblies 300 supported by the two shoulder sliders 219 move upward or downward synchronously. This synchronous vertical movement constitutes common mode vertical compensation.
[0029] like Figure 4 As shown, the central rotating shaft 210 is connected to the differential mode compensation assembly 235. The differential mode compensation assembly 235 drives the central rotating shaft 210 to rotate, and the central rotating shaft 210 drives the differential rocker arm 211 to rotate, causing the two shoulder sliders 219 to move in opposite vertical directions along the corresponding shoulder vertical guide rails 217. This reverse vertical movement constitutes differential mode vertical compensation. Thus, common mode vertical compensation changes the overall vertical position of the two robotic arm assemblies 300 relative to the torso assembly 110, and differential mode vertical compensation changes the relative vertical position between the two robotic arm assemblies 300.
[0030] like Figure 1 As shown, the torso assembly 110 includes a torso frame 111, a thoracic mounting frame 112 fixedly mounted on the torso frame 111, a waist connecting seat 113 provided at the lower part of the torso frame 111, the waist connecting seat 113 being connected to the lower limb 120, a torso connecting plate 207 provided on the fixed support frame 201, the torso connecting plate 207 being fixedly connected to the thoracic mounting frame 112 via a fixed connector 208, thereby the fixed support frame 201 being fixed relative to the thoracic mounting frame 112 via the torso connecting plate 207 and the fixed connector 208.
[0031] like Figure 3As shown, each common mold guide rail 202 is provided with an upper stroke limiter 205 at its upper end and a lower stroke limiter 206 at its lower end. When the floating support frame 204 moves upward along the common mold guide rail 202 to the upper boundary of the allowable stroke, the upper stroke limiter 205 restricts the corresponding common mold slider 203 from continuing to move upward. When the floating support frame 204 moves downward along the common mold guide rail 202 to the lower boundary of the allowable stroke, the lower stroke limiter 206 restricts the corresponding common mold slider 203 from continuing to move downward.
[0032] like Figure 3 As shown, a central bearing seat 209 is fixedly installed in the middle of the floating support frame 204. The central rotating shaft 210 is rotatably supported on the central bearing seat 209. The central rotating shaft 210 passes through the central bearing seat 209 in the front-back direction, so that the central rotating shaft 210 rotates only around its own axis relative to the central bearing seat 209.
[0033] like Figure 4 As shown, two shoulder vertical guide rails 217 are fixed to the left and right sides of the floating support frame 204 respectively. Each shoulder vertical guide rail 217 has a shoulder elastic buffer 218 at its lower end. When the corresponding shoulder slider 219 moves downward along the shoulder vertical guide rail 217 and approaches the lower stroke boundary, the shoulder elastic buffer 218 is subjected to the action of the corresponding shoulder slider 219 and generates elastic deformation, thereby reducing the mechanical impact generated when the shoulder slider 219 reaches the lower stroke boundary.
[0034] like Figure 3 As shown, a common mode actuator connection part 226 is fixedly provided at the lower part of the floating load frame 204. The common mode actuator connection part 226 is used to connect the common mode nut seat 230 in the common mode compensation assembly 227, so that the axial movement of the common mode nut seat 230 can be transmitted to the floating load frame 204.
[0035] like Figure 4 As shown, a differential rocker arm 211 is fixedly installed at the front end of the central rotating shaft 210. A transmission arm 212 is installed on both sides of the differential rocker arm 211. The two transmission arms 212 are located on both sides of the axis of the central rotating shaft 210 and rotate synchronously with the differential rocker arm 211.
[0036] like Figure 4 As shown, each transmission arm 212 is provided with a ball joint 214 at its end. Each ball joint 214 is connected to one end of the corresponding connecting rod 213. The other end of the corresponding connecting rod 213 is hinged to the corresponding shoulder slider 219. The ball joint 214 allows the corresponding connecting rod 213 to adjust its connection direction relative to the transmission arm 212 during the transmission of the differential rocker arm 211, so that the movement of the connecting rod 213 can be coordinated with the vertical movement of the shoulder slider 219 along the shoulder vertical guide rail 217.
[0037] like Figure 4 As shown, a coding component 215 that rotates synchronously with the central rotating shaft 210 is fixedly installed on the central rotating shaft 210, and a rocker arm angle sensor 216 is fixedly installed on the central bearing seat 209. The detection end of the rocker arm angle sensor 216 is arranged opposite to the rotation path of the coding component 215. When the central rotating shaft 210 rotates, the angular position of the coding component 215 relative to the rocker arm angle sensor 216 changes synchronously. The rocker arm angle sensor 216 obtains the actual rotation angle of the central rotating shaft 210 according to the position change of the coding component 215. Since the differential rocker arm 211 is fixedly connected to the central rotating shaft 210, the actual rotation angle of the central rotating shaft 210 corresponds to the actual rotation position of the differential rocker arm 211.
[0038] like Figure 5 As shown, each shoulder slider 219 is fixedly connected to a shoulder mounting base 220, and a shoulder joint module 221 is connected to the shoulder mounting base 220. The shoulder joint module 221 is used to connect to the corresponding robotic arm assembly 300. A connecting rod mounting part 225 is provided on the side of the shoulder slider 219 facing the middle of the floating support frame 204, and the corresponding connecting rod 213 is hinged to the connecting rod mounting part 225 through a pin.
[0039] like Figure 4 As shown, a shoulder position sensor 222 is provided between the shoulder slider 219 and the floating support frame 204. The fixed end of the shoulder position sensor 222 is connected to the floating support frame 204, and the detection end of the shoulder position sensor 222 is correspondingly provided to the shoulder slider 219. When the shoulder slider 219 moves along the shoulder vertical guide rail 217, the shoulder position sensor 222 detects the actual vertical position of the shoulder slider 219 relative to the floating support frame 204.
[0040] like Figure 4 As shown, each shoulder vertical guide rail 217 has a shoulder upper limit stop 223 at its upper end and a shoulder lower limit stop 224 at its lower end. When the shoulder slider 219 moves along the shoulder vertical guide rail 217 to the upper allowable position, the shoulder upper limit stop 223 restricts the shoulder slider 219 from moving upward. When the shoulder slider 219 moves to the lower allowable position, the shoulder lower limit stop 224 restricts the shoulder slider 219 from moving downward.
[0041] like Figure 3 As shown, the common mode compensation assembly 227 includes a common mode drive motor 228, which is fixedly mounted on a fixed support frame 201. The output end of the common mode drive motor 228 is connected to a common mode transmission screw 229, which is rotatably supported on the fixed support frame 201 in the vertical direction.
[0042] like Figure 3As shown, the common mode drive screw 229 is threadedly fitted with a common mode nut seat 230. The common mode nut seat 230 is fixedly connected to the common mode actuator connection part 226. When the common mode drive motor 228 drives the common mode drive screw 229 to rotate, the common mode nut seat 230 moves along the axial direction of the common mode drive screw 229 and drives the floating bearing frame 204 to move along the two common mode guide rails 202 through the common mode actuator connection part 226.
[0043] When the common mode drive motor 228 drives the common mode transmission screw 229 to rotate in the first rotation direction, the common mode nut seat 230 moves upward along the common mode transmission screw 229, and drives the floating bearing frame 204 to move upward along the common mode guide rail 202. When the common mode drive motor 228 drives the common mode transmission screw 229 to rotate in the opposite direction to the first rotation direction, the common mode nut seat 230 moves downward along the common mode transmission screw 229, and drives the floating bearing frame 204 to move downward along the common mode guide rail 202.
[0044] like Figure 3 As shown, a common mode elastic element 231 and a common mode damper 232 are arranged side by side below the floating load frame 204. One end of the common mode elastic element 231 is connected to the fixed support frame 201 through the common mode preload seat 233, and the other end of the common mode elastic element 231 is connected to the floating load frame 204.
[0045] like Figure 3 As shown, the common mode preload seat 233 is adjustablely positioned on the fixed support frame 201 along the axial direction of the common mode elastic member 231. When the position of the common mode preload seat 233 relative to the fixed support frame 201 is adjusted, the initial deformation of the common mode elastic member 231 changes accordingly, thereby changing the elastic support force applied by the common mode elastic member 231 to the floating support frame 204 when the floating support frame 204 is in the initial position.
[0046] like Figure 3 As shown, one end of the common mode damper 232 is connected to the fixed support frame 201, and the other end of the common mode damper 232 is connected to the floating support frame 204. When the floating support frame 204 moves rapidly relative to the fixed support frame 201, the common mode damper 232 dampens the relative movement between the floating support frame 204 and the fixed support frame 201, thereby suppressing the continuous reciprocating motion of the floating support frame 204 under the action of the common mode elastic element 231.
[0047] like Figure 3As shown, a common mode displacement sensor 234 is provided between the fixed support frame 201 and the floating load frame 204. The fixed end of the common mode displacement sensor 234 is connected to the fixed support frame 201, and the detection end of the common mode displacement sensor 234 is correspondingly provided with the floating load frame 204. When the floating load frame 204 moves along the common mode guide rail 202, the common mode displacement sensor 234 detects the actual vertical displacement of the floating load frame 204 relative to the fixed support frame 201.
[0048] like Figure 4 As shown, the differential mode compensation assembly 235 includes a differential mode servo motor 236, which is fixedly mounted on the floating support frame 204. The output end of the differential mode servo motor 236 is connected to the differential mode reducer 237, and the output end of the differential mode reducer 237 is coaxially connected to the central rotating shaft 210 to drive the central rotating shaft 210 to rotate.
[0049] When the differential mode servo motor 236 is working, the output rotation of the differential mode servo motor 236 is transmitted to the central rotating shaft 210 through the differential mode reducer 237, so that it rotates synchronously. The central rotating shaft 210 further drives the differential rocker arm 211 to rotate, and drives the two shoulder sliders 219 to move in opposite directions along the corresponding shoulder vertical guide rails 217 through the two transmission arms 212, the two ball joints 214 and the two connecting rods 213 respectively.
[0050] like Figure 5 As shown, the two robotic arm assemblies 300 adopt the same structure. Each robotic arm assembly 300 includes an upper arm 301. One end of the upper arm 301 is connected to the corresponding shoulder mounting base 220 through a shoulder joint module 221. The other end of the upper arm 301 is connected to the forearm 303 through an elbow joint 302. The forearm 303 is connected to the end effector 305 through a wrist joint 304.
[0051] like Figure 5 As shown, a wrist six-dimensional force sensor 306 is provided between the wrist joint 304 and the end effector 305. When the end effector 305 acts on the transported load 600, the wrist six-dimensional force sensor 306 detects the force and torque generated between the end effector 305 and the transported load 600.
[0052] The shoulder joint module 221, elbow joint 302 and wrist joint 304 are each equipped with a joint drive motor 307. Each joint drive motor 307 is connected to the corresponding shoulder joint module 221, elbow joint 302 and wrist joint 304 for transmission. When the corresponding joint drive motor 307 is running, it drives the corresponding shoulder joint module 221, elbow joint 302 or wrist joint 304 to rotate, thereby adjusting the posture of the corresponding robotic arm assembly 300.
[0053] like Figure 6As shown, the humanoid robot body 100 also includes a state detection assembly 400 and a control assembly 500. The state detection assembly 400 is communicatively connected to the control assembly 500. The state detection assembly 400 includes a torso inertial sensor 401, a foot contact sensor 402, a foot pressure sensor 403, a load posture sensor 406, a joint state sensor 404, a motor state sensor 405, a vision detection device 407, and a load presence detector 408.
[0054] like Figure 6 As shown, the torso inertial sensor 401 is disposed on the torso assembly 110. The torso inertial sensor 401 detects the vertical movement state and the left and right tilt state of the torso assembly 110 and sends the detection signal to the control assembly 500.
[0055] like Figure 1 and Figure 2 As shown, the lower limb 120 includes two feet 121 and a lower limb joint 122 disposed between the torso assembly 110 and the two feet 121. Each foot 121 is provided with a foot contact sensor 402 and a foot pressure sensor 403. The foot contact sensor 402 detects whether the corresponding foot 121 is in contact with the support surface, and the foot pressure sensor 403 detects the supporting effect between the corresponding foot 121 and the support surface.
[0056] At least one lower limb joint 122 is provided with a joint state sensor 404, which detects the movement state of the corresponding lower limb joint 122 and sends the corresponding detection signal to the control assembly 500.
[0057] Each joint drive motor 307 is equipped with a motor status sensor 405. The motor status sensor 405 detects the working status of the corresponding joint drive motor 307 and sends the corresponding detection signal to the main controller 501.
[0058] A load gripping area for accommodating the transported load 600 is formed between the two end effectors 305. At least one end effector 305 is provided with a load attitude sensor 406. The detection end of the load attitude sensor 406 faces the load gripping area between the two end effectors 305. The load attitude sensor 406 detects the attitude change of the transported load 600 located in the load gripping area relative to the end effector 305.
[0059] The humanoid robot body 100 is equipped with a vision inspection device 407. The detection area of the vision inspection device 407 covers the load handling area of the two robotic arm assemblies 300. The vision inspection device 407 acquires the spatial position and tilt state of the load being handled 600.
[0060] Each end effector 305 is equipped with a load presence detector 408, which detects whether the corresponding end effector 305 has formed a gripping state with the transported load 600. When both load presence detectors 408 detect that the corresponding end effector 305 has formed a gripping state with the transported load 600, it is determined that both end effectors 305 have completed gripping the transported load 600.
[0061] like Figure 6 As shown, the control assembly 500 includes a main controller 501, which is equipped with a gait state acquisition module 502, a torso posture estimation module 503, a common mode compensation control module 504, a differential mode compensation control module 505, a load posture feedback module 506, and a dual-arm internal force coordination module 507.
[0062] The gait state acquisition module 502 receives detection signals from the foot contact sensor 402, the foot pressure sensor 403 on the two feet 121, and the joint state sensor 404 at the lower limb joint 122.
[0063] When both foot contact sensors 402 detect that the corresponding foot 121 is in contact with the support surface, and both foot pressure sensors 403 detect that the corresponding foot 121 is bearing the support function, the gait state acquisition module 502 determines that the robot is in a bipedal support state.
[0064] When one foot contact sensor 402 detects that the corresponding foot 121 leaves the support surface, and the other foot contact sensor 402 detects that the corresponding foot 121 remains in contact with the support surface, and the foot pressure sensor 403 corresponding to the foot 121 that remains in contact detects the supporting effect, the gait state acquisition module 502, in conjunction with the lower limb joint 122 movement state detected by the joint state sensor 404, determines that the robot is in a single-leg support state.
[0065] When the foot contact sensor 402 corresponding to the foot 121 that has left the support surface detects the foot 121 contacting the support surface again, and the corresponding foot pressure sensor 403 detects the support action, the gait state acquisition module 502 determines that the robot has entered the footing state, and the gait state acquisition module 502 sends the determined robot gait state to the torso posture estimation module 503.
[0066] like Figure 6As shown, the torso posture estimation module 503 receives the triaxial acceleration and posture information output by the torso inertial sensor 401 and the robot gait state determined by the gait state acquisition module 502. The torso posture estimation module 503 uses the torso posture when the robot is standing normally and stably supported by both feet as the torso posture reference. Based on the posture information, it converts the triaxial acceleration to a body coordinate system with the robot's vertical direction as the vertical axis, and subtracts the gravity component along the vertical axis to obtain the linear acceleration in the vertical direction of the torso. Combining the robot gait state and the direction of change of the linear acceleration, it determines the torso heave state as upward, downward, or stable. The torso heave state is used to characterize the motion trend rather than determining the absolute vertical displacement of the torso through continuous integration. The torso posture estimation module 503 also compares the current left and right tilt posture with the torso posture reference, determining the torso tilt state as tilting to the left, tilting to the right, or stable.
[0067] The load attitude feedback module 506 receives detection signals from the load attitude sensor 406 and the vision inspection device 407. After both load presence detectors 408 confirm that the corresponding end effector 305 has formed a gripping state with the transported load 600, the main controller 501 records the center height of the transported load 600 detected by the vision inspection device 407 at that moment as the initial height state, and records the tilt state of the transported load 600 detected by the load attitude sensor 406 at that moment as the initial tilt state. The initial height state and the initial tilt state form the load attitude reference.
[0068] like Figure 6 As shown, the load attitude feedback module 506, based on the detection results of the load attitude sensor 406 and the vision inspection device 407 at the same sampling time, compares the center height of the transported load 600 subsequently detected by the vision inspection device 407 with the initial height state in the load attitude reference to obtain the load height deviation; it also compares the tilt state of the transported load 600 subsequently detected by the load attitude sensor 406 with the initial tilt state in the load attitude reference to obtain the load tilt deviation. Simultaneously, the vision inspection device 407 verifies the tilt direction of the transported load 600. When the tilt direction determined by the vision inspection device 407 is inconsistent with the tilt direction determined by the load attitude sensor 406, the load attitude feedback module 506 marks the load tilt data at that sampling time as invalid and stops using the data for differential compensation until both re-obtain a consistent tilt direction.
[0069] The common-mode compensation control module 504 receives the torso rise and fall state determined by the torso posture estimation module 503, the detection signal from the foot pressure sensor 403, and the load height deviation determined by the load posture feedback module 506.
[0070] The common-mode compensation control module 504 uses the load height deviation as the basis for closed-loop correction and the torso heave state as the basis for feedforward compensation. The main controller 501 sets the allowable height deviation range based on the load attitude reference. When the load height deviation exceeds the allowable range, the common-mode compensation control module 504 determines the common-mode compensation direction according to the height recovery direction indicated by the load height deviation. When the load height deviation is within the allowable range, the common-mode compensation control module 504 determines the common-mode compensation direction according to the torso heave state. When the torso heave state is opposite to the compensation direction corresponding to the load height deviation and the load height deviation has exceeded the allowable range, the compensation direction corresponding to the load height deviation takes priority. When the load height deviation is within the allowable range and the torso heave state is stable, the common-mode compensation is stopped.
[0071] When downward compensation is required according to the above rules, the common mode compensation control module 504 outputs a common mode compensation control signal to the common mode compensation assembly 227 to move the floating support frame 204 downward; when upward compensation is required according to the above rules, the common mode compensation control module 504 outputs a common mode compensation control signal to the common mode compensation assembly 227 to move the floating support frame 204 upward.
[0072] The common mode drive motor 228 drives the common mode transmission screw 229 to rotate according to the common mode compensation control signal. The common mode nut seat 230 moves along the common mode transmission screw 229 and drives the floating bearing frame 204 to move along the two common mode guide rails 202 through the common mode actuator connection part 226. The floating bearing frame 204 further drives the two shoulder sliders 219 and the two robotic arm assemblies 300 supported by the two shoulder sliders 219 to move synchronously upward or downward, so as to realize the common mode vertical compensation.
[0073] When the foot pressure sensor 403 detects the change in support caused by the foot 121 landing, the common mode compensation control module 504 adjusts the common mode compensation control signal in combination with the change in support. At the same time, the common mode elastic element 231 provides elastic support to the floating support frame 204, and the common mode damper 232 dampens the rapid movement of the floating support frame 204 relative to the fixed support frame 201, thereby reducing the vertical impact of the foot 121 landing on the floating support frame 204 and the two robotic arm assemblies 300.
[0074] The differential mode compensation control module 505 receives the torso tilt state determined by the torso posture estimation module 503 and the load tilt deviation determined by the load posture feedback module 506, respectively.
[0075] The differential mode compensation control module 505 uses the load tilt deviation as the closed-loop correction basis and the torso tilt state as the feedforward compensation basis. The main controller 501 sets the allowable tilt deviation range according to the load attitude reference; when the load tilt deviation exceeds the allowable tilt deviation range, the differential mode compensation control module 505 determines the differential mode compensation direction in the direction that reduces the load tilt deviation; when the load tilt deviation is within the allowable tilt deviation range, the differential mode compensation control module 505 determines the differential mode compensation direction in the direction that counteracts the relative vertical position change of the two robotic arm assemblies 300 caused by the torso tilt; when the torso tilt state is opposite to the compensation direction corresponding to the load tilt deviation and the load tilt deviation has exceeded the allowable tilt deviation range, the compensation direction corresponding to the load tilt deviation takes priority; when the load tilt deviation is within the allowable tilt deviation range and the torso tilt state is stable, the differential mode compensation is stopped from expanding further.
[0076] When it is determined according to the above rules that the left shoulder slider 219 needs to move upward and the right shoulder slider 219 needs to move downward, the differential mode compensation control module 505 outputs a differential mode compensation control signal in the corresponding direction to the differential mode compensation assembly 235, so that the differential mode servo motor 236 drives the central rotating shaft 210 to rotate via the differential mode reducer 237, and through the differential rocker arm 211, two transmission arms 212 and two connecting rods 213, the left shoulder slider 219 moves upward and the right shoulder slider 219 moves downward.
[0077] When it is determined according to the above rules that the right shoulder slider 219 needs to be moved upward and the left shoulder slider 219 needs to be moved downward, the differential mode compensation control module 505 controls the differential mode servo motor 236 to run in the opposite direction, so that the right shoulder slider 219 moves upward and the left shoulder slider 219 moves downward.
[0078] like Figure 6 As shown, the differential mode compensation control module 505 also receives the actual rotation angle of the central axis 210 detected by the rocker arm angle sensor 216. The main controller 501 pre-stores the allowable rotation angle range of the central axis 210 corresponding to the allowable stroke of the shoulder slider 219 defined by the upper shoulder limiter 223 and the lower shoulder limiter 224. During the differential mode compensation control process, regardless of whether the torso tilt state and the load tilt deviation are consistent, the allowable rotation angle range of the central axis 210 is used as the limiting condition for differential mode compensation. When the actual rotation angle of the central axis 210 detected by the rocker arm angle sensor 216 reaches the corresponding boundary of the allowable rotation angle range, the differential mode compensation control module 505 stops continuing to expand the differential mode compensation along the rotation direction.
[0079] The dual-arm internal force coordination module 507 receives the detection results from the two wrist six-dimensional force sensors 306 respectively, and communicates with the corresponding joint drive motors 307 in the two robotic arm assemblies 300.
[0080] After both load presence detectors 408 detect that the corresponding end effector 305 has formed a gripping state with the transported load 600, the main controller 501 uses the direction of the line connecting the two end effectors 305 as the first direction of the load coordinate system, the robot's vertical direction as the second direction of the load coordinate system, and determines the third direction according to the right-hand rule. It then transforms the three force components and three torque components detected by the two wrist six-dimensional force sensors 306 to the same load coordinate system. The main controller 501 records the six components of the two wrist six-dimensional force sensors 306 in the load coordinate system when the dual-arm gripping is completed, using them as the force references for the corresponding sides of the dual arms. The two wrist six-dimensional force sensors 306 subsequently continue to detect the force and torque between the corresponding end effector 305 and the transported load 600.
[0081] like Figure 6 As shown, the dual-arm internal force coordination module 507 compares the six components subsequently detected by the two wrist six-dimensional force sensors 306 with the same component in the corresponding dual-arm force reference, and sets an allowable force deviation range for each component. When the same component exceeds the corresponding allowable force deviation range on one side and deviates from the corresponding dual-arm force reference in the opposite direction on the other side, it is determined that there is a lack of coordination in the dual-arm force. For the force component, the dual-arm internal force coordination module 507 prioritizes adjusting the joint drive motors 307 corresponding to the shoulder joint module 221 and the elbow joint 302 to restore the corresponding force components on both sides to their respective dual-arm force references. For the torque component, it prioritizes adjusting the joint drive motor 307 corresponding to the wrist joint 304 to restore the corresponding torque components on both sides to their respective dual-arm force references. When the corresponding component re-enters the allowable force deviation range, the coordination adjustment of that component stops. When the motor status sensor 405 detects an abnormality in the corresponding joint drive motor 307 or the corresponding joint reaches the allowable range of motion, the adjustment along that direction stops.
[0082] like Figure 6 As shown, the main controller 501 also receives detection signals from the motor status sensor 405 and the two load presence detectors 408. Only when both load presence detectors 408 confirm that the corresponding end effector 305 has formed a gripping state with the transported load 600, the main controller 501 allows the common mode compensation control module 504, differential mode compensation control module 505, load attitude feedback module 506, and dual-arm internal force coordination module 507 to execute the corresponding load attitude stabilization control; if any load presence detector 408 fails to confirm that the corresponding end effector 305 has formed a gripping state, the dual-arm force reference is not established, and the dual-arm internal force coordination is stopped.
[0083] When the robot performs a handling task, the two robotic arm assemblies 300 drive the shoulder joint module 221, elbow joint 302, and wrist joint 304 to rotate via corresponding joint drive motors 307, thereby moving the two end effectors 305 to the corresponding gripping positions of the load 600 being handled. After the two end effectors 305 have completed their gripping, the corresponding load presence detectors 408 send a load presence signal to the main controller 501; upon receiving the load presence signals from the two load presence detectors 408, the main controller 501 confirms that the dual-arm gripping state is established.
[0084] During robot walking, the gait state acquisition module 502 determines the robot's gait state based on the detection signals from the foot contact sensor 402, foot pressure sensor 403, and joint state sensor 404. The torso posture estimation module 503 determines the torso rise and fall state and the torso tilt state based on the detection signal from the torso inertial sensor 401 and the robot's gait state. The load posture feedback module 506 determines the load height deviation and load tilt deviation based on the detection signals from the load posture sensor 406 and the vision detection device 407.
[0085] like Figure 6 As shown, the common mode compensation control module 504 controls the common mode compensation assembly 227 based on the torso's rise and fall status, the detection signal from the foot pressure sensor 403, and the load height deviation. The common mode compensation assembly 227 drives the floating support frame 204 to move along the two common mode guide rails 202, causing the two robotic arm assemblies 300 to move vertically in the same direction along with the floating support frame 204.
[0086] The differential mode compensation control module 505 controls the differential mode compensation assembly 235 according to the torso tilt state and load tilt deviation. The differential mode compensation assembly 235 drives the central rotating shaft 210 and the differential rocker arm 211 to rotate, and drives the two shoulder sliders 219 to move in the opposite direction along the corresponding shoulder vertical guide rail 217 through the two transmission arms 212 and the two connecting rods 213.
[0087] When both the torso rise and fall state and the torso tilt state exist simultaneously, the common mode compensation assembly 227 drives the floating support frame 204 to move vertically relative to the fixed support frame 201, while the differential mode compensation assembly 235 drives the two shoulder sliders 219 to move in opposite vertical directions relative to the floating support frame 204. The two robotic arm assemblies 300 move with the corresponding shoulder sliders 219, thereby simultaneously receiving common mode vertical compensation and differential mode vertical compensation.
[0088] Through the above structure, the common mode compensation assembly 227 uses the vertical movement of the floating bearing frame 204 relative to the fixed support frame 201 to make the two robotic arm assemblies 300 form vertical compensation in the same direction. The differential mode compensation assembly 235 uses the motion transmission between the central rotating shaft 210, the differential rocker arm 211, the transmission arm 212, the connecting rod 213 and the shoulder slider 219 to make the two robotic arm assemblies 300 form vertical compensation in opposite directions. The load posture feedback module 506 uses the load height deviation and the load tilt deviation to provide feedback and adjustment for the common mode vertical compensation and the differential mode vertical compensation, respectively. The dual-arm internal force coordination module 507 adjusts the driving state of the corresponding joint drive motor 307 according to the detection results of the two wrist six-dimensional force sensors 306, thereby maintaining the posture stability of the load 600 being transported during the robot's dual-arm handling process.
[0089] The embodiments and descriptions above are merely illustrative of the principles and preferred embodiments of this application. Various changes and modifications may be made to this application without departing from the spirit and scope thereof, and all such changes and modifications fall within the scope of this application as claimed.
Claims
1. A dual-arm load posture stabilization humanoid robot, comprising a humanoid robot body (100), the humanoid robot body (100) comprising a trunk assembly (110), lower limbs (120) connected to a lower part of the trunk assembly (110), and two mechanical arm assemblies (300) respectively arranged on left and right sides, characterized in that, A floating shoulder stabilizing device (200) is provided between the upper part of the torso assembly (110) and the two robotic arm assemblies (300). The floating shoulder stabilizing device (200) includes a fixed support frame (201) fixedly connected to the torso assembly (110). Common mode guide rails (202) extending vertically are provided on the left and right sides of the fixed support frame (201). Each common mode guide rail (202) is slidably fitted with a common mode slider (203). The two common mode sliders (203) are... The left and right sides of the floating support frame (204) are respectively fixed. The left and right sides of the floating support frame (204) are respectively provided with shoulder vertical guide rails (217). Each shoulder vertical guide rail (217) is slidably fitted with a shoulder slider (219). The two shoulder sliders (219) respectively support the corresponding robotic arm assembly (300). The floating support frame (204) is rotatably supported by a central rotating shaft (210) extending in the front-back direction. The central rotating shaft (210) is fixedly connected to the differential rocker arm. (211) Transmission arms (212) are formed on both sides of the differential rocker arm (211). The transmission arms (212) are connected to the corresponding shoulder sliders (219) through connecting rods (213). A common mode compensation assembly (227) is connected between the fixed support frame (201) and the floating support frame (204). The common mode compensation assembly (227) drives the floating support frame (204) to move up and down along the common mode guide rail (202) to drive the two shoulder sliders (219) and the corresponding robotic arms. The assembly (300) generates a vertical displacement in the same direction to achieve common mode vertical compensation; the central rotating shaft (210) is connected to the differential mode compensation assembly (235) for transmission. The differential mode compensation assembly (235) drives the differential rocker arm (211) to rotate, and through the two side transmission arms (212) and connecting rod (213), it drives the two shoulder sliders (219) to move in the opposite direction along the corresponding shoulder vertical guide rail (217) so that the two mechanical arm assemblies (300) generate a vertical displacement in the opposite direction to achieve differential mode vertical compensation.
2. The dual-arm load-bearing, attitude-stabilized humanoid robot according to claim 1, characterized in that, The torso assembly (110) includes a torso frame (111), a thoracic mounting frame (112) is fixed on the torso frame (111), a waist connecting seat (113) connected to the lower limb (120) is provided at the lower part of the torso frame (111), a torso connecting plate (207) is provided on the fixed support frame (201), the torso connecting plate (207) is fixedly connected to the thoracic mounting frame (112) through a fixed connector (208), and each common mode guide rail (202) is provided with an upper stroke limiter (205) at the upper end and a lower stroke limiter (206) at the lower end.
3. The dual-arm load-bearing, attitude-stabilized humanoid robot according to claim 2, characterized in that, A central bearing seat (209) is fixed in the middle of the floating support frame (204), and the central rotating shaft (210) is rotatably supported on the central bearing seat (209). Two shoulder vertical guide rails (217) are fixed on the left and right sides of the floating support frame (204) respectively. Each shoulder vertical guide rail (217) is provided with a shoulder elastic buffer (218) at its lower end. A common mode actuator connection part (226) connected to the common mode compensation assembly (227) is fixed at the lower part of the floating support frame (204).
4. A dual-arm load-bearing, attitude-stabilized humanoid robot according to claim 3, characterized in that, A differential rocker arm (211) is fixed at the front end of the central rotating shaft (210). A transmission arm (212) is provided on both sides of the differential rocker arm (211). A ball joint (214) is provided at the end of each transmission arm (212). The ball joint (214) is connected to one end of the corresponding connecting rod (213). The other end of the connecting rod (213) is hinged to the corresponding shoulder slider (219). The two transmission arms (212) are respectively located on both sides of the axis of the central rotating shaft (210). An encoder (215) is fixed on the central rotating shaft (210) and rotates synchronously with it. A rocker arm angle sensor (216) is fixed on the central bearing seat (209). The detection end of the rocker arm angle sensor (216) is opposite to the rotation path of the encoder (215).
5. A dual-arm load-bearing, attitude-stabilized humanoid robot according to claim 4, characterized in that, Each of the shoulder sliders (219) is fixedly connected to a shoulder mounting base (220). The shoulder slider (219) has a connecting rod mounting part (225) on the side facing the middle of the floating support frame (204). The corresponding connecting rod (213) is hinged to the connecting rod mounting part (225) through a pin. A shoulder position sensor (222) is provided between the shoulder slider (219) and the floating support frame (204). The fixed end of the shoulder position sensor (222) is connected to the floating support frame (204), and the detection end is correspondingly set to the shoulder slider (219). The upper end of the corresponding shoulder vertical guide rail (217) is provided with a shoulder upper limit member (223), and the lower end is provided with a shoulder lower limit member (224).
6. A dual-arm load-bearing, attitude-stabilized humanoid robot according to claim 3, characterized in that, The common mode compensation assembly (227) includes a common mode drive motor (228) fixedly mounted on a fixed support frame (201). The output end of the common mode drive motor (228) is connected to a common mode drive screw (229) that is rotatably supported on the fixed support frame (201) in the vertical direction. The common mode drive screw (229) is threadedly fitted with a common mode nut seat (230). The common mode nut seat (230) is fixedly connected to the common mode actuator connection part (226) and moves along its axial direction when the common mode drive screw (229) rotates, so as to drive the floating bearing frame (204) to move up and down along the common mode guide rail (202) through the common mode actuator connection part (226). A common mode elastic element (231) is arranged in parallel below the floating bearing frame (204). The common mode elastic element (231) is connected to the fixed support frame (201) through the common mode preload seat (233) and the other end is connected to the floating load frame (204). The common mode preload seat (233) is adjustablely positioned on the fixed support frame (201) along the axial direction of the common mode elastic element (231). One end of the common mode damper (232) is connected to the fixed support frame (201) and the other end is connected to the floating load frame (204). A common mode displacement sensor (234) is provided between the fixed support frame (201) and the floating load frame (204). The fixed end of the common mode displacement sensor (234) is connected to the fixed support frame (201), and the detection end is correspondingly set to the floating load frame (204).
7. A dual-arm load-bearing, attitude-stabilized humanoid robot according to claim 4, characterized in that, The differential mode compensation assembly (235) includes a differential mode servo motor (236) and a differential mode reducer (237) fixedly mounted on the floating support frame (204). The output end of the differential mode servo motor (236) is connected to the input end of the differential mode reducer (237) for transmission. The output end of the differential mode reducer (237) is coaxially connected to the central rotating shaft (210) for transmission, so as to drive the central rotating shaft (210) to rotate.
8. A dual-arm load-bearing, attitude-stabilized humanoid robot according to claim 5, characterized in that, Each of the robotic arm assemblies (300) includes an upper arm (301), one end of which is connected to a corresponding shoulder mount (220) via a shoulder joint module (221), and the other end is connected to a forearm (303) via an elbow joint (302). The forearm (303) is connected to an end effector (305) via a wrist joint (304). A wrist six-dimensional force sensor (306) is provided between the wrist joint (304) and the end effector (305). Each of the shoulder joint module (221), elbow joint (302) and wrist joint (304) is provided with a joint drive motor (307). Each of the joint drive motors (307) is connected to the corresponding shoulder joint module (221), elbow joint (302) and wrist joint (304) respectively to drive the corresponding joint to rotate.
9. A dual-arm load-bearing, attitude-stabilized humanoid robot according to claim 8, characterized in that, The humanoid robot body (100) further includes a state detection assembly (400) and a control assembly (500), the state detection assembly (400) and the control assembly (500) being communicatively connected. The torso assembly (110) is provided with a torso inertial sensor (401). The lower limbs (120) include two feet (121) and a lower limb joint (122) disposed between the torso assembly (110) and the two feet (121). Each foot (121) is provided with a foot contact sensor (402) and a foot pressure sensor (403), at least A joint state sensor (404) is provided at one of the lower limb joints (122), and a motor state sensor (405) is provided at each of the joint drive motors (307). At least one of the end effectors (305) is provided with a load posture sensor (406). The detection end of the load posture sensor (406) faces the load gripping area between the two end effectors (305). The humanoid robot body (100) is provided with a vision detection device (407), and each of the end effectors (305) is provided with a load presence detector (408).
10. A dual-arm load-bearing, attitude-stabilized humanoid robot according to claim 9, characterized in that, The main controller (501) of the control assembly (500) is equipped with a gait state acquisition module (502), a trunk posture estimation module (503), a common-mode compensation control module (504), a differential-mode compensation control module (505), a load posture feedback module (506), and a dual-arm internal force coordination module (507). The gait state acquisition module (502) determines the gait state based on the foot contact sensor (402), the foot pressure sensor (403), and the joint state sensor (404). The trunk posture estimation module (503) determines the trunk heave state and trunk tilt state based on the trunk inertial sensor (401) and the gait state. The load posture feedback module (506) determines the load height deviation and load tilt deviation based on the load posture sensor (406) and the visual detection device (407). The common-mode compensation control module (504) controls the common-mode compensation assembly (227) to perform operations based on the trunk heave state, the foot pressure sensor (403), and the load height deviation. In the same direction of vertical compensation, the differential mode compensation control module (505) controls the differential mode compensation assembly (235) to perform reverse vertical compensation based on the torso tilt state and load tilt deviation, and limits the differential mode compensation range based on the rotation angle of the central shaft (210) detected by the rocker arm angle sensor (216); the dual arm internal force coordination module (507) unifies the force and torque components of the two wrist six-dimensional force sensors (306) to the load coordinate system, and establishes the force reference of each component after both load presence detectors (408) confirm the gripping, and compares the same component with the corresponding reference; when the same component on both sides deviates in the opposite direction from its respective reference and at least one side exceeds the allowable range, the joint drive motor (307) of the shoulder joint module (221) and elbow joint (302) is adjusted when the force component is abnormal, and the joint drive motor (307) of the wrist joint (304) is adjusted when the torque component is abnormal, so that the corresponding component is restored to the allowable range; the main controller (501) is also connected to the motor status sensor (405) for communication.
