Control method of land robot

By detecting the size and slope of obstacles and using environmental information sensors to determine whether to jump or climb, the problem of existing land robots being difficult to effectively cross larger obstacles is solved, and their ability and scope of application are improved.

CN115783082BActive Publication Date: 2024-11-29SHANDONG UNIV
View PDF 5 Cites 0 Cited by

Patent Information

Application Number
CN202211531538.6
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-12-01
Publication Date
2024-11-29
Estimated Expiration
2042-12-01

AI Technical Summary

Technical Problem

When existing land robots face large obstacles, they are inconvenient to jump and are difficult to effectively cross.

Method used

By detecting obstacles in the surrounding environment, using environmental information sensors (such as cameras, radars, infrared detectors) to collect image information, judge the size and slope of the obstacle, and decide whether to jump or climb to cross the obstacle.

Benefits of technology

It improves the ability of land robots to overcome obstacles and expands its scope of application, allowing them to walk more flexibly in complex environments.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115783082B_ABST
    Figure CN115783082B_ABST
Patent Text Reader

Abstract

The present invention relates to the field of automatic control technology, and in particular to a control method for a land robot. The present invention provides a control method for a land robot with a strong ability to cross obstacles and a wider range of applications, comprising: (i) first detecting whether there are obstacles in the surrounding environment of the land robot, if there are no obstacles, walking normally, if there are obstacles, performing step (ii); (ii) detecting the size of the obstacle to determine whether the obstacle can be jumped over, if it can be jumped over, the land robot bounces, if it cannot jump over, performing step (iii); (iii) detecting the slope of the obstacle to determine whether the obstacle can be climbed, if it can be climbed, the land robot climbs.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of automatic control technology, and in particular to a control method for a land robot. Background Art

[0002] At present, robots have become common tools in industrial production and daily life. Existing land robots have technical problems such as inconvenient jumping and difficulty in crossing large obstacles. Summary of the invention

[0003] The technical problem to be solved by the present invention is to provide a control method for a land robot with a stronger ability to cross obstacles and a wider range of applications.

[0004] In order to solve the above technical problems, this application provides the following technical solutions:

[0005] The control method of the land robot of the present invention comprises the following steps:

[0006] (i) Detecting whether there are obstacles in the surrounding environment of the land robot, and walking normally if there are no obstacles, and proceeding to step (ii) if there are obstacles;

[0007] (ii) detecting the size of the obstacle to determine whether the obstacle can be jumped over, if so, the land robot performs a jump, if not, proceeding to step (iii);

[0008] (iii) detecting the slope of the obstacle to determine whether the obstacle can be climbed; if so, the land robot climbs the obstacle.

[0009] The control method of the land robot of the present invention, wherein the land robot includes an environmental information sensor and a host computer. In step (a), the environmental information sensor collects image information of the surrounding environment and transmits the collected image information to the host computer. The host computer determines whether there are obstacles in the surrounding environment based on the image information.

[0010] The control method of the land robot of the present invention, wherein the environmental information sensor includes a camera, a radar, and an infrared detector.

[0011] The control method of the land robot of the present invention, wherein the land robot also includes a body, at least two first legs, and at least two second legs, the first legs and the second legs are both connected to the body, in step (ii), the angles of the first legs and the second legs are adjusted, the first leg performs a bouncing action, during the bouncing motion, the second leg does not touch the ground until the bouncing motion is about to end, when the body lands, only the second leg touches the ground, the first leg is retracted, and the second leg is used to cushion the bouncing impact.

[0012] The control method of the land robot of the present invention, wherein the first leg includes a first section of the first leg, a second section of the first leg, and a third section of the first leg, one end of the second section of the first leg is hinged to one end of the first section of the first leg, and the other end is hinged to one end of the third section of the first leg, the other end of the first section of the first leg is connected to the body, and the other end of the third section of the first leg is used to contact the ground, and in the step (ii), the third section of the first leg is perpendicular to the ground, and the third section of the first leg bounces.

