Positioning navigation method for correcting AGV attitude based on magnetic nails
By setting magnetic nails on the AGV path and using magnetic nails to scan and calculate the AGV posture, the problem of high cost of gyroscopes in traditional AGV systems is solved, and high-precision linear walking is achieved, reducing costs and improving system reliability.
Patent Information
- Application Number
- CN202411041376.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-31
- Publication Date
- 2024-11-08
AI Technical Summary
The cost of using gyroscopes to correct walking deviations in traditional AGV systems increases procurement and use costs, while maintenance and replacement also adds additional burdens.
By setting magnetic nails at intervals on the AGV preset path, the walking deviation of AGV is monitored and corrected in real time by using the magnetic nail scanning and included angles, the correction angle θ of AGV is calculated, and the walking trajectory coordinates are calculated based on the left and right wheel speeds and wheel pitches, and the walking trajectory coordinates are calculated. Two wheels are tempted to maintain the correct posture and avoid relying on the gyroscope.
It realizes high-precision linear walking of AGV without a gyroscope, which reduces procurement and use costs, reduces equipment failure rate, improves system reliability and maintenance convenience, and enhances system flexibility and practicality.
Smart Images

Figure BDA0004972472900000031 
Figure BDA0004972472900000041 
Figure HDA0004972472910000011
Abstract
Description
Technical Field
[0001] The invention relates to the field of AGV control, and in particular to a positioning and navigation method for correcting the posture of an AGV based on magnetic nails. Background Art
[0002] An automated guided vehicle (AGV) is an industrial vehicle that automatically travels along a set route. In traditional AGV systems, a gyroscope is usually installed in the AGV to ensure that the AGV's posture is consistent with the preset path when it is walking in a straight line. The function of the gyroscope is to correct the deviation between the AGV centerline and the preset path caused by the inconsistent speed of the left and right wheels during the AGV's walking process. However, the price of the gyroscope is relatively expensive, which not only increases the purchase cost of the AGV, but also increases its use cost. In addition, the maintenance and replacement of the gyroscope also adds additional operating costs. Summary of the invention
[0003] In view of the problems existing in the prior art, the present invention provides a positioning and navigation method based on magnetic nails to correct the AGV posture, which can enable the AGV to achieve high-precision straight-line walking without a gyroscope, so as to reduce the purchase cost and use cost of the AGV. It includes the following steps:
[0004] Step 1. Magnetic nails are set at intervals on the preset walking path of the AVG. When the AGV is walking, the magnetic nails on the path are scanned in turn. The angle α between the actual walking path of the AGV in the current state and the preset walking path is obtained according to the scanning results. Then, the correction angle θ of the AGV is obtained according to the angle α. Through magnetic nail scanning and angle calculation, the walking deviation of the AGV can be monitored in real time, and the posture can be corrected in time to ensure that the AGV travels along the preset path.
[0005] Step 2: Calculate the coordinate values X, Y, and W of the AGV moving trajectory based on the AGV left wheel speed VL, right wheel speed VR, and the wheelbase D of the left and right wheels, where X represents the AGV travel distance, Y represents the offset between the AGV body center point and the preset travel path, and W represents the angle between the AGV center line and the preset travel path. This step accurately monitors the AGV's travel distance, offset, and yaw angle, providing accurate data support for subsequent posture adjustments.
[0006] Step 3: The AGV scans the magnetic nail. If the magnetic nail is scanned, the lateral deviation offset is equal to the actual scanned magnetic nail offset. If the magnetic nail is not scanned, offset is equal to the Y value in step 2, ensuring that the walking path of the AGV is always within the control range.
[0007] Step 4: The AGV adjusts its posture according to the data obtained in step 2 and walks until it scans the next magnetic nail, clears the previous walking distance X, and restarts the calculation of the walking distance. By clearing and recalculating the walking distance, the AGV scans at each magnetic nail point to accurately adjust its posture, avoid cumulative errors, and improve the continuity and accuracy of walking.
[0008] Step 5: Get the angle offset AngleDifference. During the walking process of the AGV, the difference between the W value and the θ value is used to control the walking direction of the AGV. This can ensure that the AGV always maintains the correct direction during the walking process and reduce the walking error caused by direction deviation.
[0009] Step 6: Eliminate the angle error value to improve the stability and accuracy of AGV walking.
[0010] Step 7: The AGV is adjusted in posture using the Y value calculated in step 3 and the AngleDifference calculated in step 5 to ensure that it can achieve high-precision straight-line walking without a gyroscope.
[0011] Furthermore, the calculation method for eliminating the angle error value in step 6 is:
[0012] Y(n)=kX(n)+(1-k)Y(n-1);
[0013] Where k is the filter coefficient, X(n) is the current sampling value, Y(n-1) is the output value of the previous filter, and Y(n) is the output value of this filter.
[0014] Furthermore, after calculating the left and right deviations offset and angle deviation AngleDifference, the AGV posture can be adjusted according to the two variables:
[0015] OutPutData=P×offset+I×AngleDifference;
[0016] Among them, OutPutData is the speed difference between the two wheels of AGV, P is the lateral deviation adjustment coefficient, and I is the angle deviation adjustment coefficient.
[0017] The beneficial effects of the present invention are as follows: by scanning the magnetic nails on the preset path and using an algorithm to compensate, the AGV can ensure that the AGV always maintains the correct posture during walking through a real-time posture monitoring and adjustment mechanism without a gyroscope, and achieves high-precision straight-line walking, thereby reducing the purchase cost and use cost of the AGV. At the same time, it reduces the dependence on the gyroscope, reduces the equipment failure rate, improves the reliability of the system and the convenience of maintenance, and by adjusting the speed difference between the two wheels, the AGV can flexibly adjust the posture according to the actual walking situation, thereby improving the flexibility and practicality of the system. BRIEF DESCRIPTION OF THE DRAWINGS
[0018] Figure 1 This is a schematic diagram of the AGV walking path.
[0019] Figure 2 This is an illustration of AGV walking. DETAILED DESCRIPTION
[0020] In order to enable those skilled in the art to better understand the technical solution, the technical solution is described in detail below in conjunction with the embodiments. The description in this section is only exemplary and explanatory and should not have any limiting effect on the scope of protection of the present invention.
[0021] Embodiment 1, a positioning and navigation method for correcting the posture of an AGV based on magnetic nails, comprising the following steps:
[0022] Step 1: Magnetic nails are set at intervals on the preset walking path of the AVG. During the walking process of the AGV, the magnetic nails on the path are scanned in sequence. According to the scanning results, the angle α between the actual walking path of the AGV in the current state and the preset walking path is obtained. Then, the correction angle θ of the AGV is obtained according to the angle α. The correction angle θ is the angle between the yaw angle of the vehicle body and the target straight line. The value of the correction angle θ is Figure 1 As shown in the figure, AC is the target straight line, BE is the actual walking path of the AGV, AB and CE are the offsets of the magnetic nails scanned twice consecutively, BD is the auxiliary line, DE value is equal to CE value minus AB value, α=arctan(DE / AC); assuming that the AVG center deviates to the left of the preset path as a positive value and to the right as a negative value, then when the CE value is greater than the AB value, the correction angle θ is equal to -α, otherwise, the correction angle θ is equal to α.
[0023] Step 2: Calculate the coordinate values X, Y, and W of the AGV moving trajectory according to the AGV left wheel speed VL, the right wheel speed VR, and the wheelbase D of the left and right wheels, where X represents the AGV travel distance, Y represents the offset between the AGV body center point and the preset travel path, and W represents the angle between the AGV center line and the preset travel path, that is, the body yaw angle obtained by integral calculation; the specific technical method is:
[0024] Let AVG center speed be V, left wheel speed be V L , the right wheel speed is V R , the rotation speed of the vehicle is ω, the turning radius is R, the distance between the two wheels of AVG is D, the distance from the two wheels to the center of the vehicle is d, the distance from the right wheel to the center of the circle is L, and the angle of AVG change in one cycle is β.
[0025] In the initial state, the left wheel speed and the right wheel speed can be obtained through sensors in the AVG, so:
[0026]
[0027] When adjusting the attitude, the values of the left and right wheel speeds are:
[0028] V L =V+ωd;
[0029] V R =V-ωd;
[0030] The d value is half of the D value.
[0031] In robot coordinates, the distance that the AGV moves at speed V per unit time Δt is: Δd = Δt × V, where the change per unit time Δt is calculated as: Δt = t i -t i-1 , t i For the time point of calculation, decompose this distance into the X and Y axes of the world coordinate system:
[0032] ΔX=Δd×cos(β)=Δt×V×cos(β);
[0033] ΔY=Δd×sin(β)=Δt×V×sin(β);
[0034] ΔW = ω × Δt;
[0035] ΔX, ΔY and ΔW are the changes in the X, Y and W values within the time Δt.
[0036] By integrating the movement of the mobile robot in continuous time in the above way, the position of the mobile robot in the world coordinate system at any time can be obtained, specifically:
[0037]
[0038] i refers to any point value in the time range of 0-t. Its initial value is 0 and its maximum value is t.
[0039] Step 3: The AGV scans the magnetic pin. If the magnetic pin is scanned, the lateral deviation offset is equal to the actual scanned magnetic pin offset. If the magnetic pin is not scanned, offset is equal to the Y value in step 2.
[0040] Step 4: The AGV adjusts its posture according to the data obtained in step 2 and walks until it scans the next magnetic nail. The previous walking distance X is cleared and the walking distance is calculated again. At the same time, X is used to determine the over-distance alarm. For example, a magnetic nail is arranged at an interval of 2 meters. If X reaches 2.5 meters and the next magnetic nail has not been scanned, an alarm can be triggered.
[0041] Step 5: Get the angle offset AngleDifference. When the AGV is moving, make a difference between the W value and the θ value to control the moving direction of the AGV.
[0042] Step 6: Since the encoder's integrated W will have cumulative errors over time, the angle error value needs to be eliminated during the AGV's walking process;
[0043] The calculation method to eliminate the angle error value is:
[0044] Y(n)=kX(n)+(1-k)Y(n-1);
[0045] Where k is the filter coefficient, X(n) is the current sampling value, Y(n-1) is the output value of the previous filter, and Y(n) is the output value of this filter.
[0046] Through filtering processing, the cumulative error caused by encoder integration can be reduced, the accuracy of angle measurement can be improved, and thus the navigation accuracy of AGV can be improved.
[0047] Step 7: Use the offset value calculated in step 3 and the AngleDifference calculated in step 5 to adjust the AGV’s posture:
[0048] OutPutData=P×offset+I×AngleDifference;
[0049] Where OutPutData is the speed difference between the two wheels of the AGV, P is the lateral deviation adjustment coefficient, I is the angle deviation adjustment coefficient, AngleDifference = W-θ.
[0050] By adjusting the speed difference between the two wheels, the posture can be accurately adjusted according to the lateral deviation and angle deviation to ensure that the walking path and direction of the AGV meet the preset requirements.
[0051] It should be noted that, in this article, the terms "include", "comprises" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. Specific examples are used in this article to illustrate the principle and implementation of the technical solution of the present invention. The above examples are only used to help understand the method of the present invention and its core idea. The above is only a preferred implementation of the present invention. It should be pointed out that due to the limitations of textual expression and the objective existence of infinite specific structures, for ordinary technicians in this technical field, without departing from the principle of the present invention, several improvements, modifications or changes can be made, and the above technical features can also be combined in an appropriate manner; these improvements, modifications, changes or combinations, or the direct application of the concept and technical solution of the present invention to other occasions without improvement, should be regarded as the protection scope of the present invention.
Claims
1. A positioning and navigation method based on magnetic nails to correct AGV posture, It is characterized in that The following steps are involved: Step 1: Magnetic nails are set at intervals on the preset walking path of the AGV. During the walking process of the AGV, the magnetic nails on the path are scanned in sequence. According to the scanning results, the angle α between the actual walking path of the AGV in the current state and the preset walking path is obtained, and then the correction angle θ of the AGV is obtained according to the angle α; Step 2: Calculate the coordinates X, Y, and W of the AGV moving trajectory based on the AGV left wheel speed VL and right wheel speed VR and the wheelbase D of the left and right wheels, where X represents the AGV travel distance, Y represents the offset between the AGV body center point and the preset travel path, and W represents the angle between the AGV center line and the preset travel path; Step 3: AGV scans the magnetic nail. If the magnetic nail is scanned, the lateral deviation offset is equal to the actual scanned magnetic nail offset. If the magnetic nail is not scanned, offset is equal to the Y value in step 2. Step 4: The AGV adjusts its posture according to the data obtained in step 2 and walks until it scans the next magnetic nail, clears the previous walking distance X, and starts to calculate the walking distance again; Step 5: Get the angle offset AngleDifference. During the AGV walking process, make a difference between the W value and the θ value to control the walking direction of the AGV. Step 6: Eliminate the angle error value; Step 7: Use the Y value calculated in step 3 and the AngleDifference calculated in step 5 to adjust the AGV's posture.
2. According to claim 1, a positioning and navigation method based on magnetic nails to correct the AGV posture, It is characterized in that The calculation method for eliminating the angle error value in step 6 is: Y(n)=kX(n)+(1-k)Y(n-1); Where k is the filter coefficient, X(n) is the current sampling value, Y(n-1) is the output value of the previous filter, and Y(n) is the output value of this filter.
3. According to claim 1, a positioning and navigation method based on magnetic nails to correct the AGV posture, It is characterized in that Through offset and angle deviation AngleDifference, the AGV is controlled to adjust its posture according to the two variables: OutPutData=P×offset+I×AngleDifference; Among them, OutPutData is the speed difference between the two wheels of AGV, P is the lateral deviation adjustment coefficient, and I is the angle deviation adjustment coefficient.
