Intelligent robot obstacle avoidance navigation control method and system
By obtaining and analyzing obstacle information in real time, intelligent robots can adjust travel parameters or re-plan the path, solving the safety and rationality of obstacle handling in path planning, and improving the efficiency of obstacle avoidance and path accuracy.
Patent Information
- Application Number
- CN202410940794.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-15
- Publication Date
- 2024-11-05
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
Intelligent robots have difficulty effectively adjusting their posture or re-planning their paths in path planning to avoid obstacles, especially in narrow areas, resulting in unsafe and irrationality of their operations.
By obtaining the target map, starting position and end point information of the intelligent robot, we can obtain obstacle information on the travel route in real time, judge whether we can directly cross the obstacle, and adjust the travel parameters or re-direct the obstacle's orientation, distance and appearance size information according to the obstacle's orientation, distance and appearance size information. Plan the path.
It improves the obstacle avoidance efficiency and path planning accuracy of intelligent robots, ensuring effective adjustments when encountering obstacles to ensure safety and rationality.
Smart Images

Figure CN118897549A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of robot navigation technology, and in particular to an intelligent robot obstacle avoidance navigation control method and system. Background Art
[0002] At present, with the rapid development of intelligent robot related technologies, intelligent robots can replace humans in high-risk and high-repetitive work, and the mobility of intelligent robots is a hot topic for researchers. As the core of intelligent robots, the navigation system is of paramount importance. There are many problems in the path planning system. For example, obstacles appear during the movement of the robot, which makes it impossible to adjust its posture or effectively plan the path based on the information of the obstacles. Especially when the robot is in a narrow area or an obstacle area that cannot be crossed, it is difficult to ensure the feasibility, safety and rationality of its operation. Summary of the invention
[0003] In order to solve the above technical problems, the present invention provides an intelligent robot obstacle avoidance navigation control method, comprising:
[0004] Acquire a target map of the intelligent robot, and determine the starting position information of the intelligent robot and the ending position information of the target point in the target map;
[0005] Planning a travel route of the intelligent robot according to the starting position information and the end position information;
[0006] Obtaining in real time information about obstacles encountered by the intelligent robot on the travel route, and judging whether the intelligent robot can directly pass through the obstacles according to the obstacle information;
[0007] If the obstacle cannot be directly crossed, the forward parameters of the intelligent robot are adjusted according to the obstacle information to cross the obstacle or re-plan the travel route.
[0008] Furthermore, the real-time acquisition of obstacle information encountered by the intelligent robot on the travel route, and judging whether the intelligent robot can directly cross the obstacle according to the obstacle information, includes:
[0009] Obtaining the obstacle information, wherein the obstacle information includes orientation information, distance information, and appearance size information;
[0010] It is comprehensively judged whether the intelligent robot can directly pass through the obstacle based on the position information, distance information and appearance size information of the obstacle.
[0011] Furthermore, the step of comprehensively judging whether the intelligent robot can directly pass through the obstacle based on the position information, distance information and appearance size information of the obstacle includes:
[0012] According to the position information, distance information and appearance size information of the obstacle, the intelligent robot and the obstacle are projected onto the target map in equal proportions;
[0013] Deduct the gaps between obstacles from the target map, and compare the apparent sizes of the gaps with the projection of the intelligent robot;
[0014] The probability that the intelligent robot can directly cross the obstacle is calculated based on the comparison result. If the probability that the intelligent robot can directly cross the obstacle is greater than or equal to a preset maximum probability, the intelligent robot can directly cross the obstacle.
[0015] Furthermore, if the obstacle cannot be directly crossed, adjusting the forward parameters of the intelligent robot according to the obstacle information to cross the obstacle or replan the travel route includes:
[0016] If it is determined that the intelligent robot can traverse the obstacle by adjusting its own traveling parameters, the intelligent robot traverses the obstacle by adjusting its own traveling parameters and continues to move forward along the traveling route;
[0017] If it is determined that the intelligent robot cannot cross the obstacle, the real-time position information of the intelligent robot is obtained, and the travel route is replanned according to the real-time position information.
[0018] Furthermore, if it is determined that the intelligent robot can traverse obstacles by adjusting its own traveling parameters, the method includes:
[0019] Get the probability of being able to directly cross the obstacle;
[0020] If the probability of being able to directly cross the obstacle is between a preset maximum probability and a preset minimum probability, it is determined that the intelligent robot can cross the obstacle by adjusting its own travel parameters;
[0021] The straight-line distance of the gap between the intelligent robot and the obstacle is calculated according to the orientation information and distance information of the obstacle.
[0022] Furthermore, the step of adjusting the travel parameters to cross obstacles and continuing to move forward along the travel route includes:
[0023] Obtaining the straight-line distance between the intelligent robot and the obstacle;
[0024] The turning speed and forward speed of the intelligent robot crossing the obstacle are set according to the straight-line distance.
[0025] Furthermore, the step of setting the turning speed and the forward speed of the intelligent robot crossing an obstacle according to the straight-line distance includes:
[0026] The obtained straight-line distance between the intelligent robot and the obstacle is set as △G;
[0027] And set the standard distance G0, the processing module is also used to set the first preset distance difference g1, the second preset distance difference g2, the third preset distance difference g3 and the fourth preset distance difference g4, and g1<g2<g3<g4; the processing module is also used to set the first preset working condition matrix A1 (a1, b1), the second preset working condition matrix A2 (a2, b2), the third preset working condition matrix A3 (a1, b1) and the fourth preset working condition matrix A4 (a4, b4), wherein a1-a4 are the first to fourth preset turning speeds respectively, and a1<a2<a3<a4, b1-b4 are the first to fourth preset forward speeds respectively, and b1<b2<b3<b4;
[0028] According to the difference between the obtained straight-line distance value △G and the set standard distance G0, a preset working condition matrix A is selected as the working condition for the intelligent robot to cross obstacles;
[0029] When △G-G0≤g1, the first preset working condition matrix A1 is selected as the working condition for the intelligent robot to cross obstacles;
[0030] When g1<△G-G0≤g2, the second preset working condition matrix A2 is selected as the working condition for the intelligent robot to cross obstacles;
[0031] When g2<△G-G0≤g3, the third preset working condition matrix A3 is selected as the working condition for the intelligent robot to cross obstacles;
[0032] When g3<△G-G0≤g4, the fourth preset working condition matrix A4 is selected as the working condition for the intelligent robot to cross obstacles.
[0033] Furthermore, if it is determined that the intelligent robot cannot cross the obstacle, obtaining the real-time location information of the intelligent robot, and replanning the travel route according to the real-time location information, includes:
[0034] Get the probability of being able to directly cross the obstacle;
[0035] If the probability of being able to directly cross the obstacle is less than or equal to the preset minimum probability, it is determined that the intelligent robot cannot cross the obstacle;
[0036] Acquire the real-time location information of the intelligent robot, and re-plan the travel route according to the real-time location information.
[0037] The present invention also provides an intelligent robot obstacle avoidance navigation control system, comprising:
[0038] An acquisition module, used to acquire a target map of the intelligent robot, and determine the starting position information of the intelligent robot and the end position information of the target point in the target map;
[0039] A planning module, used to plan a travel route of the intelligent robot according to the starting position information and the end position information;
[0040] A judgment module, used for obtaining in real time information of obstacles encountered by the intelligent robot on the travel route, and judging whether the intelligent robot can directly pass through the obstacles according to the obstacle information;
[0041] The adjustment module is used to adjust the forward parameters of the intelligent robot according to the obstacle information to cross the obstacle or re-plan the travel route if the obstacle cannot be directly crossed.
[0042] Compared with the prior art, the intelligent robot obstacle avoidance navigation control method and system according to the embodiment of the present invention have the following beneficial effects:
[0043] The present invention obtains and calculates obstacle information on the route in real time, determines the probability of the intelligent robot crossing the obstacle, and can select different response measures according to the size of the probability, thereby further improving the obstacle avoidance efficiency and path planning accuracy of the intelligent robot. BRIEF DESCRIPTION OF THE DRAWINGS
[0044] Figure 1 is a flow chart of an intelligent robot obstacle avoidance navigation control method in an embodiment of the present invention;
[0045] Figure 2 It is a schematic diagram of the composition of the intelligent robot obstacle avoidance navigation control system in an embodiment of the present invention. DETAILED DESCRIPTION
[0046] The specific implementation methods of the present application are further described in detail below in conjunction with the accompanying drawings and examples. The following examples are used to illustrate the present invention, but are not intended to limit the scope of the present invention.
[0047] In the description of the present application, it should be understood that the terms "center", "up", "down", "front", "back", "left", "right", "vertical", "horizontal", "top", "bottom", "inside", "outside", etc., indicating orientations or positional relationships, are based on the orientations or positional relationships shown in the accompanying drawings, and are only for the convenience of describing the present application and simplifying the description, and do not indicate or imply that the method or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore should not be understood as a limitation on the present application.
[0048] The terms "first" and "second" are used for descriptive purposes only and should not be understood as indicating or implying relative importance or implicitly indicating the number of the indicated technical features. Thus, a feature defined as "first" or "second" may explicitly or implicitly include one or more of the features. In the description of this application, unless otherwise specified, "plurality" means two or more.
[0049] In the description of this application, it should be noted that, unless otherwise clearly specified and limited, the terms "installed", "connected", and "connected" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection, or it can be indirectly connected through an intermediate medium, or it can be the internal communication of two components. For ordinary technicians in this field, the specific meanings of the above terms in this application can be understood according to specific circumstances.
[0050] like Figure 1 As shown, in an embodiment of the present application, an intelligent robot obstacle avoidance navigation control method is provided, including: S100: acquiring a target map of the intelligent robot, and determining the starting position information of the intelligent robot and the end position information of the target point in the target map; S200: planning the travel route of the intelligent robot according to the starting position information and the end position information; S300: acquiring obstacle information encountered by the intelligent robot on the travel route in real time, and judging whether the intelligent robot can directly cross the obstacle according to the obstacle information; S400: if the obstacle cannot be directly crossed, adjusting the forward parameters of the intelligent robot according to the obstacle information to cross the obstacle or re-plan the travel route.
[0051] Furthermore, by acquiring obstacle information on the route in real time and calculating it in real time, the probability of the intelligent robot crossing the obstacle can be judged, and different response measures can be selected according to the size of the probability, further improving the intelligent robot's obstacle avoidance efficiency and path planning accuracy.
[0052] In an embodiment of the present application, an intelligent robot obstacle avoidance navigation control method is provided, wherein the real-time acquisition of obstacle information encountered by the intelligent robot on the travel route and the determination of whether the intelligent robot can directly cross the obstacle are performed based on the obstacle information. The method comprises: acquiring the obstacle information, wherein the obstacle information comprises orientation information, distance information and appearance size information; and comprehensively determining whether the intelligent robot can directly cross the obstacle based on the orientation information, distance information and appearance size information of the obstacle.
[0053] In an embodiment of the present application, an intelligent robot obstacle avoidance navigation control method is provided, wherein the method comprehensively judges whether the intelligent robot can directly cross the obstacle based on the position information, distance information and appearance size information of the obstacle, including: projecting the intelligent robot and the obstacle onto the target map in equal proportions based on the position information, distance information and appearance size information of the obstacle; deducting the gaps between the obstacles from the target map, and comparing the appearance sizes of the gaps with the projection of the intelligent robot; calculating the probability that the intelligent robot can directly cross the obstacle based on the comparison result, and if the probability of directly crossing the obstacle is greater than or equal to a preset maximum probability, the intelligent robot can directly cross the obstacle.
[0054] In an embodiment of the present application, an intelligent robot obstacle avoidance navigation control method is provided, wherein if the obstacle cannot be crossed directly, the forward parameters of the intelligent robot are adjusted according to the obstacle information to cross the obstacle or re-plan the travel route, including: if it is determined that the intelligent robot can cross the obstacle by adjusting its own travel parameters, the obstacle is crossed by adjusting its own travel parameters, and the robot continues to move forward along the travel route; if it is determined that the intelligent robot cannot cross the obstacle, the real-time position information of the intelligent robot is obtained, and the travel route is re-planned according to the real-time position information.
[0055] In an embodiment of the present application, an intelligent robot obstacle avoidance navigation control method is provided, wherein if it is determined that the intelligent robot can cross an obstacle by adjusting its own travel parameters, the method comprises: obtaining the probability of being able to directly cross the obstacle; if the probability of being able to directly cross the obstacle is between a preset maximum probability and a preset minimum probability, then determining that the intelligent robot can cross the obstacle by adjusting its own travel parameters; and calculating the straight-line distance of the gap between the intelligent robot and the obstacle based on the orientation information and distance information of the obstacle.
[0056] In an embodiment of the present application, a method for obstacle avoidance and navigation control of an intelligent robot is provided, wherein the intelligent robot crosses obstacles by adjusting its own travel parameters and continues to move forward along the travel route, including: obtaining the straight-line distance of the gap between the intelligent robot and the obstacle; and setting the turning speed and forward speed of the intelligent robot when crossing the obstacle according to the straight-line distance.
[0057] In an embodiment of the present application, a method for controlling obstacle avoidance and navigation of an intelligent robot is provided, wherein the turning speed and the forward speed of the intelligent robot crossing an obstacle are set according to the straight-line distance, including:
[0058] The obtained straight-line distance between the intelligent robot and the obstacle is set as △G;
[0059] And set the standard distance G0, the processing module is also used to set the first preset distance difference g1, the second preset distance difference g2, the third preset distance difference g3 and the fourth preset distance difference g4, and g1<g2<g3<g4; the processing module is also used to set the first preset working condition matrix A1 (a1, b1), the second preset working condition matrix A2 (a2, b2), the third preset working condition matrix A3 (a1, b1) and the fourth preset working condition matrix A4 (a4, b4), wherein a1-a4 are the first to fourth preset turning speeds respectively, and a1<a2<a3<a4, b1-b4 are the first to fourth preset forward speeds respectively, and b1<b2<b3<b4;
[0060] According to the difference between the obtained straight-line distance value △G and the set standard distance G0, a preset working condition matrix A is selected as the working condition for the intelligent robot to cross obstacles;
[0061] When △G-G0≤g1, the first preset working condition matrix A1 is selected as the working condition for the intelligent robot to cross obstacles;
[0062] When g1<△G-G0≤g2, the second preset working condition matrix A2 is selected as the working condition for the intelligent robot to cross obstacles;
[0063] When g2<△G-G0≤g3, the third preset working condition matrix A3 is selected as the working condition for the intelligent robot to cross obstacles;
[0064] When g3<△G-G0≤g4, the fourth preset working condition matrix A4 is selected as the working condition for the intelligent robot to cross obstacles.
[0065] In an embodiment of the present application, an intelligent robot obstacle avoidance navigation control method is provided, wherein if it is determined that the intelligent robot cannot cross the obstacle, the real-time position information of the intelligent robot is obtained, and the travel route is replanned according to the real-time position information, including: obtaining the probability of being able to directly cross the obstacle; if the probability of being able to directly cross the obstacle is less than or equal to a preset minimum probability, determining that the intelligent robot cannot cross the obstacle; obtaining the real-time position information of the intelligent robot, and replanning the travel route according to the real-time position information.
[0066] like Figure 2As shown, in an embodiment of the present application, an intelligent robot obstacle avoidance navigation control system is provided, including: an acquisition module, used to acquire a target map of the intelligent robot, and determine the starting position information of the intelligent robot and the end position information of the target point in the target map; a planning module, used to plan the travel route of the intelligent robot according to the starting position information and the end position information; a judgment module, used to acquire the obstacle information encountered by the intelligent robot on the travel route in real time, and judge whether the intelligent robot can directly cross the obstacle according to the obstacle information; an adjustment module, used to adjust the forward parameters of the intelligent robot according to the obstacle information to cross the obstacle or re-plan the travel route if the obstacle cannot be directly crossed.
[0067] In summary, the embodiment of the present invention provides an intelligent robot obstacle avoidance navigation control method and system, which includes: obtaining the target map of the intelligent robot, and determining the starting position information of the intelligent robot and the end position information of the target point in the target map; planning the route of the intelligent robot according to the starting position information and the end position information; obtaining the obstacle information encountered by the intelligent robot on the route in real time, and judging whether the intelligent robot can directly cross the obstacle according to the obstacle information; if the obstacle cannot be directly crossed, adjusting the forward parameters of the intelligent robot according to the obstacle information to cross the obstacle or re-plan the route. The present invention obtains the obstacle information on the route in real time, calculates it in real time, and judges the probability of the intelligent robot crossing the obstacle. Different response measures can be selected according to the size of the probability, which further improves the obstacle avoidance efficiency and path planning accuracy of the intelligent robot.
[0068] Finally, it should be noted that it is obvious that those skilled in the art can make various changes and modifications to the present invention without departing from the spirit and scope of the present invention. Thus, if these modifications and variations of the present invention fall within the scope of the claims of the present invention and their equivalents, the present invention is also intended to include these modifications and variations.
[0069] The above is only an example of implementation of the present invention, but it cannot be used to limit the scope of the present invention. Any structural changes made according to the present invention, as long as they do not lose the essence of the present invention, should be regarded as falling within the scope of protection of the present invention and being restricted. Those skilled in the art can clearly understand that for the convenience and simplicity of description, the specific working process and related instructions of the method described above can refer to the corresponding process in the aforementioned method embodiment, and will not be repeated here.
[0070] The term "comprise" or any other similar term is intended to cover a non-exclusive inclusion such that a process, method, article, or apparatus / method that comprises a list of elements includes not only those elements but also other elements not expressly listed or inherent to such process, method, article, or apparatus / method.
[0071] So far, the technical solutions of the present invention have been described in conjunction with the further embodiments shown in the accompanying drawings, but it is easy for those skilled in the art to understand that the protection scope of the present invention is obviously not limited to these specific embodiments. Without departing from the principle of the present invention, those skilled in the art can make equivalent changes or substitutions to the relevant technical features, and the technical solutions after these changes or substitutions will fall within the protection scope of the present invention.
[0072] The above are only preferred embodiments of the present invention and are not intended to limit the protection scope of the present invention.
Claims
1. An intelligent robot obstacle avoidance navigation control method, characterized in that: include: Acquire a target map of the intelligent robot, and determine the starting position information of the intelligent robot and the ending position information of the target point in the target map; Planning a travel route of the intelligent robot according to the starting position information and the end position information; Obtaining in real time information about obstacles encountered by the intelligent robot on the travel route, and judging whether the intelligent robot can directly pass through the obstacles according to the obstacle information; If the obstacle cannot be directly crossed, the forward parameters of the intelligent robot are adjusted according to the obstacle information to cross the obstacle or re-plan the travel route.
2. The intelligent robot obstacle avoidance navigation control method according to claim 1, characterized in that: The real-time acquisition of obstacle information encountered by the intelligent robot on the travel route, and judging whether the intelligent robot can directly pass through the obstacle according to the obstacle information, includes: Obtaining the obstacle information, wherein the obstacle information includes orientation information, distance information, and appearance size information; It is comprehensively judged whether the intelligent robot can directly pass through the obstacle based on the position information, distance information and appearance size information of the obstacle.
3. The intelligent robot obstacle avoidance navigation control method according to claim 2, characterized in that: The step of comprehensively judging whether the intelligent robot can directly pass through the obstacle based on the position information, distance information and appearance size information of the obstacle includes: According to the position information, distance information and appearance size information of the obstacle, the intelligent robot and the obstacle are projected onto the target map in equal proportions; Deduct the gaps between obstacles from the target map, and compare the apparent sizes of the gaps with the projection of the intelligent robot; The probability that the intelligent robot can directly cross the obstacle is calculated based on the comparison result. If the probability that the intelligent robot can directly cross the obstacle is greater than or equal to a preset maximum probability, the intelligent robot can directly cross the obstacle.
4. An intelligent robot obstacle avoidance navigation control method according to claim 3, characterized in that: If the obstacle cannot be directly crossed, adjusting the forward parameters of the intelligent robot according to the obstacle information to cross the obstacle or replanning the travel route includes: If it is determined that the intelligent robot can traverse the obstacle by adjusting its own traveling parameters, the intelligent robot traverses the obstacle by adjusting its own traveling parameters and continues to move forward along the traveling route; If it is determined that the intelligent robot cannot cross the obstacle, the real-time position information of the intelligent robot is obtained, and the travel route is replanned according to the real-time position information.
5. An intelligent robot obstacle avoidance navigation control method according to claim 4, characterized in that: If it is determined that the intelligent robot can cross obstacles by adjusting its own traveling parameters, the method includes: Get the probability of being able to directly cross the obstacle; If the probability of being able to directly cross the obstacle is between a preset maximum probability and a preset minimum probability, it is determined that the intelligent robot can cross the obstacle by adjusting its own travel parameters; The straight-line distance of the gap between the intelligent robot and the obstacle is calculated according to the orientation information and distance information of the obstacle.
6. An intelligent robot obstacle avoidance navigation control method according to claim 5, characterized in that: The step of adjusting the travel parameters to cross obstacles and continuing to move forward along the travel route includes: Obtaining the straight-line distance between the intelligent robot and the obstacle; The turning speed and forward speed of the intelligent robot crossing the obstacle are set according to the straight-line distance.
7. An intelligent robot obstacle avoidance navigation control method according to claim 6, characterized in that: The step of setting the turning speed and the forward speed of the intelligent robot crossing the obstacle according to the straight-line distance comprises: The obtained straight-line distance between the intelligent robot and the obstacle is set as △G; And set the standard distance G0, the processing module is also used to set the first preset distance difference g1, the second preset distance difference g2, the third preset distance difference g3 and the fourth preset distance difference g4, and g1<g2<g3<g4; the processing module is also used to set the first preset working condition matrix A1 (a1, b1), the second preset working condition matrix A2 (a2, b2), the third preset working condition matrix A3 (a1, b1) and the fourth preset working condition matrix A4 (a4, b4), wherein a1-a4 are the first to fourth preset turning speeds respectively, and a1<a2<a3<a4, b1-b4 are the first to fourth preset forward speeds respectively, and b1<b2<b3<b4; According to the difference between the obtained straight-line distance value △G and the set standard distance G0, a preset working condition matrix A is selected as the working condition for the intelligent robot to cross obstacles; When △G-G0≤g1, the first preset working condition matrix A1 is selected as the working condition for the intelligent robot to cross obstacles; When g1<△G-G0≤g2, the second preset working condition matrix A2 is selected as the working condition for the intelligent robot to cross obstacles; When g2<△G-G0≤g3, the third preset working condition matrix A3 is selected as the working condition for the intelligent robot to cross obstacles; When g3<△G-G0≤g4, the fourth preset working condition matrix A4 is selected as the working condition for the intelligent robot to cross obstacles.
8. An intelligent robot obstacle avoidance navigation control method according to claim 4, characterized in that: If it is determined that the intelligent robot cannot pass through the obstacle, obtaining the real-time location information of the intelligent robot, and replanning the travel route according to the real-time location information, including: Get the probability of being able to directly cross the obstacle; If the probability of being able to directly cross the obstacle is less than or equal to the preset minimum probability, it is determined that the intelligent robot cannot cross the obstacle; Acquire the real-time location information of the intelligent robot, and re-plan the travel route according to the real-time location information.
9. An intelligent robot obstacle avoidance navigation control system, characterized in that: include: An acquisition module, used to acquire a target map of the intelligent robot, and determine the starting position information of the intelligent robot and the end position information of the target point in the target map; A planning module, used to plan a travel route of the intelligent robot according to the starting position information and the end position information; A judgment module, used for obtaining in real time information of obstacles encountered by the intelligent robot on the travel route, and judging whether the intelligent robot can directly pass through the obstacles according to the obstacle information; The adjustment module is used to adjust the forward parameters of the intelligent robot according to the obstacle information to cross the obstacle or re-plan the travel route if the obstacle cannot be directly crossed.
Citation Information
Patent Citations
Obstacle avoidance method and robot
CN106272425A
Robot and obstacle avoidance method thereof, and computer readable storage medium
CN108733045A
Obstacle prevention structure of intelligent robot
CN110865640A
Obstacle avoidance method and apparatus for robot, robot, storage medium, and electronic device
US20240126299A1
Vehicle local trajectory planning method and system having multiple obstacle avoidance modes
WO2023178910A1