[0013] The control method of the land robot of the present invention, wherein the third section of the first leg includes a leg shell, a first leg motor, a spring, a first spring pressure block, and a second spring pressure block, the first leg motor, the spring, and the first spring pressure block are all arranged in the leg shell, the second spring pressure block is arranged outside the leg shell, the first spring pressure block and the second spring pressure block are respectively connected to the two ends of the spring, the spring is arranged along the length direction of the leg shell, the first leg motor is connected to the first spring pressure block, and in the step (ii), the first leg motor compresses the spring to store elastic energy, so that the first leg performs a bouncing action.

[0014] The control method of the land robot of the present invention, wherein in the step (ii), the environmental information sensor collects image information of obstacles in the surrounding environment and transmits it to the host computer, and the host computer compares the size of the obstacle in the image information with the maximum height and the farthest distance of the first leg jumping. If the maximum height and the farthest distance of the first leg jumping are greater than the size of the obstacle, it is determined that the obstacle can be jumped over.

[0015] The control method of the land robot of the present invention, wherein in the step (a), during the normal walking process, the first leg and the second leg walk in the same manner, wherein the first section of the first leg rotates relative to the body in a direction parallel to the ground to drive the body to move, the second section of the first leg rotates in a direction perpendicular to the ground, and the third section of the first leg rotates in a direction perpendicular to the ground.

[0016] The control method of the land robot of the present invention, wherein in the step (iii), the environmental information sensor collects image information of obstacles in the surrounding environment and transmits it to the host computer, and the host computer judges the slope of the obstacle in the image information. If the slope of the obstacle is greater than 60°, it is judged that it cannot be climbed, and if the slope of the obstacle is less than 60°, it can be climbed.

[0017] The control method of the land robot of the present invention, wherein in the step (iii), during the climbing process, the second section of the first leg is parallel to the top surface of the body, the third section of the first leg is parallel to the side wall of the body, and the first section of the first leg rotates relative to the body to drive the body to climb.

[0018] Compared with the prior art, the control method of the land robot of the present invention has at least the following beneficial effects:

[0019] The control method of the land robot of the present invention can detect the size of obstacles so as to jump over the obstacles or climb over the obstacles, thereby improving the ability of the land robot to cross obstacles and expanding the scope of application of the land robot.

[0020] The control method of the land robot of the present invention is further described below with reference to the accompanying drawings. BRIEF DESCRIPTION OF THE DRAWINGS

[0021] Figure 1 is a schematic diagram of the structure of the land robot in the present invention;

[0022] Figure 2 It is a schematic diagram of the structure of the land robot body of the present invention;

[0023] Figure 3 This is a schematic diagram of the structure of the honeycomb-shaped groove of the land robot in the present invention;

[0024] Figure 4 It is a schematic diagram of the structure of the side of the honeycomb-shaped groove of the land robot in the present invention;

[0025] Figure 5 It is a schematic structural diagram of the first section of the first leg of the land robot in the present invention;

[0026] Figure 6 It is a schematic diagram of the structure of the second rotation pair of the land robot in the present invention;

[0027] Figure 7 It is a schematic diagram of the structure of the second section of the first leg of the land robot in the present invention;

[0028] Figure 8 It is a schematic diagram of the structure of the third section of the first leg of the land robot in the present invention;

[0029] Fig. 9 It is a schematic diagram of the structure of the third section of the second leg of the land robot in the present invention. DETAILED DESCRIPTION

[0030] like Figure 1 As shown, a land robot includes a body 01, two or more first legs 02, two or more second legs 03 and a control unit, wherein the first leg 02 and the second leg 03 are both connected to the body 01, and the first leg 02 and the second leg 03 are suitable for driving the body 01 to move, the first leg 02 and the second leg 03 are arranged crosswise, the control unit is connected to the first leg 02 and the second leg 03, and the control unit is suitable for controlling the rotation and jumping of the first leg 02, and the control unit is suitable for controlling the rotation and buffering of the second leg 03 when it touches the ground. Since the control unit can control the rotation and jumping of the first leg 02, and control the rotation and buffering of the second leg 03 when it touches the ground, it can perform a large rotation movement in a limited space, and can speed up the movement speed by jumping, and cross obstacles that ordinary robots cannot cross when walking, and at the same time buffer the impact caused by jumping, thereby extending the service life.

