Height-variable and foot wheel conversion humanoid robot mechanism and information processing control method
Through the multiplexed structure of variable height, foot wheel conversion mechanism and knee drive motor, the height adjustment and motion mode switching of the humanoid robot are realized, solving the stability and safety of the humanoid robot in complex environments, and improving high-speed movement and obstacle-over-blocking ability reduces system complexity and weight.
Patent Information
- Application Number
- CN202411220081.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-02
- Publication Date
- 2024-11-08
- Estimated Expiration
- 2044-09-02
AI Technical Summary
The existing humanoid robots have low stability and safety in high-speed movement and complex environments, making it difficult to achieve high-speed motion and obstacle-resistance functions, and the increase in driving wheels leads to increased weight and complexity.
Using a humanoid robot mechanism for variable height and foot wheel conversion, the height adjustment mechanism and foot wheel conversion mechanism realize the active control of the robot height and the quick switching of the motion mode. Combined with the multiplexed structure of the knee joint drive motor and the elbow joint drive motor, the The coupling and switching of foot and wheel motion reduces system complexity and weight.
It improves the information perception and movement capabilities of humanoid robots, realizes flexible detection and high-speed motion in complex environments, reduces energy consumption and weight, and simplifies the control system.
Smart Images

Figure CN118907260A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the fields of intelligent robots, artificial intelligence, new generation information technology and bionic mechanisms, and specifically to a humanoid robot mechanism with variable height and wheel-foot conversion and an information processing control method. Background Art
[0002] Humanoid robots have bipedal movement, biarm operation, and multimodal perception functions of vision, hearing, force and touch, just like humans, and can move and operate in typical indoor environments such as flat ground and stairs. However, due to the high center of gravity of humanoid robots, their safe and stable movement requires extremely high control requirements, and it is difficult to achieve high-speed movement functions, especially when there are small obstacles on the ground. Slipping will cause the humanoid robot to fall and be damaged.
[0003] In order to increase the movement speed of humanoid robots, researchers have added wheels or tracks to humanoid robots.
[0004] For example, invention patent CN201580020076.3 discloses an omnidirectional wheeled humanoid robot, which has the advantages of wheeled motion, but cannot cross obstacles like footed motion. Utility model patent CN201720886723.5 discloses a device that can switch the motion mode of a humanoid robot, which drives the roller to rotate relative to the bottom plate by rotating the power part, so that the robot can switch between low-speed and high-speed modes, but cannot complete footed motion.
[0005] Invention patent CN201810650307.4 discloses a wheeled humanoid robot with two wheels on its feet. The whole robot is similar to a balance car, but it is difficult to perform bipedal obstacle traversal. Invention patent CN201910562329.X also discloses a wheel-legged humanoid robot that can move on wheels but is also unable to perform foot-based obstacle traversal. Invention patent CN201510443721.4 discloses a wheeled humanoid robot and a working method. The robot achieves wheeled walking by arranging driving wheels and driven wheels on the outside of the legs, and the driving wheels are driven by motors. This solution separates the wheeled and foot-based motion drives, but requires additional drive motors to achieve wheeled motion, which increases the complexity and weight of the robot.
[0006] Utility model patent CN201621145118.4 discloses a deformable humanoid robot, which can change from humanoid walking to car-like moving forward by setting a driving wheel on the back of the robot, a front support wheel on the front of the forearm, and a support wheel on the back of the calf. However, the robot has only one back driving wheel as an active driving wheel, and the driving performance of wheeled motion is limited, and the driving wheel also needs an additional driving motor to drive. Invention patent CN201710565178.4 discloses a foot-shoe composite humanoid robot, whose two feet are two track wheels, which can realize tracked motion and footed motion, but the track wheels need to be driven independently, and the track wheels are heavy, which results in high energy consumption of the robot's footed motion.
[0007] Utility model patent CN201820492346.1 discloses a wheel-legged humanoid robot, whose feet include a foot base and a roller skate module, which can realize two kinds of movements: foot walking and wheel rolling. However, the roller skate structure causes the robot's feet to have a large mass, resulting in high energy consumption during foot movement. In addition, due to the high center of gravity of the humanoid robot, the solution of having wheels on the soles of the feet makes it impossible to achieve high-speed movement during wheel rolling.
[0008] In addition, some researchers have also carried out the design of humanoid robot torso telescopic devices. For example, utility model patent CN201720183258.9 discloses a robot torso telescopic device, which uses a worm gear screw lift to achieve rapid and smooth telescopic movement of the robot torso. However, the worm gear screw mechanism is bulky, which greatly increases the mass of the robot.
[0009] Utility model patent CN202021215261.2 also discloses a humanoid robot structure for adjusting height, which adjusts the height of the robot body through a screw nut mechanism, but the mechanism is complex and heavy. In addition, the operation control of humanoid robots in complex environments is also very important. For example, invention patent CN202210737033.9 discloses a robot and operation method based on multimodal fusion in a complex and restricted environment, but the robot cannot walk with feet, and the information processing method does not involve information collection and control during the switching process between foot-style and leg-style movements of the robot.
[0010] In addition, the current research on humanoid robots mainly focuses on mechanism design, motion control and environmental perception, and there are not many applications in the field of inspection operations. Humanoid robots, like humans, have a higher height than wheeled and quadruped robots, and are suitable for tasks such as power inspection. However, the higher the height of the humanoid robot, the higher its center of gravity, and the lower the stability and safety of its movement. In view of the problems faced by current humanoid robots in inspection operations, such as low movement speed, increased weight and complexity caused by adding driving wheels, and low movement stability and safety caused by the high center of gravity of humanoid robots, the present invention proposes a humanoid inspection robot with variable height and foot-wheel multi-mode movement and a control method, the robot adopts a height adjustment mechanism to realize the height adjustment of the sensor unit in space, so as to meet the function of detecting instruments and power equipment in a wide range and at multiple angles, and reduces the height and weight of the robot body, adopts a foot-wheel conversion mechanism to realize the rapid switching between bipedal walking movement and four-wheel wheeled movement, balances the obstacle crossing and high-speed movement requirements of humanoid robots under different terrains, and has the advantages of simple mechanism, light weight and simple control. Summary of the invention
[0011] In order to solve the above technical problems, the present invention proposes a humanoid robot mechanism with variable height and foot-wheel conversion and an information processing control method, which can realize active height control and foot-wheel motion switching, and improve the information perception, obstacle surmounting and motion capabilities of the humanoid robot.
[0012] To achieve the above object, the technical solution adopted by the present invention is: The humanoid robot body structure is composed of a body, legs, feet, arms, a height adjustment mechanism, a sensor unit and a control system. The legs, feet and arms are installed on the body. The legs include a left leg and a right leg. The feet include a left foot and a right foot. The arms include a left arm and a right arm. The left leg and the right leg have the same structure and are symmetrical with respect to the body. The left foot and the right foot have the same structure and are symmetrical with respect to the body. The structure reuses the knee joint drive motor and the elbow joint drive motor of the bipedal motion mechanism of the humanoid robot to realize the coupling and switching of the foot-type and wheel-type motions. The height adjustment mechanism is composed of a contraction mechanism and a rotation mechanism. The rotation mechanism drives the contraction mechanism to rotate 360 degrees relative to the body to achieve folding, stowing and unfolding through the contraction mechanism.
[0013] As a further improvement of the humanoid robot body structure of the present invention, the leg and foot mechanisms of the structure reused with the knee joint drive motor and elbow joint drive motor of the bipedal motion mechanism of the humanoid robot are specifically as follows; The left leg and the right leg are both composed of a side-swing drive motor, a direction adjustment motor seat, a direction adjustment motor, a hip joint motor seat, a hip joint motor, a thigh frame, a knee joint drive motor, a knee joint connecting rod 1, a knee joint connecting rod 2, a calf frame, an ankle joint drive motor, a leg coupling, a leg electromagnetic clutch, a leg wheel, an ankle joint connecting rod 1 and an ankle joint connecting rod 2; the side-swing drive motor is fixed to the lower end of the body, the direction adjustment motor seat is fixed to the side-swing drive motor output shaft, the direction adjustment motor is fixed to the direction adjustment motor seat, the hip joint motor seat is fixed to the direction adjustment motor output shaft, the hip joint motor is fixed to the hip joint motor seat, the upper end of the thigh frame is fixed to the hip joint motor output shaft, the knee joint drive motor is fixed to the thigh frame, the hip joint motor is on the inner side of the thigh frame, the knee joint drive motor is placed on the outer side of the thigh frame, and the knee joint connecting rod One end of the knee joint connecting rod is fixed on the output shaft of the knee joint driving motor, the other end of the knee joint connecting rod one is connected to the knee joint connecting rod two by a rotating pair, the other end of the knee joint connecting rod two is connected to the top of the calf frame by a rotating pair, a rotating shaft hole is provided below the top of the calf frame, and is connected to the bottom end of the thigh frame by a rotating pair, the bottom end of the calf frame is connected to the middle part of the foot by a rotating pair, the ankle joint driving motor is fixed on the inner side of the calf frame, located below the rotating pair of the thigh frame and the calf frame, the leg coupling is fixed on the output shaft of the ankle joint driving motor, the moving disk of the leg electromagnetic clutch is fixed on the leg coupling, the leg wheel is sleeved on the outer ring of the moving disk of the leg electromagnetic clutch and fixed, one end of the ankle joint connecting rod one is fixed to the bottom plate of the leg electromagnetic clutch, the other end of the ankle joint connecting rod one is connected to the ankle joint connecting rod two by a rotating pair, and the other end of the ankle joint connecting rod two is connected to the root of the foot by a rotating pair.
[0014] As a further improvement of the humanoid robot body structure of the present invention, the arm mechanism of the structure reused with the knee joint drive motor and the elbow joint drive motor of the bipedal motion mechanism of the humanoid robot is specifically as follows; The left arm and the right arm each include an abduction drive motor, an upward lifting drive motor seat, an upward lifting drive motor, a large arm, an elbow joint drive motor, an arm coupling, an arm electromagnetic clutch, an arm wheel, a large arm and a small arm connecting piece and a small arm. The abduction drive motor is fixed to the shoulder of the trunk, the upward lifting drive motor seat is fixed to the abduction drive motor output shaft, the upward lifting drive motor is fixed to the upward lifting drive motor seat, the upper end of the large arm is fixed to the output shaft of the upward lifting drive motor, the elbow joint drive motor is fixed to the bottom end of the large arm, the arm coupling is fixed to the output shaft of the elbow joint drive motor, the moving plate of the arm electromagnetic clutch is fixed to the arm coupling, the arm wheel is sleeved on the outer ring of the moving plate of the arm electromagnetic clutch and fixed, the large arm and a small arm connecting piece is fixed to the bottom plate of the arm electromagnetic clutch, and the small arm is fixed to the large arm and a small arm connecting piece.
[0015] As a further improvement of the body structure of the humanoid robot of the present invention, the retracting mechanism of the height adjustment mechanism includes an origami structure, a torsion spring, a folding motor, a winch, a base, a top seat and a pull rope, the origami structure is softly connected by at least two triangular carbon fiber plates through adhesive tape, the torsion spring includes at least two, the rotation axis of the torsion spring is coaxial with the movable edge connected to the adjacent upper triangular carbon fiber plate and the lower triangular carbon fiber plate, one of the force arms is fixed on the upper triangular carbon fiber sheet, and the other force arm is fixed on the lower triangular carbon fiber sheet, the folding motor is fixed on the base, the winch is fixed on the output shaft of the folding motor, the bottom end of the origami structure is fixed on the base, the top seat is fixed on the top of the origami structure, and the pull rope includes two, one end of which is fixed on the top seat, and the other end passes through the triangular carbon fiber plate of the origami structure and is fixed on the winch; The rotating mechanism of the height adjustment mechanism comprises a rotating motor and a rotating motor seat, wherein the rotating motor is fixed on the rotating motor seat, and the rotating motor seat is fixed on the top of the body; the base of the contraction mechanism is fixed on the output shaft of the rotating motor.
[0016] As a further improvement to the body structure of the humanoid robot of the present invention, the sensor unit includes a laser radar, a camera, a microphone and a thermal imager. The laser radar and the camera are installed on the top of the height adjustment mechanism, and the microphone and the thermal imager are installed on the upper part of the body.
[0017] The humanoid robot information processing control method of the present invention is characterized by: including a road and obstacle detection and foot-wheel conversion control method, and a target detection information processing and height control method; The steps of the road and obstacle detection and foot-wheel conversion control method are as follows: S1: Road and obstacle detection: The humanoid robot scans and builds maps through LiDAR to obtain the three-dimensional geometric information of the surrounding environment, and uses the camera to identify surrounding objects based on machine learning algorithms to obtain the semantic information of the objects; S2: Road state judgment: The humanoid robot combines the three-dimensional geometric information and the object semantic information to judge the road state; S3: Wheeled motion mode: When the ground is flat, the robot switches from the footed motion mode to the wheeled motion mode, using wheeled motion. The footed-wheeled motion mode includes the following sub-steps: a1: Stand with your legs together and your arms hanging down; a2: Squat down with both legs until the lowest height; a3: Leg joint adjustment of knee landing: Dynamically adjust the angles of the hip, knee and ankle joints based on the ZMP control algorithm so that the knees are in contact with the ground; a4: Lean forward with the ends of your arms touching the ground: Based on the ZMP control algorithm, the angle of the hip joint is dynamically adjusted so that the body leans forward and the ends of the arms touch the ground; a5: arm wheel landing; Dynamically adjust the angle of the elbow joint based on the ZMP control algorithm to make the elbow arm wheel touch the ground; a6: Adjustment of forearm and foot posture; adjust the angle of the elbow joint to make the forearm as close to the upper arm as possible, ensure that the arm wheel is in full contact with the ground, adjust the angle of the ankle joint to make the foot end contract and not in contact with the ground, ensure that the leg wheel is in full contact with the ground, and control the electromagnetic clutch of the left and right legs to be turned off, and the electromagnetic clutch of the left and right arms to be turned off; S4: Footed motion mode: When there are obstacles on the ground that the wheels cannot overcome, the robot switches from wheeled motion mode to footed motion mode and uses footed motion to cross the obstacle. The steps of wheel-to-foot mode are opposite to the steps of foot-to-wheel mode. Based on the ZMP control algorithm, the robot adjusts the joint angles of the arms and legs to achieve the conversion from footed motion mode to wheeled motion mode. The steps of the target detection information processing and height control method are as follows: S1: Environment and target detection: The robot scans and maps through LiDAR to obtain the three-dimensional geometric information of the surrounding environment. It uses the camera to identify surrounding objects based on machine learning algorithms to obtain the semantic information of the objects. After matching the geometric information and voice information, it obtains the three-dimensional position of the target to be observed. S2: Height and viewing angle control: The robot controls the angles of the knee joints and ankle joints of the legs, as well as the unfolding height of the retracting mechanism, thereby controlling the robot's spatial position over a large range. By controlling the rotation of the rotating mechanism, the direction of the camera is adjusted, thereby adjusting the viewing angle. Based on the PID algorithm, the distance between the three-dimensional position of the target camera and the three-dimensional position of the target to be observed is controlled to reach a set threshold to obtain the best observation field of view; by adjusting the height and viewing angle, or adjusting the posture of the microphone and thermal imager, the fault sound of the instrument and the abnormal temperature of the equipment can be detected in a better posture; when the folding motor of the retracting mechanism rotates forward, the pull rope is wound around the capstan, the retracting mechanism is folded, and the height is reduced. When the folding motor of the retracting mechanism is reversed, the pull rope is unwound from the capstan, the retracting mechanism is unfolded, and the height is increased.
[0018] The technical solution of the present invention has the following beneficial effects: (1) The variable height and wheel-conversion humanoid robot mechanism and information processing control method of the present invention, based on an origami mechanism, can adjust the height and posture of sensors such as cameras without adjusting the height of the robot body, thereby reducing the complexity, weight and energy consumption of the system and improving the flexibility of detection operations in complex and narrow indoor environments.
[0019] (2) The foot-wheel conversion mechanism of the present invention adopts a structure that reuses the knee joint drive motor and elbow joint drive motor of the bipedal motion mechanism of the humanoid robot, thereby realizing the coupling and switching of foot-type and wheel-type motion. It does not require an additional motor to drive the wheel-type motion. It has the advantages of simple structure, light weight, and simple control. It balances the requirements of the humanoid robot for obstacle crossing and high-speed motion, and improves the robot's ability to pass and motion efficiency in complex environments. BRIEF DESCRIPTION OF THE DRAWINGS
[0020] Figure 1 is a right front perspective view of the main structure of the humanoid robot in the example of the present invention; Figure 2 It is a left rear perspective view of the main body structure of the humanoid robot in the example of the present invention; Figure 3 is a front view of the main structure of the humanoid robot in the example of the present invention; Figure 4 is a rear view of the main structure of the humanoid robot in the example of the present invention; Figure 5 is a schematic diagram of the body of a humanoid robot in an example of the present invention; Figure 6 The leg structure details of the humanoid robot in the present invention are shown in FIG. Figure 1 ; Figure 7 The leg structure details of the humanoid robot in the present invention are shown in FIG. Figure 2 ; Figure 8 The figure is a schematic diagram of the composition and folding state of the height adjustment mechanism of the humanoid robot in the embodiment of the present invention. Figure 1 ; Fig. 9 The figure is a schematic diagram of the height adjustment mechanism and folding state of the humanoid robot in the embodiment of the present invention. Figure 2 ; Fig.10 Schematic diagram of the height adjustment mechanism and elongation state of the humanoid robot in the embodiment of the present invention Figure 1 ; Fig.11 Schematic diagram of the height adjustment mechanism and elongation state of the humanoid robot in the embodiment of the present invention Figure 2 ; Fig.12 is a schematic diagram of the highest state of height adjustment of the humanoid robot in the example of the present invention; Fig.13 Schematic diagram of the leg-wheel mechanism of the foot-wheel conversion mechanism of the humanoid robot in the example of the present invention; Fig.14 Schematic diagram of the arm-wheel mechanism of the foot-wheel conversion mechanism of the humanoid robot in the example of the present invention; Fig.15 is a schematic diagram of the foot-type flat ground movement of the humanoid robot in an example of the present invention; Fig.16 Schematic diagram of the leg-type stair climbing motion of the humanoid robot in the example of the present invention; Fig.17 is a schematic diagram of the movement of a humanoid robot overcoming obstacles in an example of the present invention; Fig.18 is a schematic diagram of foot-wheel motion conversion of a humanoid robot in an example of the present invention; Fig.19 is a schematic diagram of wheeled flat-ground motion of a humanoid robot in an example of the present invention; Fig. 20 is a flow chart of a road and obstacle detection and foot-wheel conversion control method of a humanoid robot in an example of the present invention; Fig.21 It is a flow chart of the target detection information processing and height control method of the humanoid robot in the example of the present invention.
[0021] List of reference numerals: torso; 2, legs; 2-1, left leg; 2-2, right leg; 2-3, lateral swing drive motor; 2-4, direction adjustment motor seat; 2-5, direction adjustment motor; 2-6, hip joint motor seat; 2-7, hip joint motor; 2-8, thigh skeleton; 2-9, knee joint drive motor; 2-10, knee joint link 1; 2-11, knee joint link 2; 2-12, calf skeleton; 2-13, ankle joint drive motor; 2-14, leg coupling; 2-15, leg electromagnetic clutch; 2-16, leg wheel; 2-17, ankle joint link 1; 2-18, ankle joint link 2; 3, foot; 3-1, left foot; 3-2, right foot; 4, arm; 4-1, left arm; 4-2, right arm; 4-3, abduction drive motor; 4-4, lifting drive motor seat; 4-5, lifting drive motor; 4 -6, upper arm; 4-7, elbow joint drive motor; 4-8, arm coupling; 4-9, arm electromagnetic clutch; 4-10, arm wheel; 4-11, upper arm and forearm connecting piece; 4-12, forearm; 5, height adjustment mechanism; 5-1, retraction mechanism; 5-1-1, origami structure; 5-1-1-1, upper triangular carbon fiber plate; 5-1-1-2, lower triangular carbon fiber plate; 5-1-2, torsion spring; 5-1-3, folding motor; 5-1-4, winch; 5-1-5, base; 5-1-6, top seat; 5-1-7, pull rope; 5-2, rotating mechanism; 5-2-1, rotating motor; 5-2-2, rotating motor seat; 6, sensor unit; 6-1, laser radar; 6-2, camera; 6-3, microphone; 6-4, thermal imager; 7, control system. DETAILED DESCRIPTION
[0022] The present invention is further described in detail below in conjunction with the accompanying drawings and specific embodiments: For structural parts, please refer to the attached Figure 1-7 , the composition of the height adjustment mechanism and the folding state of the humanoid robot refer to the attached Figure 8-9 The composition and extension state of the height adjustment mechanism of the humanoid robot refer to the attached Figure 10-11 , the highest state of height adjustment of the humanoid robot is shown in the attached Fig.12 , the leg-wheel mechanism of the humanoid robot is shown in the attached Fig.13 , the foot-wheel conversion mechanism and arm-wheel mechanism of the humanoid robot refer to the attached Fig.14 , the motion state of the humanoid robot refers to the attached Figure 15-19A humanoid robot mechanism with variable height and wheel-to-foot conversion and an information processing control method, comprising a robot body and an information processing control method, wherein the robot body comprises a body 1, legs 2, feet 3, arms 4, a height adjustment mechanism 5, a sensor unit 6 and a control system 7; the legs 2, feet 3 and arms 4 are mounted on the body, the legs 2 comprise a left leg 2-1 and a right leg 2-2, the feet 3 comprise a left foot 3-1 and a right foot 3-2, the arms 4 comprise a left arm 4-1 and a right arm 4-2, the left leg 2-1 and the right leg 2-2 have the same structure and are symmetrical relative to the body, the left foot 3-1 and the right foot 3-2 have the same structure and are symmetrical relative to the body; The left leg 2-1 and the right leg 2-2 are both composed of a side-swing drive motor 2-3, a direction adjustment motor seat 2-4, a direction adjustment motor 2-5, a hip joint motor seat 2-6, a hip joint motor 2-7, a thigh skeleton 2-8, a knee joint drive motor 2-9, a knee joint connecting rod 1 2-10, a knee joint connecting rod 2-11, a calf skeleton 2-12, an ankle joint drive motor 2-13, a leg coupling 2-14, a leg electromagnetic clutch 2-15, a leg wheel 2-16, an ankle joint connecting rod 1 2-17, and an ankle joint connecting rod 2-18; the side-swing drive motor 2-3 is fixed to the lower end of the body 1, and the direction adjustment motor 2-5 is fixed to the lower end of the body 1. The adjustment motor seat 2-4 is fixed on the output shaft of the side swing drive motor 2-3, the direction adjustment motor 2-5 is fixed on the direction adjustment motor seat 2-4, the hip joint motor seat 2-6 is fixed on the output shaft of the direction adjustment motor 2-5, the hip joint motor 2-7 is fixed on the hip joint motor seat 2-6, the upper end of the thigh skeleton 2-8 is fixed on the output shaft of the hip joint motor 2-7, the knee joint drive motor 2-9 is fixed on the thigh skeleton, the hip joint motor 2-7 is on the inner side of the thigh skeleton 2-8, and the knee joint drive motor 2-9 is placed on the outer side of the thigh skeleton 2-8 One end of the knee joint connecting rod 2-10 is fixed on the output shaft of the knee joint driving motor 2-9, and the other end of the knee joint connecting rod 2-10 is connected to the knee joint connecting rod 2-11 by a rotating pair. The other end of the knee joint connecting rod 2-11 is connected to the top of the calf skeleton 2-12 by a rotating pair. A rotating shaft hole is provided below the top of the calf skeleton 2-12, which is connected to the bottom end of the thigh skeleton 2-8 by a rotating pair. The bottom end of the calf skeleton 2-12 is connected to the middle part of the foot 3 by a rotating pair. The ankle joint driving motor 2-13 is fixed on the inner side of the calf skeleton 2-12, located at the thigh. Below the rotating pair of the leg frame 2-8 and the calf frame 2-12, the leg coupling 2-14 is fixed on the output shaft of the ankle joint drive motor 2-13, the moving disk of the leg electromagnetic clutch 2-15 is fixed on the leg coupling 2-14, the leg wheel 2-16 is sleeved on the outer ring of the moving disk of the leg electromagnetic clutch 2-15 and fixed, one end of the ankle joint connecting rod 1 2-17 is fixed on the bottom plate of the leg electromagnetic clutch 2-15, the other end of the ankle joint connecting rod 1 2-17 is connected to the ankle joint connecting rod 2 2-18 by a rotating pair, and the other end of the ankle joint connecting rod 2 2-18 is connected to the root of the foot 3 by a rotating pair; The left arm 4-1 and the right arm 4-2 each include an abduction drive motor 4-3, an upward drive motor seat 4-4, an upward drive motor 4-5, a large arm 4-6, an elbow joint drive motor 4-7, an arm coupling 4-8, an arm electromagnetic clutch 4-9, an arm wheel 4-10, an upper arm and lower arm connecting piece 4-11 and a lower arm 4-12. The abduction drive motor 4-3 is fixed to the shoulder of the torso 1, the upward drive motor seat 4-4 is fixed to the output shaft of the abduction drive motor 4-3, the upward drive motor 4-5 is fixed to the upward drive motor seat 4-4, and the large arm 4- The upper end of the arm 4-6 is fixed on the output shaft of the lifting drive motor 4-5, the elbow joint drive motor 4-7 is fixed on the bottom end of the arm 4-6, the arm coupling 4-8 is fixed on the output shaft of the elbow joint drive motor 4-7, the moving plate of the arm electromagnetic clutch 4-9 is fixed on the arm coupling 4-8, the arm wheel 4-10 is sleeved on the outer ring of the moving plate of the arm electromagnetic clutch 4-9 and fixed, the arm-small arm connecting piece 4-11 is fixed on the bottom plate of the arm electromagnetic clutch 4-9, and the small arm 4-12 is fixed on the arm-small arm connecting piece 4-11; The height adjustment mechanism 5 is composed of a contraction mechanism 5-1 and a rotation mechanism 5-2. The contraction mechanism 5-1 includes an origami structure 5-1-1, a torsion spring 5-1-2, a folding motor 5-1-3, a winch 5-1-4, a base 5-1-5, a top seat 5-1-6 and a pull rope 5-1-7. The origami structure 5-1-1 is composed of a plurality of triangular carbon fiber plates connected by adhesive tape to form a Yoshimura origami mechanism. The torsion spring 5-1-2 includes a plurality of rotating shafts, and the rotating shafts are coaxial with the movable edges connected to the adjacent upper triangular carbon fiber plates 5-1-1-1 and the lower triangular carbon fiber plates 5-1-1-2. One of the force arms is fixed on the upper triangular carbon fiber sheet 5-1-1-1, and the other force arm is fixed on the lower triangular carbon fiber sheet 5-1-1-2. The folding motor 5-1-3 is fixed on the base 5-1-5, and the winch 5-1-4 is fixed on the folding motor. 5-1-3 output shaft, the bottom end of the origami structure 5-1-1 is fixed on the base 5-1-5, the top seat 5-1-6 is fixed on the top of the origami structure 5-1-1, and the pull rope 5-1-7 includes two ropes, one end of which is fixed on the top seat 5-1-6, and the other end passes through the triangular carbon fiber plate of the origami structure 5-1-1 and is fixed on the winch 5-1-4; the rotating mechanism 5-2 includes a rotating motor 5-2-1 and a rotating motor seat 5-2-2, the rotating motor 5-2-1 is fixed on the rotating motor seat 5-2-2, and the rotating motor seat 5-2-2 is fixed on the top of the body 1; the base 5-1-5 of the contraction mechanism 5-1 is fixed on the output shaft of the rotating motor 5-2-1; the rotating mechanism 5-2 drives the contraction mechanism 5-1 to rotate 360 degrees relative to the body 1, and the contraction mechanism 5-1 can be folded, stowed and unfolded; The sensor unit 6 includes a laser radar 6-1, a camera 6-2, a microphone 6-3 and a thermal imager 6-4. The laser radar 6-1 and the camera 6-2 are installed on the top of the height adjustment mechanism 5, and the microphone 6-3 and the thermal imager 6-4 are installed on the upper part of the body 1; The information processing control method includes a road and obstacle detection and foot-wheel conversion control method, and a target detection information processing and height control method; Road and obstacle detection and foot-wheel switching control methods for humanoid robots Fig. 20 As shown, the steps of the road and obstacle detection and foot-wheel conversion control method are: S1: Road and obstacle detection: The humanoid robot scans and builds maps through LiDAR to obtain the three-dimensional geometric information of the surrounding environment, and uses the camera to identify surrounding objects based on machine learning algorithms to obtain the semantic information of the objects; S2: Road state judgment: The humanoid robot combines the three-dimensional geometric information and the object semantic information to judge the road state; S3: Wheeled motion mode: When the ground is flat, the robot switches from the foot-based motion mode to the wheeled motion mode, using wheeled motion. The foot-based motion mode includes the following sub-steps: a1: Stand with your legs together and your arms hanging down; a2: Squat down with both legs to the lowest height; a3: Leg joint adjustment for knee contact: Based on the Zero Moment Point (ZMP) control algorithm, the angles of the hip, knee and ankle joints are dynamically adjusted to make the knee contact the ground; a4: Lean forward with both arms touching the ground: Based on the ZMP control algorithm, the angle of the hip joint is dynamically adjusted to make the body lean forward with both arms touching the ground; a5: Arm wheel touches the ground; based on the ZMP control algorithm, the angle of the elbow joint is dynamically adjusted to make the elbow arm wheel touch the ground; a6: Adjustment of forearm and foot posture; adjust the angle of the elbow joint to make the forearm as close to the upper arm as possible, ensure that the arm wheel is in full contact with the ground, adjust the angle of the ankle joint to make the foot end contract and not in contact with the ground, ensure that the leg wheel is in full contact with the ground, and control the electromagnetic clutch of the left and right legs to be turned off, and the electromagnetic clutch of the left and right arms to be turned off; S4: Footed motion mode: When there are obstacles such as stairs and thresholds on the ground that the wheels cannot overcome, the robot switches from wheeled motion mode to footed motion mode and uses foot-based motion to cross the obstacles. The steps of wheel-to-foot conversion are opposite to the steps of foot-to-wheel conversion above. Based on the ZMP control algorithm, the robot adjusts the joint angles of the arms and legs to achieve the conversion from footed motion mode to wheeled motion mode.
[0023] Target detection information processing and height control method for humanoid robots Fig.21 As shown, the steps of the target detection information processing and height control method are: S1: Environment and target detection: The robot scans and maps through LiDAR to obtain the three-dimensional geometric information of the surrounding environment. It uses the camera to identify surrounding objects based on machine learning algorithms to obtain the semantic information of the objects. After matching the geometric information and voice information, it obtains the three-dimensional position of the target to be observed. S2: Height and viewing angle control: The robot controls the angles of the knee joints and ankle joints of the legs, as well as the unfolding height of the retracting mechanism, thereby controlling the robot's spatial position over a large range. By controlling the rotation of the rotating mechanism, the camera's direction is adjusted, thereby adjusting the viewing angle. Based on the PID algorithm, the distance between the three-dimensional position of the target camera and the three-dimensional position of the target to be observed is controlled to reach a set threshold to obtain the best observation field of view. By adjusting the height and viewing angle, the position of the microphone and thermal imager can also be adjusted, so as to detect instrument fault sounds and abnormal equipment temperature in a better position. When the retracting motor rotates forward, the pull rope is wound around the capstan, the retracting mechanism is retracted, and the height is reduced. When the retracting motor rotates reversely, the pull rope is unwound from the capstan, the retracting mechanism is unfolded, and the height is increased.
[0024] The above description is only a preferred embodiment of the present invention and does not constitute any other form of limitation to the present invention. Any modification or equivalent change made based on the technical essence of the present invention still falls within the scope of protection required by the present invention.
Claims
1. A humanoid robot body structure, comprising a body (1), legs (2), feet (3), arms (4), a height adjustment mechanism (5), a sensor unit (6) and a control system (7), characterized in that; The legs (2), feet (3) and arms (4) are mounted on the body (1); the legs (2) include a left leg (2-1) and a right leg (2-2); the feet (3) include a left foot (3-1) and a right foot (3-2); the arms (4) include a left arm (4-1) and a right arm (4-2); the left leg (2-1) and the right leg (2-2) have the same structure and are symmetrical with respect to the body (1); the left foot (3-1) and the right foot (3-2) have the same structure and are symmetrical with respect to the body (1); a structure that reuses the knee joint drive motor and the elbow joint drive motor of the bipedal motion mechanism of the humanoid robot is adopted, thereby realizing the coupling and switching between foot-type and wheel-type motion; The height adjustment mechanism (5) is composed of a retracting mechanism (5-1) and a rotating mechanism (5-2), wherein the rotating mechanism (5-2) drives the retracting mechanism (5-1) to rotate 360 degrees relative to the body (1), thereby achieving folding, stowing and unfolding through the retracting mechanism (5-1).
2. The humanoid robot body structure according to claim 1, characterized in that: The leg (2) and foot (3) structures that reuse the knee joint drive motor and elbow joint drive motor of the bipedal motion mechanism of the humanoid robot are specifically as follows; The left leg (2-1) and the right leg (2-2) are both composed of a side-swing drive motor (2-3), a direction adjustment motor seat (2-4), a direction adjustment motor (2-5), a hip joint motor seat (2-6), a hip joint motor (2-7), a thigh frame (2-8), a knee joint drive motor (2-9), a knee joint connecting rod 1 (2-10), a knee joint connecting rod 2 (2-11), a calf frame (2-12), an ankle joint drive motor (2-13), a leg coupling (2-14), a leg electromagnetic clutch (2-15), a leg wheel (2-16), an ankle joint connecting rod 1 (2-17) and an ankle joint connecting rod 2 (2-18); the side-swing drive motor (2-3) is fixed to the body (1 ), the direction adjustment motor seat (2-4) is fixed on the output shaft of the lateral swing drive motor (2-3), the direction adjustment motor (2-5) is fixed on the direction adjustment motor seat (2-4), the hip joint motor seat (2-6) is fixed on the output shaft of the direction adjustment motor (2-5), the hip joint motor (2-7) is fixed on the hip joint motor seat (2-6), the upper end of the thigh frame (2-8) is fixed on the output shaft of the hip joint motor (2-7), the knee joint drive motor (2-9) is fixed on the thigh frame (2-8), the hip joint motor (2-7) is on the inner side of the thigh frame (2-8), and the knee joint drive motor (2-9) is placed on the inner side of the thigh frame (2-8). On the outside of the thigh frame (2-8), one end of the knee joint connecting rod 1 (2-10) is fixed to the output shaft of the knee joint driving motor (2-9), the other end of the knee joint connecting rod 1 (2-10) is connected to the knee joint connecting rod 2 (2-11) by a rotating pair, the other end of the knee joint connecting rod 2 (2-11) is connected to the top of the calf frame (2-12) by a rotating pair, a rotating shaft hole is provided below the top of the calf frame (2-12), and is connected to the bottom of the thigh frame (2-8) by a rotating pair, the bottom end of the calf frame (2-12) is connected to the middle part of the foot (3) by a rotating pair, and the ankle joint driving motor (2-13) is fixed to the inner side of the calf frame (2-12). , located below the rotating pair of the thigh frame (2-8) and the calf frame (2-12), the leg coupling (2-14) is fixed on the output shaft of the ankle joint drive motor (2-13), the movable plate of the leg electromagnetic clutch (2-15) is fixed on the leg coupling (2-14), the leg wheel (2-16) is sleeved on the outer ring of the movable plate of the leg electromagnetic clutch (2-15) and fixed, one end of the ankle joint connecting rod 1 (2-17) is fixed on the bottom plate of the leg electromagnetic clutch (2-15), the other end of the ankle joint connecting rod 1 (2-17) is connected to the ankle joint connecting rod 2 (2-18) by a rotating pair, and the other end of the ankle joint connecting rod 2 (2-18) is connected to the root of the foot (3) by a rotating pair.
3. The humanoid robot body structure according to claim 1, characterized in that: The arm (4) structure that reuses the knee joint drive motor and elbow joint drive motor of the bipedal motion mechanism of the humanoid robot is specifically as follows; The left arm (4-1) and the right arm (4-2) each comprise an abduction drive motor (4-3), an upward drive motor seat (4-4), an upward drive motor (4-5), an upper arm (4-6), an elbow joint drive motor (4-7), an arm coupling (4-8), an arm electromagnetic clutch (4-9), an arm wheel (4-10), an upper arm and lower arm connecting piece (4-11) and a lower arm (4-12); the abduction drive motor (4-3) is fixed to the shoulder of the trunk (1); the upward drive motor seat (4-4) is fixed to the output shaft of the abduction drive motor (4-3); the upward drive motor (4-5) is fixed to the upward drive motor seat (4-4); The upper end of the upper arm (4-6) is fixed on the output shaft of the lifting drive motor (4-5), the elbow joint drive motor (4-7) is fixed on the bottom end of the upper arm (4-6), the arm coupling (4-8) is fixed on the output shaft of the elbow joint drive motor (4-7), the movable plate of the arm electromagnetic clutch (4-9) is fixed on the arm coupling (4-8), the arm wheel (4-10) is sleeved on the outer ring of the movable plate of the arm electromagnetic clutch (4-9) and fixed, the upper arm and lower arm connecting piece (4-11) is fixed on the bottom plate of the arm electromagnetic clutch (4-9), and the lower arm (4-12) is fixed on the upper arm and lower arm connecting piece (4-11).
4. The humanoid robot body structure according to claim 1, characterized in that: The retracting mechanism (5-1) of the height adjustment mechanism (5) comprises an origami structure (5-1-1), a torsion spring (5-1-2), a folding motor (5-1-3), a winch (5-1-4), a base (5-1-5), a top seat (5-1-6) and a pull rope (5-1-7); the origami structure (5-1-1) is composed of at least two triangular carbon fiber plates connected by adhesive tape; the torsion spring (5-1-2) comprises at least two torsion springs; the rotation axis of the torsion spring (5-1-2) is coaxial with the movable edge connected to the adjacent upper triangular carbon fiber plate (5-1-1-1) and the lower triangular carbon fiber plate (5-1-1-2); one of the force arms is fixed to the upper triangular carbon fiber plate (5-1-1-1) and the lower triangular carbon fiber plate (5-1-1-2). The folding motor (5-1-3) is fixed on the base (5-1-5), the winch (5-1-4) is fixed on the output shaft of the folding motor (5-1-3), the bottom end of the origami structure (5-1-1) is fixed on the base (5-1-5), the top seat (5-1-6) is fixed on the top of the origami structure (5-1-1), and the pull rope (5-1-7) includes two ropes, one end of which is fixed on the top seat (5-1-6) and the other end passes through the triangular carbon fiber plate of the origami structure (5-1-1) and is fixed on the winch (5-1-4); The rotating mechanism (5-2) of the height adjustment mechanism (5) comprises a rotating motor (5-2-1) and a rotating motor seat (5-2-2), wherein the rotating motor (5-2-1) is fixed on the rotating motor seat (5-2-2), and the rotating motor seat (5-2-2) is fixed on the top of the body (1); and the base (5-1-5) of the contraction mechanism (5-1) is fixed on the output shaft of the rotating motor (5-2-1).
5. The humanoid robot body structure according to claim 1, characterized in that: The sensor unit (6) comprises a laser radar (6-1), a camera (6-2), a microphone (6-3) and a thermal imager (6-4); the laser radar (6-1) and the camera (6-2) are mounted on the top of the height adjustment mechanism (5), and the microphone (6-3) and the thermal imager (6-4) are mounted on the upper part of the body (1).
6. The height-variable and wheel-convertible humanoid robot mechanism and information processing control method according to any one of claims 1 to 5, characterized in that: Including road and obstacle detection and foot-wheel conversion control methods, as well as target detection information processing and height control methods; The steps of the road and obstacle detection and foot-wheel conversion control method are as follows: S1: Road and obstacle detection: The humanoid robot scans and maps through the laser radar (6-1) to obtain the three-dimensional geometric information of the surrounding environment, and identifies the surrounding objects based on the machine learning algorithm through the camera (6-2) to obtain the semantic information of the objects; S2: Road state judgment: The humanoid robot combines the three-dimensional geometric information and the object semantic information to judge the road state; S3: Wheeled motion mode: When the ground is flat, the robot switches from the footed motion mode to the wheeled motion mode, using wheeled motion. The footed-wheeled motion mode includes the following sub-steps: a1: Stand with your legs together and your arms hanging down; a2: Squat down with both legs until the lowest height; a3: Leg joint adjustment of knee landing: Dynamically adjust the angles of the hip, knee and ankle joints based on the ZMP control algorithm so that the knees are in contact with the ground; a4: Lean forward with the ends of your arms touching the ground: Based on the ZMP control algorithm, the angle of the hip joint is dynamically adjusted so that the body leans forward and the ends of the arms touch the ground; a5: arm wheel landing; Dynamically adjust the angle of the elbow joint based on the ZMP control algorithm to make the elbow arm wheel touch the ground; a6: Adjustment of the posture of the forearm and foot; adjust the angle of the elbow joint so that the forearm (4-12) is as close to the upper arm (4-6) as possible, ensure that the arm wheel (4-10) is in full contact with the ground, adjust the angle of the ankle joint so that the foot end is contracted and does not contact the ground, ensure that the leg wheel (2-16) is in full contact with the ground, and control the leg electromagnetic clutch (2-15) of the left leg (2-1) and the right leg (2-2) to be turned off, and the arm electromagnetic clutch (4-9) of the left arm (4-1) and the right arm (4-2) to be turned off; S4: Footed motion mode: When there are obstacles on the ground that the wheels cannot overcome, the robot switches from wheeled motion mode to footed motion mode and uses footed motion to cross the obstacle. The steps of wheel-to-foot mode are opposite to the steps of foot-to-wheel mode. Based on the ZMP control algorithm, the robot adjusts the joint angles of the arms and legs to achieve the conversion from footed motion mode to wheeled motion mode. The steps of the target detection information processing and height control method are as follows: S1: Environment and target detection: The robot scans and maps through LiDAR to obtain the three-dimensional geometric information of the surrounding environment. It uses the camera to identify surrounding objects based on machine learning algorithms to obtain the semantic information of the objects. After matching the geometric information and voice information, it obtains the three-dimensional position of the target to be observed. S2: Height and viewing angle control: The robot controls the angles of the knee and ankle joints of the legs and the unfolding height of the retracting mechanism (5-1) to control the spatial position of the robot over a large range. By controlling the rotation of the rotating mechanism (5-2), the direction of the camera (6-2) is adjusted to adjust the viewing angle. Based on the PID algorithm, the distance between the three-dimensional position of the target camera (6-2) and the three-dimensional position of the target to be observed is controlled to reach the set threshold to obtain the best observation field of view. By adjusting the height and viewing angle, or adjusting the microphone (6-3) and the thermal imager (6-4), so as to detect the fault sound of the instrument and the abnormal temperature of the equipment in a better posture; when the folding motor (5-1-3) of the retracting mechanism (5-1) rotates forward, the pull rope (5-1-7) is wound around the winch (5-1-4), the retracting mechanism (5-1) is folded, and the height is reduced; when the folding motor (5-1-3) of the retracting mechanism (5-1) rotates reversely, the pull rope (5-1-7) is unwound from the winch (5-1-4), the retracting mechanism (5-1) is unfolded, and the height is increased.
Citation Information
Patent Citations
Humanoid robot capable of moving with wheels, and working method
CN105059420A
Omnidirectional wheeled humanoid robot based on a linear predictive position and velocity controller
CN106573370A
Leg-track composite humanoid robot
CN107127760A
Humanoid robot moving by wheels
CN108622225A
Wheel leg type humanoid robot with internal oil flowing
CN110217308A
