Irregular bogie chassis motion control algorithm
By collecting the actual state data of AGV and combining with PID control algorithms, the bogie angle and wheel speed are accurately controlled, and the driving error and instability of heavy-loaded AGV in complex environments is solved, achieving higher driving accuracy and stability , and reduces equipment costs.
Patent Information
- Application Number
- CN202411041373.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-31
- Publication Date
- 2024-12-06
AI Technical Summary
The existing AGV control algorithms cannot effectively control the steering and speed allocation of heavy-loaded AGVs in complex paths and variable environments, resulting in driving errors and instability.
Through driver feedback, encoder feedback and magnetic guide sensor data acquisition, combined with PID control algorithm, the target angle and speed allocation are calculated, the bogie angle and wheel speed are accurately controlled, and the adjustment value is set to reduce external force interference and improve control accuracy.
It realizes that the AGV drives stably along the preset path, reduces deviations, improves driving accuracy and stability, and reduces equipment costs and maintenance costs.
Smart Images

Figure CN119078950A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of AGV control, and in particular to an irregular bogie chassis motion control algorithm. Background Art
[0002] Traditional automated guided vehicles (AGVs) play an important role in industrial automation and logistics transportation. In order to control costs, heavy-duty AGVs often use irregular steering chassis. However, this design makes precise control of the bogie particularly important. Existing control algorithms often cannot fully cope with the driving needs of heavy-duty AGVs in complex paths and changing environments, especially in terms of steering control and speed distribution. Summary of the invention
[0003] In view of the problems existing in the prior art, the present invention provides an irregular bogie chassis motion control algorithm, which can accurately control the bogie of a heavy-load AGV, and comprises the following steps:
[0004] Step 1: Collect the actual speed of the wheels on the bogie through driver feedback, the actual angle of the bogie fed back by the encoder, and the data collected by the magnetic guidance sensor on the AGV; through comprehensive data collection, provide the necessary input information for subsequent precise control, and ensure that the algorithm can be adjusted based on the actual status.
[0005] Step 2: Obtain the offset e(t) of the existing AGV based on the data collected by the magnetic guidance sensor; obtain the structural parameters of each group of bogies of the AGV, and calculate a target angle θ using the PID control algorithm, which provides key parameters for subsequent bogie angle control and wheel speed distribution, and helps to reduce deviations during driving.
[0006] Step 3: Control the angle of each bogie according to the current angle; by controlling the angle of each bogie, the steering of the AGV can be made more precise, the accuracy of the driving path can be improved, and the driving error caused by improper steering can be reduced.
[0007] Step 4: Based on the calculated target angle θ and the known bogie structural parameters, the target angle of each group of bogies and the speed of each wheel can be calculated to ensure that the AGV can maintain stability and coordination when turning or going straight, reducing unstable driving or inaccurate steering caused by uneven speed.
[0008] Furthermore, since the angle of the bogie cannot be fixed like a steering wheel, it is easily disturbed by external factors, resulting in a deviation due to the speed being maintained. Therefore, it is necessary to set an adjustment value. By setting the adjustment value, the angle of the bogie can be fine-tuned to further improve the control accuracy and reduce unstable driving or inaccurate steering caused by uneven speed.
[0009] The beneficial effects of the present invention are as follows: by precisely controlling the angle of the bogie and the speed of the wheels, the AGV is ensured to travel stably along the preset path, reduce deviation, and improve driving accuracy; by reasonably allocating wheel speed and controlling the bogie angle, the stability of the AGV when turning or going straight is ensured, and driving instability caused by uneven speed or improper steering is reduced. By optimizing the control algorithm, the dependence on equipment is reduced, and the equipment cost and maintenance cost of heavy-load AGV are reduced. BRIEF DESCRIPTION OF THE DRAWINGS
[0010] Figure 1 This is a schematic diagram of the AGV walking path. Figure 2 This is a schematic diagram of the AGV walking path in Example 2. DETAILED DESCRIPTION
[0011] 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.
[0012] Embodiment 1, as Figure 1 As shown, an irregular bogie chassis motion control algorithm is used on AGV and is applicable to a variety of bogie chassis models. It is highly versatile. There are multiple bogies on the chassis of the AGV. Regardless of whether the number of bogies is three groups, five groups, or more than ten groups, this embodiment is described with three groups. For the convenience of description, they are named bogie a, bogie b, and bogie c. It includes the following steps:
[0013] Step 1: Collect the actual speed of the wheels on the bogie through driver feedback, the actual angle of the bogie fed back by the encoder, and the data collected by the magnetic guidance sensor on the AGV;
[0014] Step 2: Obtain the offset e(t) of the existing AGV based on the data collected by the magnetic guidance sensor; obtain the structural parameters of each group of bogies of the AGV, and then calculate a target angle θ, where the formula for calculating θ is:
[0015]
[0016] θ(t) is the target angle value of the steering wheel at time t, e(t) represents the offset of the AGV, which specifically means the deviation between the AGV and the magnetic stripe when the magnetic guide on the AGV scans the preset magnetic stripe. In this embodiment, the deviation is positive when the AGV is biased to the left, negative when it is biased to the right, and zero when it coincides with the magnetic stripe, i.e., the AGV is in the middle. K p is the proportionality coefficient, K i is the integral time coefficient, K dis the differential time coefficient, dt represents the accumulated time of the error value (offset) of e(t) from time 0 to time t, and de(t) / dt refers to the derivative of the offset with respect to time t, and the rate of change of the offset is calculated.
[0017] The structural parameters of the bogie include the wheelbase L between the left and right wheels on the bogie, and before the deviation correction, the center point of any bogie is selected as the balance point, and then the line between the balance point and the center point of the turning circle is used as the standard line, and then the length of the vertical line between the center point of each bogie and the standard line and the distance between the feet of the vertical of each bogie on the standard line are measured; finally, the turning angle and turning radius of each bogie are calculated according to the length of the vertical line, the distance between the feet of the vertical and the angle θ. In this embodiment, the bogie c is used as the balance point. At this time, the line CO between the center point C of the bogie c and the center point O of the turning circle is perpendicular to the center line of the bogie c, and then the length of the vertical line between the center point of other bogies and CO is measured, and the distance between the feet of the vertical of each bogie on CO is measured.
[0018] Step 3: Calculate the rotation angle of each bogie according to the calculated target angle θ and the structural parameters of the bogie, and distribute the speed of each wheel according to the rotation angle of the bogie.
[0019] In the actual movement of AGV, there will be two states: left deviation correction and right deviation correction. Figure 1 The figure shows the state of correcting to the left. The calculation method is:
[0020] Calculate the target rotation angle of bogie a and the turning radius of bogie a:
[0021] The target rotation angle of bogie a is θA=θ;
[0022] Turning radius of bogie a
[0023] Calculate the target rotation angle of bogie b and the turning radius of bogie c:
[0024] EO = AO × cosθ;
[0025] DO=EO-DE;
[0026] The target rotation angle of bogie b
[0027] Turning radius of bogie b
[0028] The target rotation angle of bogie c θC=0;
[0029] The turning radius CO of bogie c is CO=EO+EC.
[0030] The speed of each wheel is distributed according to the rotation angle of the bogie, and the calculation formula is:
[0031]
[0032]
[0033] In the operation, Va is the overall speed of bogie a, V is the overall speed of AVG, VaL is the left wheel speed of bogie a, and VaR is the right wheel speed of bogie a; Vb is the overall speed of bogie b, VbL is the left wheel speed of bogie b, and VbR is the right wheel speed of bogie b; Vc is the overall speed of bogie c, VcL is the left wheel speed of bogie c, VcR is the right wheel speed of bogie c, and L is the wheelbase between the left and right wheels on the bogie. In this embodiment, the specifications of each group of bogies are the same. A, B, and C are the center points of bogies a, b, and c, D and E are the vertical points of A and B at CO, and O is the center point of the turning circle. The values of BD, ED, AE, and EC are all measured in advance by a ruler or the like.
[0034] Step 4. Obtain the target speed of each bogie and each wheel through step 3. Since the bogie structure is in free mode, if this speed distribution is maintained for walking and correction, the bogie angle will deviate, resulting in pulling and other phenomena, which will cause the motor to have overcurrent, overload and other alarms. At this time, on the basis of the already allocated speed, in order to stabilize the bogie angle, it is necessary to add a speed adjustment value Δv. Δv is obtained by mapping the current angle of the AGV with the target angle of rotation. The current angle can be obtained through an angle encoder, etc. The larger the angle difference, the larger Δv, and vice versa. The direction of the bogie angle is defined in the application as positive for the left and negative for the right. Now we map the angle difference value of -10 degrees to -10 degrees according to a linear relationship to -50mm / s-50mm / s, and the angle difference = target angle of rotation - actual angle. Assume that the angle deviation value is calculated to be >=10 degrees, indicating that the actual angle still has to turn 10 degrees to the left, then the output Δv value is equal to 50mm / s, then the speed of the original two wheels is adjusted as follows:
[0035] VaL1=VaL-Δv,
[0036] VaR1=VaR+Δv,
[0037] VaL1 and VaR1 are the adjusted left and right wheel speeds of the bogie, and the same applies to other bogies.
[0038] At this time, VaL1 decreases on the original basis, and VaR1 increases on the original basis. At this time, the bogie a will turn left to correct the deviation to the left.
[0039] Embodiment 2, as Figure 2As shown, the other steps of this embodiment are the same as those of embodiment 1, but in this embodiment, the AGV is in a state of correcting deviation to the right, and the calculation method of step 3 and step 4 is:
[0040] Calculate the target rotation angle of bogie a and the turning radius of bogie a:
[0041] The target rotation angle of bogie a is θA=θ;
[0042] Turning radius of bogie a
[0043] Calculate the target rotation angle of bogie b and the turning radius of bogie c:
[0044] EO = AO × cosθ;
[0045] DO=EO+DE;
[0046] The target rotation angle of bogie b
[0047] Turning radius of bogie b
[0048] The target rotation angle of the bogie c is θC = 0;
[0049] The turning radius CO of bogie c = EO-EC.
[0050] The speed of each wheel is assigned according to the current angle θ, and the calculation formula is:
[0051]
[0052]
[0053] In the operation, Va is the overall speed of bogie a, V is the overall speed of AVG, VaL is the left wheel speed of bogie a, and VaR is the right wheel speed of bogie a; Vb is the overall speed of bogie b, VbL is the left wheel speed of bogie b, and VbR is the right wheel speed of bogie b; Vc is the overall speed of bogie c, VcL is the left wheel speed of bogie c, VcR is the right wheel speed of bogie c, and L is the wheelbase between the left and right wheels on the bogie. In this embodiment, the specifications of each group of bogies are the same. A, B, and C are the center points of bogies a, b, and c, D and E are the vertical points of A and B at CO, and O is the center point of the turning circle. The values of BD, ED, AE, and EC are all measured in advance.
[0054] Step 4: Since the deviation is corrected to the right, that is, the bogie turns right, and the calculated angle deviation value is greater than or equal to 10 degrees, it proves that our actual angle still needs to turn 10 degrees to the right, so the output Δv value is equal to -50mm / s, then the speed of the original two wheels is adjusted as follows:
[0055] VaL1=VaL-Δv,
[0056] VaR1=VaR+Δv,
[0057] VaL1 and VaR1 are the adjusted left and right wheel speeds of the bogie, and the same applies to other bogies.
[0058] At this time, VaL1 increases on the original basis, and VaR1 decreases on the original basis. At this time, the bogie a will turn right to correct the deviation to the right.
[0059] 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. An irregular bogie chassis motion control algorithm, characterized in that: The following steps are involved: Step 1: Collect the actual speed of the wheels on the bogie, the angle of the bogie in the current state, and the data collected by the magnetic guidance sensor on the AGV; Step 2: Obtain the offset e(t) of the existing AGV and the structural parameters of each bogie of the AGV according to the data collected by the magnetic guidance sensor, and calculate the target angle θ of the bogie rotation; Step 3: Calculate the target rotation angle of each set of bogies and the speed of each wheel according to the target angle θ and the structural parameters of the bogie; Step 4: Add the speed adjustment value to the wheel speed calculated in step 3.