[0031] Alternatively, if Figure 2 As shown, the body 01 is a plate-shaped body, and a plurality of honeycomb-shaped grooves 11 are respectively arranged on the top surface and the bottom surface of the body 01 to reduce the weight of the body 01.

[0032] Alternatively, if Figure 3 , Figure 4 As shown, the cross section of the honeycomb groove 11 forms a hexagonal structure, which is formed by splicing three congruent rhombuses, the two acute angles of the rhombus are 70°32′, the two obtuse angles are 109°28′, the cross-sectional area of ​​the opening of the honeycomb groove 11 is greater than the cross-sectional area of ​​the bottom of the hole, and the inclination of the hole wall of the honeycomb groove 11 is 13°. Since the honeycomb groove 11 is provided on the body 01, the body 01 deeply imitates the honeycomb in nature, saves more materials, has a stronger structure, and prolongs the service life of the land robot of the present invention.

[0033] Alternatively, if Figure 1 , Figure 5 , Figure 7 , Figure 8As shown, the first leg 02 includes a first leg first section 21, a first leg second section 22, a first leg third section 23, a first section driving unit, a second section driving unit, and a third section driving unit. The first leg first section 21 is L-shaped, the first leg third section 23 is suitable for bouncing, one end of the first leg second section 22 is hinged to one end of the first leg first section 21, and the other end is hinged to one end of the first leg third section 23. The other end of the first leg first section 21 is connected to the body 01, and the other end of the first leg third section 23 is used to contact the ground. The first section driving unit is suitable for driving the first leg first section 21 relative to the body 01 rotates within a range of 360°, the second section driving unit is suitable for driving the second section 22 of the first leg to rotate relative to the first section 21 of the first leg, the third section driving unit is suitable for driving the third section 23 of the first leg to rotate relative to the second section 22 of the first leg, the first section driving unit, the second section driving unit, the third section driving unit and the third section 23 of the first leg are all connected to the control unit, the control unit controls the first section driving unit, the second section driving unit and the third section driving unit to respectively drive the first section 21 of the first leg, the second section 22 of the first leg and the third section 23 of the first leg to rotate, and the control unit controls the third section 23 of the first leg to bounce.

[0034] Optionally, it further includes a first rotation pair 24, through which the first leg first section 21 is connected to the body 01, and the first section driving unit is a first steering gear, which is arranged in the first rotation pair 24, and the two ends of the first steering gear are respectively connected to the body 01 and the first leg first section 21. The first steering gear drives the first leg first section 21 to rotate relative to the body 01 by a set angle according to the command of the control unit.

[0035] Alternatively, if Figure 6 , Figure 7As shown, the second rotating pair 25 and the third rotating pair 26 are both pins. The second section driving unit is the second steering gear, and the third section driving unit is the third steering gear. A set of rotating pair connecting grooves 221 and 222 are respectively provided at both ends of the second section 22 of the first leg. The middle parts of the second rotating pair 25 and the third rotating pair 26 are both provided with connecting holes. The second rotating pair 25 is provided with a connecting hole 251. The end of the first section 21 of the first leg is fixedly connected to the connecting hole 251 of the second rotating pair 25. The two ends of the second rotational pair 25 are respectively connected to a group of rotational pair connection grooves 221 at one end of the second section 22 of the first leg, the second steering gear is arranged in the second rotational pair 25, the end of the third section 23 of the first leg is fixedly connected to the connection hole in the middle of the third rotational pair 26, the two ends of the third rotational pair 26 are respectively connected to a group of rotational pair connection grooves 222 at the other end of the second section 22 of the first leg, the third steering gear is arranged in the third rotational pair 26, and the second section 22 of the first leg is also provided with a weight reduction groove 223 to reduce the weight of the second section 22 of the first leg. The second steering gear and the third steering gear drive the second section 22 of the first leg and the third section 23 of the first leg to rotate the set angle according to the command of the control unit.

