A differential AGV control method and system based on fuzzy control and cascade control
Through the combination of fuzzy control and cascade control, the trajectory tracking stability problem of AGV system in complex environments is solved, and the fast and accurate trajectory tracking and system stability of AGV are achieved, which is suitable for AGV control in complex environments.
Patent Information
- Application Number
- CN202111266589.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2021-10-28
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2041-10-28
AI Technical Summary
Due to its strongly coupled nonlinear characteristics, existing AGV control systems are difficult to achieve fast and accurate trajectory tracking control, especially when operating in complex environments.
Using a method based on fuzzy control and cascade control, the AGV kinematic model is constructed, combined with a fuzzy controller and a cascade control algorithm, the position error problem is decomposed, and the distance deviation and angle deviation are adjusted in real time are adjusted to realize the trajectory tracking control of AGV.
It realizes fast and accurate trajectory tracking of AGV, ensures the global stability of the system, and can effectively complete operating tasks in complex environments.
Smart Images

Figure CN114237214B_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the field of artificial intelligence technology, and in particular relates to a differential AGV control method and system based on fuzzy control and cascade control. Background Art
[0002] Automatic Guided Vehicles (AGV) is an intelligent device used in logistics handling systems and automated docking devices. It can use magnetic strips, lasers or QR codes for path tracking control, and can achieve unmanned operation in the factory. In recent years, with the advancement of laser navigation control and the maturity of intelligent control, the application of differential AGV based on laser SLAM navigation has become more and more common. However, since AGV itself includes multiple types of sensors, the AGV operating environment is complex and changeable, and the AGV itself has a complex structure, it determines that the AGV control system is a strongly coupled nonlinear system.
[0003] Therefore, it is urgent to provide an AGV control method for strongly coupled nonlinear systems. Summary of the invention
[0004] In order to achieve the above-mentioned purpose of the invention, in view of the defects in the prior art, the present invention provides a combination of fuzzy control and cascade control algorithms to build an AGV dynamic system, quickly adjust the AGV posture error, ensure that the AGV control system can quickly and accurately complete the operation task, and realize stable tracking control of the global system.
[0005] According to a first aspect of the technical solution of the present invention, a differential AGV control method based on fuzzy control and cascade control is provided, and the control method comprises the following steps:
[0006] Step (1): construct an AGV travel path, set multiple path points on the travel path, and set a priority focus deviation for each path point;
[0007] Step (2): When the AGV travels to a certain path point, the distance deviation level and angle deviation level of the current AGV are determined, and the AGV is processed in parallel by fuzzy control and cascade control according to the priority deviation of the path point;
[0008] Step (3): Based on the parallel processing results of fuzzy control and cascade control, the AGV continues to move forward or issues an alarm.
[0009] Furthermore, in the step (1), the priority focus deviation of the path point is the distance deviation or the angle deviation.
[0010] Furthermore, in step (2), the distance deviation and angle deviation levels include: negative large deviation, negative small deviation, zero deviation, positive small deviation, and positive large deviation.
[0011] Furthermore, the step (2) specifically includes:
[0012] Step (21): When the AGV travels to a certain path point, the distance deviation level and the angle deviation level of the current AGV are determined, and brought into the fuzzy controller to obtain the authority coefficient f(k1) of the distance deviation function and the authority coefficient f(k2) of the angle deviation function;
[0013] Step (22): Determine the priority focus deviation of the path point;
[0014] Step (23): With respect to the priority focus deviation of the path point, the authority coefficient f(k1) of the distance deviation function or the authority coefficient f(k2) of the angle deviation function is adjusted according to the fuzzy cascade function, thereby performing fuzzy control and cascade control in parallel.
[0015] Furthermore, in the step (21), the fuzzy function f(k) of the fuzzy controller is as shown in the following table, wherein, when k=k1, that is, the distance deviation function f(k1) takes a value, t=1; when k=k2, that is, the angle deviation function f(k2) takes a value, t=-1,
[0016]
[0017] Among them, f(k1) and f(k2) have one decimal place.
[0018] Furthermore, in step (23), the fuzzy cascade function is:
[0019] g(x,y,θ)=f(k1)f(x,y)+f(k2)f(θ)+f(x,y,θ),
[0020] v=v r +c2s e -c3ω r y e c2>0,c3>0
[0021] ω=ω r +c1θ e c1>0
[0022]
[0023]
[0024]
[0025]
[0026] f(θ)=-c1θ e
[0027] Where ω is the angular velocity of the AGV center point, v is the linear velocity of the AGV center point, and x e is the distance deviation in the x direction, y e is the distance deviation in the y direction, θ e is the angular deviation error, ω r is the reference angular velocity of the AGV center point, v r is the reference line speed of the AGV center point, h is the distance deviation of the AGV center, x r ,y r ,θ r are the reference coordinate values and reference orientation angles of the AGV, x, y, θ are the coordinate values and orientation angles of the AGV at the current moment, and c1, c2, c3 are constants greater than 0.
[0028] Furthermore, the step (23) specifically includes:
[0029] If the priority deviation of the waypoint is distance deviation, then:
[0030] Increase the authority coefficient f(k1) of the distance deviation function and ensure that 0.8≤f(k1)+f(k2)≤1.2, and bring the increased authority coefficient f(k1) and the authority coefficient f(k2) of the angle deviation function obtained in step (21) into the fuzzy cascade function to obtain the calculation result of the fuzzy cascade function;
[0031] If the priority deviation of the path point is the angle deviation, then:
[0032] Increase the authority coefficient f(k2) of the angle deviation function and ensure that 0.8≤f(k1)+f(k2)≤1.2. Substitute the increased authority coefficient f(k2) and the authority coefficient f(k1) of the distance deviation function obtained in step (21) into the fuzzy cascade function to obtain the calculation result of the fuzzy cascade function.
[0033] Furthermore, the step (3) specifically includes:
[0034] According to the calculation result of the fuzzy cascade function, if it is within the predetermined threshold range, continue to move forward; if it is not within the predetermined threshold range, continue to increase the authority coefficient f(k1) of the distance deviation function or the authority coefficient f(k2) of the angle deviation function according to the priority attention deviation of the path point until all values that meet 0.8≤f(k1)+f(k2)≤1.2 are traversed;
[0035] If after traversing all values that meet 0.8≤f(k1)+f(k2)≤1.2, none of them is within the predetermined threshold range, an alarm is triggered.
[0036] According to the second aspect of the technical solution of the present invention, a differential AGV control system based on fuzzy control and cascade control is provided, the system comprising: a processor and a memory for storing executable instructions; wherein the processor is configured to execute the executable instructions to execute the differential AGV control method based on fuzzy control and cascade control according to any of the above aspects.
[0037] According to the third aspect of the technical solution of the present invention, a computer-readable storage medium is provided, characterized in that a computer program is stored thereon, and when the computer program is executed by a processor, the differential AGV control method based on fuzzy control and cascade control according to any of the above aspects is implemented.
[0038] Beneficial effects of the present invention:
[0039] 1. The present invention adopts a fuzzy cascade control method to perform trajectory tracking control on the AGV, establishes an AGV kinematic model, and designs a trajectory tracking control law in combination with a fuzzy controller to make the vehicle tend to global stability.
[0040] 2.AGV can track the reference trajectory in real time and quickly, with good control effect. BRIEF DESCRIPTION OF THE DRAWINGS
[0041] Figure 1 is a flow chart of a method according to an embodiment of the present invention;
[0042] Figure 2 is a two-wheel differential drive AGV model according to an embodiment of the present invention;
[0043] Figure 3 is an AGV posture error model according to an embodiment of the present invention. DETAILED DESCRIPTION
[0044] The present invention is further described below with reference to the accompanying drawings and examples.
[0045] The technical solution of the present invention provides a differential AGV control method based on fuzzy control and cascade control, such as Figure 1 As shown, the control method includes the following steps:
[0046] Step (101): constructing an AGV travel path, setting a plurality of path points on the travel path, and setting a priority focus deviation for each path point;
[0047] Step (102): When the AGV travels to a certain path point, the distance deviation level and the angle deviation level of the current AGV are determined, and the AGV is subjected to fuzzy control and cascade control in parallel according to the priority deviation of the path point;
[0048] Step (103): Based on the parallel processing results of fuzzy control and cascade control, the AGV continues to move forward or issues an alarm.
[0049] The present invention adopts differential laser SLAM navigation method, such as Figure 2 As shown, the middle is the driving wheel, which is composed of a servo motor with a two-in-one driver. The motion trajectory of the AGV of the present invention includes straight lines, left turns, right turns, and rotations in place. The SLAM is installed in the front of the vehicle body, XOY is the coordinate system of the AGV movement, and the linear speeds of the left and right driving wheels are v and L and v R , and their angular velocities are ω L ,ω R The distance between the drive wheels is L, the angular velocity of the AGV center is ω, and the linear velocity is v. The midpoint C is the line connecting the centers of the left and right wheels, so the position of the car is P = [xyθ] T , the distance deviation between AGV and the reference path is h, and the angle deviation is θ. Before AGV moves, laser SLAM first maps the surrounding environment, extracts coordinates and allocates sites. AGV plans the path according to the site, and sends path instructions through the scheduling system. AGV runs according to SLAM navigation. During the operation, the distance deviation and angle deviation from the specified coordinates are eliminated. In the actual operation process, the posture of the AGV body is always deviated from the reference point, such as Figure 3 As shown, based on this, the AGV reference position is P r =[x r y r θ r ] T , based on the AGV motion model system, is defined as follows:
[0050]
[0051] The dynamic formula of its posture error is:
[0052]
[0053] From the above analysis, we can see that in the process of trajectory tracking, the main focus is on the posture error of AGV. Under any circumstances, the AGV satisfies formula (3) during operation.
[0054]
[0055] Cascade control method
[0056] The cascade control method is to decompose a complex nonlinear time-varying control system into two or more nonlinear time-varying control systems, and its significance lies in that the decomposed subsystems are easier to control. Combined with the differential AGV control of the present invention, the problem of positioning the coordinates of the center of the vehicle body (x, y) in its posture, and the problem of the vehicle body orientation angle θ. In the present invention, two subsystem functions, f(x, y), f(θ), f(x, y, θ) are constructed, and the authority coefficients f(k1) and f(k2) of the two subsystem functions are constructed using the fuzzy control method. The function f(θ) is constructed to meet global consistent stability, and its output is used as the input of the f(x, y) function. The result also meets global consistent stability, and the final function after matching with the authority system also meets the system asymptotic stability.
[0057] In the present invention, cascade control is defined as follows:
[0058]
[0059]
[0060]
[0061]
[0062]
[0063] f(θ)=-c1θ e (7)
[0064] f(θ) is a linear proportional function, so the function converges within the defined range. During the operation of the AGV, the speed has a certain range, and its angular velocity meets the continuous excitation condition of the cascade function. It can be concluded that f(x, y) converges within the defined range, and its coupling function f(x, y, θ) also converges. Combined with the fuzzy control theory, the AGV posture error is close to 0.
[0065] Fuzzy control method
[0066] In the trajectory tracking control of AGV, the distance deviation e h and the angular deviation e θ Real-time adjustment is required. On a specific path, sometimes the distance deviation or angle deviation needs to be adjusted first. Fuzzy control algorithm is used for adjustment. The input of the fuzzy controller is the distance deviation e h and the angular deviation e θ, the output is the authority coefficient of the distance deviation or angle deviation function. During the operation of AGV, the distance deviation and angle deviation are fuzzy processed, and five fuzzy subsets are defined, namely, negative large deviation (NB), negative small deviation (NS), zero deviation (ZE), positive small deviation (PS), and positive large deviation (PB). The authority system of distance deviation is defined according to the actual operation path of AGV, as shown in Table 1, where the distance deviation function f(k1) takes a value, t=1; the angle deviation function f(k2) takes a value, t=-1, and the values of f(k1) and f(k2) take only one decimal place.
[0067] Table 1 Fuzzy functions
[0068]
[0069] The output results of the fuzzy controller can be adjusted in a targeted manner on different paths to achieve the optimal adjustment effect. h is NB, and the angle deviation e θ When it is PB, the distance deviation function f(k1) takes a value of 0.9, and the angle deviation function f(k2) takes a value of 0.1.
[0070] The fuzzy cascade function is defined as follows:
[0071] g(x,y,θ)=f(k1)f(x,y)+f(k2)f(θ)+f(x,y,θ) (8)
[0072] For example, when the AGV is at a certain position away from the cache shelf, it is necessary to adjust the angle deviation first and increase the f(k2) authority coefficient. Since 0.8≤f(k1)+f(k2)≤1.2, and the distance deviation function f(k1) takes a value of 0.9, the values of f(k2) are 0, 0.1, 0.2, and 0.3. At this time, f(k2)=0.2 and f(k1)=0.9 are substituted into the fuzzy cascade function. If the calculation result is within the predetermined threshold range, the AGV continues to move forward. If the calculation result is not within the predetermined threshold range, the f(k2) authority coefficient continues to be increased, and f(k2)=0.3 and f(k1)=0.9 are substituted into the fuzzy cascade function. If the calculation result is within the predetermined threshold range, the AGV continues to move forward. If the calculation result is still not within the predetermined threshold range, an alarm is triggered.
[0073] Here, the predetermined threshold range of the fuzzy cascade function may be, for example, -10 to 10.
[0074] Before storing and retrieving goods from the cache shelf, the distance deviation is adjusted first and the f(k1) authority coefficient is increased. The operation is opposite to the above steps, so that the fuzzy controller can make targeted adjustments according to the on-site environment.
[0075] In summary, by adopting the fuzzy cascade control algorithm and decomposing the distance deviation and angle deviation, the AGV can quickly realize path tracking control. Combined with the fuzzy control theory, the AGV can complete the operation task of the differential AGV on a specific path, and the whole system tends to be asymptotically stable.
[0076] The embodiments of the present invention are described above, but the present invention is not limited to the above-mentioned specific implementation modes. The above-mentioned specific implementation modes are merely illustrative and not restrictive. Under the guidance of the present invention, ordinary technicians in this field can also make many forms without departing from the scope of protection of the purpose of the present invention and the claims, which are all within the protection of the present invention.
Claims
1. A differential AGV control method based on fuzzy control and cascade control, characterized in that: The control method comprises the following steps: Step (1): construct an AGV travel path, set multiple path points on the travel path, and set a priority focus deviation for each path point; Step (2): When the AGV travels to a certain path point, the distance deviation level and angle deviation level of the current AGV are determined, and the AGV is processed in parallel by fuzzy control and cascade control according to the priority deviation of the path point; Step (3): Based on the results of the parallel processing of fuzzy control and cascade control, the AGV continues to move forward or issues an alarm. Wherein, the step (2) specifically includes: Step (21): When the AGV travels to a certain path point, the distance deviation level and the angle deviation level of the current AGV are determined, and brought into the fuzzy controller to obtain the authority coefficient f(k1) of the distance deviation function and the authority coefficient f(k2) of the angle deviation function; Step (22): Determine the priority focus deviation of the path point; Step (23): For the priority deviation of the path point, according to the fuzzy cascade function, the authority coefficient f(k1) of the distance deviation function or the authority coefficient f(k2) of the angle deviation function is adjusted, thereby performing fuzzy control and cascade control in parallel. Wherein, in the step (23), the fuzzy cascade function is: g(x,y,θ)=f(k1)f(x,y)+f(k2)f(θ)+f(x,y,θ), v=v r +c2x e -c3ω r y e c2>0,c3>0 oh = oh r +c1θ e c1>0 f(θ)=-c1θ e Where ω is the angular velocity of the AGV center point, v is the linear velocity of the AGV center point, and x e is the distance deviation in the x direction, y e is the distance deviation in the y direction, θ e is the angular deviation error, ω r is the reference angular velocity of the AGV center point, v r is the reference line speed of the AGV center point, h is the distance deviation of the AGV center, x r ,y r ,θ r are the reference coordinate values and reference orientation angles of the AGV, x, y, θ are the coordinate values and orientation angles of the AGV at the current moment, and c1, c2, c3 are constants greater than 0.
2. The differential AGV control method according to claim 1, characterized in that: In the step (1), the priority deviation of the path point is the distance deviation or the angle deviation.
3. The differential AGV control method according to claim 1, characterized in that: In the step (2), the distance deviation and angle deviation levels include: negative large deviation, negative small deviation, zero deviation, positive small deviation, and positive large deviation.
4. The differential AGV control method according to claim 1, characterized in that: In the step (21), the fuzzy function f(k) of the fuzzy controller is as shown in the following table, wherein, when k=k1, that is, the distance deviation function f(k1) takes a value, t=1; when k=k2, that is, the angle deviation function f(k2) takes a value, t=-1, Among them, f(k1) and f(k2) have one decimal place.
5. The differential AGV control method according to claim 1, characterized in that: The step (23) specifically comprises: If the priority deviation of the waypoint is distance deviation, then: Increase the authority coefficient f(k1) of the distance deviation function and ensure that 0.8≤f(k1)+f(k2)≤1.2, and bring the increased authority coefficient f(k1) and the authority coefficient f(k2) of the angle deviation function obtained in step (21) into the fuzzy cascade function to obtain the calculation result of the fuzzy cascade function; If the priority deviation of the path point is the angle deviation, then: Increase the authority coefficient f(k2) of the angle deviation function and ensure that 0.8≤f(k1)+f(k2)≤1.
2. Substitute the increased authority coefficient f(k2) and the authority coefficient f(k1) of the distance deviation function obtained in step (21) into the fuzzy cascade function to obtain the calculation result of the fuzzy cascade function.
6. The differential AGV control method according to claim 1, characterized in that: The step (3) specifically comprises: According to the calculation result of the fuzzy cascade function, if it is within the predetermined threshold range, continue to move forward; if it is not within the predetermined threshold range, continue to increase the authority coefficient f(k1) of the distance deviation function or the authority coefficient f(k2) of the angle deviation function according to the priority attention deviation of the path point until all values that meet 0.8≤f(k1)+f(k2)≤1.2 are traversed; If after traversing all values that meet 0.8≤f(k1)+f(k2)≤1.2, none of them is within the predetermined threshold range, an alarm is triggered.
7. A differential AGV control system based on fuzzy control and cascade control, the system comprising: A processor and a memory for storing executable instructions; wherein the processor is configured to execute the executable instructions to execute the differential AGV control method based on fuzzy control and cascade control according to any one of claims 1 to 6.
8. A computer-readable storage medium, characterized in that: A computer program is stored thereon, and when the computer program is executed by a processor, the differential AGV control method based on fuzzy control and cascade control according to any one of claims 1 to 6 is implemented.
