Obstacle avoidance methods and devices during AGV turning and AGV
By calculating the AGV's speed and front wheel angle in real time and combining it with navigation radar detection, the system can flexibly avoid obstacles during turns, solving the problem that existing technologies cannot effectively avoid dynamic obstacles and improving the safety and adaptability of AGVs when turning.
Patent Information
- Application Number
- CN202510618835.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2025-05-14
- Publication Date
- 2026-11-17
AI Technical Summary
Existing AGV obstacle avoidance technology cannot effectively avoid dynamic obstacles during turning and requires extensive prior testing, making it impractical.
By acquiring the AGV's speed and front wheel angle in real time, calculating the safe distance through kinematic analysis, and combining this with navigation radar to detect obstacles, the driving strategy is adjusted in real time to avoid collisions.
It enables flexible avoidance of both static and dynamic obstacles, improves the safety and adaptability of AGV turning, and reduces reliance on fixed safety zones.
Smart Images

Figure CN123104633A_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the field of AGV technology, and in particular to an obstacle avoidance method, device, and AGV during the turning process of an AGV. Background Technology
[0002] Automated Guided Vehicles (AGVs) are transport vehicles equipped with electromagnetic or optical automatic guidance devices, enabling them to travel along a prescribed path and providing safety protection and various transfer functions. AGVs are battery-powered, driverless vehicles equipped with non-contact guidance systems. Their main function is to precisely travel and stop at designated locations under computer monitoring, according to path planning and operational requirements, to complete a series of tasks.
[0003] In existing technologies, common obstacle avoidance solutions for AGVs include the following:
[0004] (1) Use a combination of front wheel steering angle and speed in different gears to establish multiple safe zones;
[0005] (2) Set up turning reminder points on the guide medium before the turning section to remind vehicles that there is a turning section ahead and that they need to slow down to zero before changing the direction of travel.
[0006] Both of the aforementioned existing technologies require extensive preliminary work and testing in each area, making them impractical and unable to select the nearest safe zone based on vehicle conditions. Furthermore, both technologies can only avoid fixed obstacles during turning, not dynamic obstacles. Summary of the Invention
[0007] The main objective of this invention is to overcome the problems of the prior art and propose an obstacle avoidance method, device and AGV during the turning process of an AGV. It can calculate the safe distance on the expected trajectory in real time according to the vehicle speed and the front wheel turning angle. Once an obstacle enters the safe distance, it will immediately brake to ensure that the AGV does not collide with the obstacle.
[0008] The present invention adopts the following technical solution:
[0009] On the one hand, an obstacle avoidance method during AGV turning includes:
[0010] During the AGV's turning process, the current vehicle speed, front wheel angle, and front and rear wheel track are obtained in real time;
[0011] Based on the motion trajectory of the AGV during the turning process obtained from kinematic analysis, the ratio of the front and rear wheel wheelbase to the tangent of the front wheel turning angle is calculated to obtain the turning radius of the rear wheel; the braking arc distance of the rear wheel from the braking point to the stopping point is calculated, and the relationship angle between the braking arc distance and the rear wheel turning radius is obtained based on the ratio of the braking arc distance to the rear wheel turning radius; based on the rear wheel turning radius and the relationship angle, the braking straight distance from the braking point to the stopping point is obtained.
[0012] The safe turning angle and safe distance are obtained based on the braking straight distance, the relationship angle, and the front and rear wheelbase.
[0013] The navigation radar on the AGV controls whether there are obstacles within the safe turning angle range that are less than the safe distance; if there are, the brakes are applied; otherwise, the vehicle continues to move.
[0014] Preferably, the ratio of the front and rear wheelbases to the tangent of the front wheel steering angle is calculated to obtain the rear wheel turning radius, as shown below:
[0015]
[0016] Where R represents the rear wheel turning radius; L represents the front and rear wheel track; and δ represents the front wheel steering angle.
[0017] Preferably, the braking arc distance is expressed as follows:
[0018]
[0019] Among them, S b t0 represents the braking arc distance; v represents the current vehicle speed; t0 represents the braking response time of the braking device; a represents the deceleration.
[0020] Preferably, the relationship angle between the braking arc distance and the rear wheel turning radius is obtained based on the ratio of the braking arc distance to the rear wheel turning radius, as shown below:
[0021]
[0022] Where α represents the relation angle; S b R represents the braking arc distance; R represents the rear wheel turning radius.
[0023] Preferably, based on the rear wheel turning radius and the relationship angle, the braking straight-line distance from the braking point to the stopping point is obtained, as shown below:
[0024] l d =R*2sinα
[0025] Among them, l d R represents the straight-line braking distance; R represents the rear wheel turning radius; α represents the relationship angle.
[0026] Preferably, the safe turning angle and safe distance are obtained based on the braking straight-line distance, the relationship angle, and the front and rear wheelbases, as shown below:
[0027]
[0028] Where θ represents the safe turning angle; m represents the safe distance; l d α represents the braking straight-line distance; α represents the relationship angle; L represents the front and rear wheelbase.
[0029] Preferably, the navigation radar on the AGV is controlled to detect whether there are obstacles within the safe turning angle range that are less than the safe distance, specifically including:
[0030] The navigation radar on the AGV is controlled to detect whether there are obstacles within the safe turning angle range that are less than the safe distance, or whether there are obstacles within the safe turning angle positive and negative offset preset angle range that are less than the safe distance and the difference between the safe distance and the preset distance.
[0031] Preferably, the motion trajectory of the AGV during the turning process is obtained based on kinematic analysis, specifically as follows:
[0032] The motion trajectory of the AGV during turning is obtained by kinematic analysis based on a linear two-degree-of-freedom model.
[0033] On the other hand, an obstacle avoidance device for an AGV during turning includes:
[0034] The real-time data acquisition module is used to acquire the current vehicle speed, front wheel angle and front and rear wheel track in real time during the AGV turning process;
[0035] The motion trajectory data acquisition module is used to calculate the ratio of the front and rear wheel wheelbase to the tangent of the front wheel turning angle based on the motion trajectory of the AGV during the turning process obtained by kinematic analysis, and obtain the turning radius of the rear wheel; calculate the braking arc distance of the rear wheel from the braking point to the stopping point, and obtain the relationship angle based on the braking arc distance and the turning radius of the rear wheel; and obtain the braking straight distance from the braking point to the stopping point based on the turning radius of the rear wheel and the relationship angle.
[0036] The safe range calculation module obtains the safe turning angle and safe distance based on the braking straight distance, the relationship angle, and the front and rear wheelbase.
[0037] The driving control module is used to control the navigation radar on the AGV to detect whether there are obstacles within the safe turning angle range that are less than the safe distance; if there are, the brakes are applied; otherwise, the vehicle continues to travel.
[0038] In another aspect, an AGV includes: a navigation radar and a control module installed on top of the AGV; the control module implements the obstacle avoidance method during the turning process of the AGV.
[0039] As can be seen from the above description of the present invention, compared with the prior art, the present invention has the following beneficial effects:
[0040] (1) The present invention calculates the safe distance from obstacles on the predicted path of the AGV in real time based on the AGV speed and the front wheel angle and avoids them. Compared with the traditional pre-configured safe area, the present invention is more flexible, the obtained safe area of the AGV is more suitable for actual operating conditions, and can avoid both static and dynamic obstacles at the same time.
[0041] (2) This invention uses a linear two-degree-of-freedom model to simulate the motion characteristics of AGV when turning, performs kinematic analysis, and obtains the vehicle's motion trajectory. It has the advantages of high accuracy, fast calculation speed, and easy understanding and derivation.
[0042] (3) The present invention combines navigation radar to detect whether there are obstacles within the safe turning angle range that are less than the safe distance; when determining whether to brake, the safe turning angle and / or safe distance are redundantly designed, which further increases the turning safety and ensures that the AGV stops without colliding with obstacles. Attached Figure Description
[0043] Figure 1 This is a flowchart illustrating the obstacle avoidance method during the turning process of an AGV according to an embodiment of the present invention.
[0044] Figure 2 This is a schematic diagram of the vehicle motion trajectory obtained using a linear two-degree-of-freedom model according to an embodiment of the present invention;
[0045] Figure 3 This is a schematic diagram of the obstacle avoidance device during the turning process of the AGV according to an embodiment of the present invention. Detailed Implementation
[0046] The technical solutions of the present invention will be clearly and completely described below with reference to the accompanying drawings of the embodiments of the present invention. Obviously, the described embodiments are only some embodiments of the present invention, and not all embodiments. All other embodiments obtained by those skilled in the art based on the embodiments of the present invention without creative effort are within the scope of protection of the present invention.
[0047] In the description of this invention, it should be noted that the terms "comprising," "including," or any other variations thereof are intended to cover a non-exclusive inclusion, such that a process, method, article, or apparatus that comprises a list of elements includes not only those elements but also other elements not expressly listed, or elements inherent to such a process, method, article, or apparatus. Without further limitation, an element defined by the phrase "comprising one..." does not exclude the presence of other identical elements in the process, method, article, or apparatus that includes said element.
[0048] In the description of this invention, it should be noted that, unless otherwise explicitly specified and limited, the step identifiers S101, S102, S103, etc. are only used for convenience of description and do not indicate the execution order. The corresponding execution order can be adjusted as needed.
[0049] See Figure 1 As shown in the figure, this embodiment of an obstacle avoidance method during AGV turning includes the following steps:
[0050] S101 can obtain the current speed, front wheel angle and front and rear wheel track in real time during the AGV turning process;
[0051] S102, based on the motion trajectory of the AGV during the turning process obtained from kinematic analysis, calculate the ratio of the front and rear wheel wheelbase to the tangent of the front wheel turning angle to obtain the rear wheel turning radius; calculate the braking arc distance of the rear wheel from the braking point to the stopping point, and based on the ratio of the braking arc distance to the rear wheel turning radius, obtain the relationship angle between the braking arc distance and the rear wheel turning radius; based on the rear wheel turning radius and the relationship angle, obtain the braking straight-line distance from the braking point to the stopping point;
[0052] S103, based on braking straight distance, relationship angle and front and rear wheelbase, obtains safe turning angle and safe distance;
[0053] S104: Control the navigation radar on the AGV to detect whether there are obstacles within the safe turning angle range that are less than the safe distance; if so, apply the brakes; otherwise, continue driving.
[0054] In this embodiment, a linear two-degree-of-freedom model is used to simulate the motion characteristics of the AGV during turning, and kinematic analysis is performed to obtain the vehicle's trajectory. (See [link]). Figure 3 As shown.
[0055] Figure 2 In the diagram, O represents the steering center, A represents the rear wheel center, B represents the front wheel center and the navigation radar center (small yellow dot), and arc AC represents the trajectory S of the AGV's rear wheels after braking at point A. bThe distance of the rear wheel from the braking point to the stopping point is the braking arc distance; point C represents the position of the rear wheel after stopping; R is the turning radius of the rear wheel; L is the wheelbase between the front and rear wheels; the distance between points BC is m; the angle between BC and the direction of travel is θ, which is the safe turning angle; ∠BAC = α, which is the relationship angle; δ represents the front wheel turning angle; AC = l d This refers to the straight-line distance from the braking point to the stopping point of the rear wheel.
[0056] Based on the real-time acquired AGV operating speed v, braking system braking response time t0, and the deceleration that the AGV can provide, a (where a is a negative value), the braking arc distance is obtained as follows:
[0057] The rear wheel turning radius can be obtained based on the Ackermann steering model.
[0058] According to the law of sines, we can obtain... After simplification, we get l d =R*2sinα.
[0059] Based on the braking arc distance and the rear wheel turning radius, the relationship between the braking trajectory and the turning radius, i.e., the relationship angle, is obtained. From the beginning
[0060] In one step, it can be obtained from trigonometric function relationships:
[0061] msinθ=l d sinα
[0062] mcosθ=l d cosα-L
[0063] Combining the above two equations, we obtain the safe turning angle θ and the safe distance m, as follows:
[0064]
[0065] Furthermore, the navigation radar detects whether there are obstacles within a distance of less than m in the θ direction, within a preset angle range (e.g., ±2 degrees). If an obstacle is too close, the AGV applies the brakes; otherwise, the AGV continues to move.
[0066] It should be noted that when determining whether there is an obstacle at a distance less than the safe distance, a threshold redundancy design can also be implemented, that is, determining whether there is an obstacle at a distance less than the difference between the safe distance and the preset distance.
[0067] The obstacle avoidance method of the AGV during the turning process in this embodiment calculates the safe distance from the obstacle on the predicted path of the AGV in real time based on the AGV speed and the front wheel turning angle, and avoids it. Compared with the traditional pre-configured safe zone, the method of the present invention is more flexible, can make the safe zone of the AGV more suitable for actual operating conditions, and has better passability.
[0068] See Figure 3 As shown, corresponding to an obstacle avoidance method during AGV turning, this embodiment also discloses an obstacle avoidance device during AGV turning, comprising:
[0069] The real-time data acquisition module 301 is used to acquire the current vehicle speed, front wheel angle and front and rear wheel track in real time during the AGV turning process;
[0070] The motion trajectory data acquisition module 302 is used to calculate the ratio of the front and rear wheel wheelbase to the tangent of the front wheel turning angle based on the motion trajectory of the AGV during the turning process obtained by kinematic analysis, and obtain the turning radius of the rear wheel; calculate the braking arc distance of the rear wheel from the braking point to the stopping point, and obtain the relationship angle between the braking arc distance and the rear wheel turning radius based on the ratio of the braking arc distance to the rear wheel turning radius; and obtain the braking straight distance from the braking point to the stopping point based on the rear wheel turning radius and the relationship angle.
[0071] The safe range calculation module 303 obtains the safe turning angle and safe distance based on the braking straight distance, the relationship angle and the front and rear wheelbase;
[0072] The driving control module 304 is used to control the navigation radar on the AGV to detect whether there are obstacles within the safe turning angle range that are less than the safe distance; if there are, the brakes are applied; otherwise, the vehicle continues to drive.
[0073] The specific implementation of each module of the obstacle avoidance device during the turning process of an AGV is the same obstacle avoidance method during the turning process of an AGV, and will not be described again in this embodiment.
[0074] Furthermore, this embodiment also discloses an AGV, including: a navigation radar and a control module installed on top of the AGV; the control module implements the obstacle avoidance method during the AGV's turning process.
[0075] In one embodiment, the navigation radar is installed directly above the AGV vehicle, and the center of the navigation radar coincides with the center of the front wheel in the horizontal coordinate direction. This reduces coordinate transformations and improves detection speed and accuracy.
[0076] The above description is merely a preferred embodiment of the present invention; however, the scope of protection of the present invention is not limited thereto. Any equivalent substitutions or modifications made by those skilled in the art within the scope of the technology disclosed in the present invention, based on the technical solution and its improved concepts, should be covered within the scope of protection of the present invention.
Claims
1. An obstacle avoidance method during AGV turning, characterized in that, include: During the AGV's turning process, the current vehicle speed, front wheel angle, and front and rear wheel track are obtained in real time; Based on the motion trajectory of the AGV during the turning process obtained from kinematic analysis, the ratio of the front and rear wheel wheelbase to the tangent of the front wheel turning angle is calculated to obtain the turning radius of the rear wheel; the braking arc distance of the rear wheel from the braking point to the stopping point is calculated, and the relationship angle between the braking arc distance and the rear wheel turning radius is obtained based on the ratio of the braking arc distance to the rear wheel turning radius; based on the rear wheel turning radius and the relationship angle, the braking straight distance from the braking point to the stopping point is obtained. The safe turning angle and safe distance are obtained based on the braking straight distance, the relationship angle, and the front and rear wheelbase. The navigation radar on the AGV controls whether there are obstacles within the safe turning angle range that are less than the safe distance; if there are, the brakes are applied; otherwise, the vehicle continues to move.
2. The obstacle avoidance method for AGV turning process according to claim 1, characterized in that, Calculate the ratio of the front and rear wheelbases to the tangent of the front wheel steering angle to obtain the rear wheel turning radius, as shown below: Where R represents the rear wheel turning radius; L represents the front and rear wheel track; and δ represents the front wheel steering angle.
3. The obstacle avoidance method for AGV turning process according to claim 1, characterized in that, The braking arc distance is expressed as follows: Among them, S b t0 represents the braking arc distance; v represents the current vehicle speed; t0 represents the braking response time of the braking device; a represents the deceleration.
4. The obstacle avoidance method for AGV turning process according to claim 1, characterized in that, Based on the ratio of the braking arc distance to the rear wheel turning radius, the relationship angle between the braking arc distance and the rear wheel turning radius is obtained, as follows: Where α represents the relation angle; S b R represents the braking arc distance; R represents the rear wheel turning radius.
5. The obstacle avoidance method for AGV turning process according to claim 1, characterized in that, Based on the rear wheel turning radius and the relationship angle, the straight-line braking distance from the braking point to the stopping point is obtained, as shown below: L d < R*2sinα Among them, l d R represents the straight-line braking distance; R represents the rear wheel turning radius; α represents the relationship angle.
6. The obstacle avoidance method for AGV turning process according to claim 1, characterized in that, The safe turning angle and safe distance are obtained based on the braking straight-line distance, the relationship angle, and the front and rear wheelbases, as shown below: Where θ represents the safe turning angle; m represents the safe distance; l d α represents the braking straight-line distance; α represents the relationship angle; L represents the front and rear wheelbase.
7. The obstacle avoidance method for AGV turning process according to claim 1, characterized in that, The navigation radar on the AGV controls whether there are obstacles within the safe turning angle range that are less than the safe distance. Specifically, this includes: The navigation radar on the AGV is controlled to detect whether there are obstacles within the safe turning angle range that are less than the safe distance, or whether there are obstacles within the safe turning angle positive and negative offset preset angle range that are less than the safe distance and the difference between the safe distance and the preset distance.
8. The obstacle avoidance method for AGV turning process according to claim 1, characterized in that, The motion trajectory of the AGV during the turning process is obtained based on kinematic analysis, specifically as follows: The motion trajectory of the AGV during turning is obtained by kinematic analysis based on a linear two-degree-of-freedom model.
9. An obstacle avoidance device for AGVs during turning, characterized in that, include: The real-time data acquisition module is used to acquire the current vehicle speed, front wheel angle and front and rear wheel track in real time during the AGV turning process; The motion trajectory data acquisition module is used to calculate the ratio of the front and rear wheel wheelbase to the tangent of the front wheel turning angle based on the motion trajectory of the AGV during the turning process obtained by kinematic analysis, and obtain the turning radius of the rear wheel; calculate the braking arc distance of the rear wheel from the braking point to the stopping point, and obtain the relationship angle between the braking arc distance and the rear wheel turning radius based on the ratio of the braking arc distance to the rear wheel turning radius; and obtain the braking straight distance from the braking point to the stopping point based on the rear wheel turning radius and the relationship angle. The safe range calculation module obtains the safe turning angle and safe distance based on the braking straight distance, the relationship angle, and the front and rear wheelbase. The driving control module is used to control the navigation radar on the AGV to detect whether there are obstacles within the safe turning angle range that are less than the safe distance; if there are, the brakes are applied; otherwise, the vehicle continues to travel.
10. An AGV, characterized in that, include: A navigation radar and control module are installed above the AGV; the control module implements the obstacle avoidance method for the AGV during turning as described in any one of claims 1 to 8.