[0036] Alternatively, if Figure 8 As shown, the third section 23 of the first leg includes a leg housing 231, a first leg motor, a spring 233, a first spring pressure block 234, and a second spring pressure block 235. The first leg motor, the spring 233, and the first spring pressure block 234 are all arranged in the leg housing 231, and the second spring pressure block 235 is arranged outside the leg housing 231. The first spring pressure block 234 and the second spring pressure block 235 are respectively connected to the two ends of the spring 233. The spring 233 is arranged along the length direction of the leg housing 231. The first leg motor is connected to the first spring pressure block 234, and the first leg motor is connected to the control unit. The control unit controls the first leg motor to drive the first spring pressure block 234 to compress the spring 233. The spring 233 adopts a high elastic coefficient spring. After the spring is compressed, the elastic potential energy is stored to perform a bouncing motion, providing elastic energy for the first leg to take off.

[0037] Alternatively, if Figure 1 , Fig. 9As shown, the second leg 03 includes a second leg first section 31, a second leg second section 32, a second leg third section 33, a first section driving unit, a second section driving unit, and a third section driving unit. The second leg 03 is different from the first leg 02 only in that the second leg third section 33 includes a second shell 331, a second leg motor 332, and a second slider 333. A slider cavity 334 is provided in the second shell 331. The second slider 333 is provided in the slider cavity 334. The length of the second slider 333 is greater than the length of the slider cavity 334. The second slider 333 matches the slider cavity 334. Lubricating oil is provided between the slider cavity 334 and the second slider 333 to reduce the sliding friction of the second slider 333. The second leg motor 332 is connected to the second slider 333. The second leg motor 332 is connected to the control unit. The control unit controls the second leg motor 332 to drive the second slider 333 to move along the length direction of the slider cavity 334. When the second leg motor 332 drives the second slider 333 to move downward and the second leg 03 falls to the ground, the second slider 333 is pushed upward by the reaction force of the second leg 03, which plays a buffering role and reduces the damage caused to the machine body 01 by the impact of falling.

[0038] Optionally, a hollow cavity 12 is provided in the middle of the body 01, and the control unit includes a host computer, a main control unit, an environmental information sensor, a sensor control unit, a first leg motor control unit, a second leg motor control unit, and a plurality of steering gear control units. The main control unit, the sensor control unit, the first leg motor control unit, the second leg motor control unit, and the steering gear control unit are all provided in the hollow cavity 12, the environmental information sensor transmits environmental information to the host computer, the first leg motor control unit is connected to the first leg motor, the second leg motor control unit is connected to the second leg motor 332, and each steering gear control unit is connected to a steering gear respectively. The host computer controls the main control unit according to the information transmitted by the environmental information sensor, and the main control unit controls the first leg motor control unit, the second leg motor control unit, and the steering gear control unit. Specifically, the host computer and the main control unit transmit information via a Bluetooth module. Since the hollow cavity 12 is provided on the body 01, it not only reduces the weight of the body 01, but also facilitates the setting of the control unit to prevent the control unit from being damaged.

[0039] Optionally, the environmental information sensor includes a camera, a radar, and an infrared detector. A plurality of grooves 13 are provided on the outer wall of the body 01, and the camera, the radar, and the infrared detector are arranged in the grooves 13. The camera, the radar, and the infrared detector are used to collect environmental information outside the body 01 and transmit the information to the host computer.

[0040] Optionally, four first legs 02 are provided, two second legs 03 are provided, the body 01 is a hexagonal plate-shaped body, the first leg 02 and the second leg 03 are respectively provided at a vertex of the body 01, the two second legs 03 are symmetrically provided, and the four first legs 02 are symmetrically provided.

[0041] The control method of the land robot of the present invention comprises the following steps:

[0042] (i) Detect whether there are obstacles in the surrounding environment. If there are no obstacles, walk normally. If there are obstacles, proceed to step (ii);

[0043] (ii) detecting the size of the obstacle to determine whether the obstacle can be jumped over, if it can be jumped over, the first leg 02 performs a bounce, if it cannot be jumped over, proceeding to step (iii);

[0044] (iii) Detecting the surface slope of the obstacle to determine whether the obstacle can be climbed; if so, the land robot will climb the obstacle.

[0045] The control method of the land robot of the present invention can detect the size of obstacles so as to jump over the obstacles or climb over the obstacles, thereby improving the ability of the land robot to cross obstacles and expanding the scope of application of the land robot.

[0046] Optionally, in step (i), the environmental information sensor collects image information of the surrounding environment and transmits the collected image information to a host computer, and the host computer determines whether there are obstacles in the surrounding environment based on the image information.

[0047] Optionally, in step (a), the environmental information sensor includes a camera, a radar, and an infrared detector, and the camera, the radar, and the infrared detector collect environmental image information outside the land robot and transmit the environmental image information to a host computer.

[0048] Optionally, in step (ii), the first leg first section 21, the first leg second section 22, and the first leg third section 23 of the first leg 02 are relatively rotated to adjust the angle accordingly. After the adjustment, the first leg third section 23 is perpendicular to the ground, and the first leg 02 performs a bouncing action. During the bouncing motion, the second leg 03 does not touch the ground, only the first leg 02 touches the ground, until the bouncing motion is about to end, when the body 01 lands, only the second leg 03 touches the ground, the first leg 02 is retracted, and the second leg 03 is used to buffer the bouncing impact. The control method of the land robot of the present invention reduces the friction during the bouncing process because only the first leg touches the ground and bounces during the bouncing process. At the end of the bouncing, only the second leg with buffering ability touches the ground, which can buffer the impact caused by the jump. This mode is more suitable for briefly passing through obstacles that cannot be crossed by normal walking or passing through relatively hard ground.

[0049] Optionally, in step (ii), the spring 233 of the third section 23 of the first leg is compressed to store elastic energy, causing the first leg 02 to bounce, and at the same time, the second slider 333 of the second leg 03 is moved downward. During the bouncing movement, the second leg 03 is retracted after making a corresponding angle adjustment, and only the first leg 02 performs the bouncing movement until the bouncing movement is about to end. When the body 01 lands, only the second leg 03 touches the ground and the first leg 02 is retracted.

[0050] Optionally, in step (ii), the environmental information sensor collects image information of obstacles in the surrounding environment and transmits it to the host computer. The host computer compares the size of the obstacle in the image information with the maximum height and the farthest distance of the jump of the first leg 02. If the maximum height and the farthest distance of the jump of the first leg 02 are greater than the size of the obstacle, it is determined that the obstacle can be jumped over, otherwise it cannot.

[0051] Optionally, in step (a), during normal walking, the first leg 02 and the second leg 03 walk in the same manner, wherein the first section 21 of the first leg rotates in a direction parallel to the ground relative to the body 01 to drive the body 01 to move, the second section 22 of the first leg rotates in a direction perpendicular to the ground, and the third section 23 of the first leg rotates in a direction perpendicular to the ground, and the first leg motor and the second leg motor 332 do not work.

[0052] Optionally, in step (iii), the environmental information sensor collects image information of obstacles in the surrounding environment and transmits it to a host computer, which determines the slope of the obstacle in the image information. If the slope of the obstacle is greater than 60°, it is determined that the obstacle cannot be climbed; if the slope of the obstacle is less than 60°, it can be climbed.

[0053] Optionally, in step (three), during the climbing process, the second section 22 of the first leg is parallel to the top surface of the body 01, the third section 23 of the first leg is parallel to the side wall of the body 01, and the first section 21 of the first leg rotates relative to the body 01 to drive the body 01 to climb.

[0054] The embodiments described above are merely descriptions of preferred implementation modes of the present invention and are not intended to limit the scope of the present invention. Without departing from the design spirit of the present invention, various modifications and improvements made to the technical solutions of the present invention by ordinary technicians in this field should all fall within the protection scope determined by the claims of the present invention.

Claims

1. A control method for a land robot, characterized in that: The steps include: (i) Detect whether there are obstacles in the surrounding environment of the land robot. If there are no obstacles, the robot walks normally. If there are obstacles, the robot proceeds to step (ii). (ii) detecting the size of the obstacle to determine whether the obstacle can be jumped over, if the obstacle can be jumped over, the land robot performs a bounce, if the obstacle cannot be jumped over, performing step (iii); the land robot further comprises a body (01), at least two first legs (02), and at least two second legs (03), the first legs (02) and the second legs (03) are both connected to the body (01), when jumping, the first legs (02) and the second legs (03) are adjusted in angle, the first leg (02) performs a bouncing action, During the bouncing movement, the second leg (03) does not touch the ground until the bouncing movement is about to end. When the machine body (01) lands, only the second leg (03) touches the ground and the first leg (02) is retracted. The second leg (03) is used to buffer the impact of the bouncing movement. The first leg (02) comprises a first leg first section (21), a first leg second section (22), and a first leg third section (23). One end of the first leg second section (22) is hinged to one end of the first leg first section (21), and the other end is hinged to one end of the first leg third section (23). The other end of the first leg first section (21) is connected to the machine body (01), and the other end of the first leg third section (23) is used to contact the ground. In the step (ii), the first leg third section (23) is perpendicular to the ground, and the first leg third section (23) bounces. The first leg third section (23) comprises a leg housing (231), a first leg motor, a spring (233), a first spring pressure block (234), and a second spring pressure block (235). The first leg motor, the spring (233), and the first spring pressure block (234) Both are arranged in the leg housing (231), the second spring pressure block (235) is arranged outside the leg housing (231), the first spring pressure block (234) and the second spring pressure block (235) are respectively connected to two ends of the spring (233), the spring (233) is arranged along the length direction of the leg housing (231), the first leg motor is connected to the first spring pressure block (234), and in the step (ii), the first leg motor compresses the spring (233) to store elastic energy, so that the first leg (02) performs a bouncing action; (iii) detecting the slope of the obstacle to determine whether the obstacle can be climbed, and if so, the land robot climbing the obstacle.

2. The control method of a land robot according to claim 1, characterized in that: The land robot includes an environmental information sensor and a host computer. In step (i), the environmental information sensor collects image information of the surrounding environment and transmits the collected image information to the host computer. The host computer determines whether there are obstacles in the surrounding environment based on the image information.

3. The control method of the land robot according to claim 2, characterized in that: The environmental information sensor includes a camera, a radar, and an infrared detector.

4. The control method of the land robot according to claim 3, characterized in that: In the step (ii), the environmental information sensor collects image information of obstacles in the surrounding environment and transmits it to the host computer. The host computer compares the size of the obstacle in the image information with the maximum height and the maximum distance that the first leg (02) can jump. If the maximum height and the maximum distance that the first leg (02) can jump are greater than the size of the obstacle, it is determined that the obstacle can be jumped over.

5. The control method of the land robot according to claim 4, characterized in that: In the step (i), during the normal walking process, the first leg (02) and the second leg (03) walk in the same manner, wherein the first section (21) of the first leg rotates relative to the body (01) in a direction parallel to the ground to drive the body (01) to move, the second section (22) of the first leg rotates in a direction perpendicular to the ground, and the third section (23) of the first leg rotates in a direction perpendicular to the ground.

6. The control method of the land robot according to claim 5, characterized in that: In the step (iii), the environmental information sensor collects image information of obstacles in the surrounding environment and transmits it to the host computer. The host computer determines the slope of the obstacle in the image information. If the slope of the obstacle is greater than 60°, it is determined that it cannot be climbed. If the slope of the obstacle is less than 60°, it can be climbed.

7. The control method of a land robot according to claim 6, characterized in that: In the step (iii), during the climbing process, the second section (22) of the first leg is parallel to the top surface of the body (01), the third section (23) of the first leg is parallel to the side wall of the body (01), and the first section (21) of the first leg rotates relative to the body (01) to drive the body (01) to climb.

Citation Information

Patent Citations

  • Rolling-feet type intermittent hopping robot capable of adjusting posture in the air and recycling landing energy

    CN107089275A

  • Worm-imitative special robot and control method thereof

    CN108516024A

  • Jump gait planning method of multi-legged robot

    CN112650222A

  • Quadruped robot leg device capable of climbing 60-degree slope

    CN209757313U

  • Leg module and leg type robot using it

    JP2006051559A