Double-AGV formation cooperative motion control method
By establishing a kinematic model of coordinated movement of dual AGV formations, using rigid body kinematics principles and lidar technology, the problem of convergence of distance and angle deviation in the dual AGV formation is solved, and the stable formation maintenance and basic driving speed of dual AGVs are achieved.
Patent Information
- Application Number
- CN202310491593.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2023-05-05
- Publication Date
- 2024-11-08
AI Technical Summary
In the coordinated motion control of dual AGV formations, it is difficult to ensure that the distance and angle deviation converge between dual AGVs simultaneously, which affects the formation maintenance and basic driving speed of dual AGVs.
By establishing a kinematic model of the coordinated movement of the dual AGV formation, using rigid body kinematic principles and two-dimensional Cartesian coordinate system, combining lidar mapping and positioning, the formation error between the two vehicles is calculated and closed-loop control is performed to ensure that the two vehicles are not allowed to be controlled. The distance and angle deviation between vehicles converge.
The convergence of formation error between the two vehicles during the coordinated movement of the dual AGV is achieved, ensuring that the stable operation of the dual AGV at the basic driving speed is achieved, and improving the coordinated movement efficiency and accuracy of the dual AGV formation.
Smart Images

Figure CN118915707A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of automatic driving control of mobile robots, and in particular to a method for controlling the coordinated motion of a dual AGV formation. Background Art
[0002] As AGVs are widely used in automatic material handling, the problem of automatic handling of large and long workpieces is solved by using a dual AGV formation to coordinate movement and automatically handle large and long workpieces. This can overcome the limitations of the size and carrying capacity of a single AGV, improve the utilization rate of a single AGV, effectively reduce costs, and achieve diversity in the handling solutions for large and long workpieces.
[0003] In the coordinated motion control of the dual AGV formation, it is necessary to control the dual AGVs to maintain the formation of the two AGVs and ensure that the dual AGVs run at the basic driving speed. In particular, when performing motion control on the dual AGV formation, it is necessary to ensure that the distance and angle deviation between the dual AGVs converge. Summary of the invention
[0004] The present invention proposes a dual AGV formation cooperative motion control method, which realizes the simultaneous convergence of the distance and angle deviation between the two vehicles during the dual AGV formation cooperative motion process.
[0005] The technical solution to realize the present invention is a dual AGV formation collaborative motion control method, and the specific steps are as follows.
[0006] Step 1, from Figure 1 From the diagram of the collaborative motion process of the dual AGV formation, the collaborative motion process of the dual AGV formation is analyzed to determine the convergence target of the formation error between the two vehicles.
[0007] Step 2, from Figure 2 From the coordinate system diagram of the dual AGVs, the coordinate system of the dual AGV formation collaborative motion process is established, and based on the principle of rigid body kinematics, the kinematic analysis of the dual AGV formation collaborative motion process is carried out.
[0008] Step 3, from Figure 3 From the analysis diagram of the collaborative kinematic model of the dual AGV formation, a kinematic model of the collaborative motion of the dual AGV formation is established based on the two-dimensional Cartesian coordinate system. The motion model needs to ensure that the dual AGVs can simultaneously adjust the formation error between the two vehicles to convergence, that is, control the convergence of the distance deviation and angle deviation between the two vehicles.
[0009] The present invention will be further described below in conjunction with the accompanying drawings. BRIEF DESCRIPTION OF THE DRAWINGS
[0010] Figure 1 This is a diagram of the collaborative movement process of a dual AGV formation.
[0011] Figure 2 This is the coordinate system diagram of the dual AGV.
[0012] Figure 3 This is the analysis diagram of the collaborative kinematics model of a dual AGV formation. DETAILED DESCRIPTION
[0013] In order to better understand the technical content of the present invention, the following description is given based on specific implementation schemes and drawings.
[0014] Step 1 mainly analyzes the collaborative motion process of the dual AGV formation and determines the convergence target of the formation error during the collaborative motion process of the dual AGV formation.
[0015] Step 1-1, from Figure 1 From the diagram of the coordinated motion process of the dual AGV formation, the dashed part of the vehicle body represents the theoretical position of the front vehicle (1) and the theoretical position of the rear vehicle (2), and the solid part of the vehicle body represents the actual position of the front vehicle (3) and the actual position of the rear vehicle (4); L g represents the target distance between the centers of the two vehicles, L f Indicates the actual distance between the centers of the two vehicles; Df 1 and Df 2 They respectively represent the angles between the two vehicles' forward directions and the line connecting the two vehicles' centers, that is, the angular deviation values of the two vehicles relative to the target attitude angle; in addition, the two vehicles are diagonally installed with lidar sensors for mapping and positioning.
[0016] Step 1-2: In order to ensure the formation maintenance and the basic driving speed of the two vehicles during the dual AGV formation coordination process, it is necessary to control the formation error convergence between the two vehicles, that is: Step 2 mainly establishes a two-dimensional coordinate system during the coordinated motion of the dual AGV formation, and performs kinematic analysis on the coordinated motion of the dual AGV formation based on the principle of rigid body kinematics.
[0017] Step 2-1, from Figure 2 From the coordinate system diagram of the dual AGV, a two-dimensional Cartesian coordinate system XOY is established on the plane where the dual AGVs are located. The position and posture of the world coordinate system where the single AGV is located can be expressed as g =[ X o Y o i ] T . Establish a local coordinate system on the AGV body xoy ,origin oLocated at the center of the dual AGV virtual spindle, the positive direction of the vehicle head is set to y Axis direction, according to the right-hand rule, clockwise 90 ° That is x In addition, the dual AGV guidance solution adopts the laser radar mapping and positioning method as a whole, which can accurately obtain the position information of the geometric center of the dual AGV under the global map. g 1 =[ X 1 Y 1 i 1 ] T and g 2 =[ X 2 Y 2 i 2 ] T .
[0018] Step 2-2, in global coordinates, according to the principle of rigid body kinematics, the instantaneous center of the speed of each wheel group during the coordinated motion of the dual AGV formation must intersect at one point, and the target control information of the eight differential wheel groups can be obtained. First, the instantaneous center of the rigid body motion is obtained based on the control information of the virtual spindles of the two vehicles; secondly, the control information of the virtual spindles 1 and 2 of vehicle 1 and vehicle 2 is calculated based on the instantaneous center; finally, the target control information of the virtual spindles of the two vehicles is used to calculate the target control information of the eight differential wheel group units.
[0019] Step 3, mainly based on the two-dimensional Cartesian coordinate system, establishes the kinematic model of the dual AGV formation collaborative motion control to achieve the convergence of the formation error of the dual AGV during the formation collaborative motion.
[0020] Step 3-1, from Figure 3 From the analysis diagram of the collaborative kinematics model of the dual AGV formation, d 1 and d 2 The two points are the front car and the rear car at a target distance of L_g The ideal position under the generalized coordinate system XOY; the position information of the two vehicle centers P1 and P2 are respectively ( x 1 , y 1 , i 1 )and( x 2 , y 2 , i2 ); The angle between the center line P1P2 of the two vehicles and the generalized coordinate system is the attitude angle of the two vehicle targets. According to the geometric relationship and the dot product and cross product of the vector, the angle between the center lines of the two vehicles of the dual AGV can be calculated. β 1 and β 2 ; After the target driving speed of the virtual main axis of the two vehicles is given, that is, the speed at point P ( V x , V y , w ), where the velocity coordinate system is defined in the ISO direction of travel. V x The positive direction, perpendicular to the forward direction and to the left, is V y Positive direction: the angular velocity direction is counterclockwise for positive and clockwise for negative.
[0021] Step 3-2, the distance deviation between the two vehicle centers is obtained based on the geometric relationship ΔL The angle deviation between the two vehicles Df 1 and Df 2 : 。
[0022] Step 3-3, then the dual AGV is relative to the ideal point d 1 and d 2 The deviation is: 。
[0023] Step 3-4, closed-loop control is performed according to the distance deviation and angle deviation between the two vehicles, and the speed information of the two vehicles can be determined (in the speed coordinate system of the virtual spindles of the two vehicles): 。
[0024] Step 3-5: Since the speeds of the two vehicles obtained in the above formula are in the speed coordinate system of the virtual spindles of the two vehicles, they need to be transformed into the body coordinates of the two vehicles. The collaborative kinematic model of the dual AGV formation is: in, K L >0, K φ>0, the kinematic model can well realize the coordinated movement of the dual AGVs in the formation, so that the formation error between the two vehicles converges while ensuring that the dual AGV fleet moves at the basic driving speed.
Claims
1. A dual AGV formation collaborative motion control method, characterized in that: The specific steps are: Step 1: Analyze the collaborative motion process of the dual AGV formation and determine the convergence target of the formation error between the two vehicles; Step 2: Establish the coordinate system of the dual AGV formation during the coordinated motion process, and perform kinematic analysis on the dual AGV formation during the coordinated motion process based on the rigid body kinematics principle; Step 3: Establish a kinematic model of the collaborative motion of the dual AGV formation based on a two-dimensional Cartesian coordinate system. The motion model needs to ensure that the dual AGVs can simultaneously adjust the formation error between the two vehicles until convergence, that is, control the distance deviation and angle deviation between the two vehicles to converge.
2. According to the method for controlling the coordinated motion of a dual AGV formation as described in claim 1, it is characterized in that: In step 1, the steps for analyzing the collaborative motion process of the two AGVs in formation and determining the convergence target of the formation error between the two vehicles are as follows: Step 1-1, the dashed line part of the vehicle body represents the theoretical position (1) of the front vehicle and the theoretical position (2) of the rear vehicle, and the solid line part of the vehicle body represents the actual position (3) of the front vehicle and the actual position (4) of the rear vehicle; L g represents the target distance between the centers of the two vehicles, L f Indicates the actual distance between the centers of the two vehicles; Δφ 1 and Δφ 2 They respectively represent the angles between the forward directions of the two vehicles and the line connecting the centers of the two vehicles, that is, the angle deviation values of the two vehicles relative to the target attitude angle; in addition, laser radar sensors are installed diagonally on the two vehicles for mapping and positioning; Step 1-2: In order to ensure the formation maintenance and the basic driving speed of the two vehicles during the dual AGV formation coordination process, it is necessary to control the formation error convergence between the two vehicles, that is: 。 3. According to the method for controlling the coordinated motion of a dual AGV formation as described in claim 1, it is characterized in that: In step 2, the coordinate system of the dual AGV formation during the coordinated motion process is established. Based on the principle of rigid body kinematics, the steps for kinematic analysis of the dual AGV formation during the coordinated motion process are as follows: Step 2-1: Establish a two-dimensional Cartesian coordinate system XOY on the plane where the dual AGVs are located. Then the position and posture of the world coordinate system where the single AGV is located can be expressed as ζ =[ X o Y o θ ] T , establish a local coordinate system on the AGV body xoy ,origin o Located at the center of the dual AGV virtual spindle, the positive direction of the vehicle head is set to y Axis direction, according to the right-hand rule, clockwise 90 ° That is x In addition, the dual AGV guidance solution adopts the laser radar mapping and positioning method as a whole, which can accurately obtain the position information of the geometric center of the dual AGV under the global map. ζ 1 =[ X 1 Y 1 θ 1 ] T and ζ 2 =[ X 2 Y 2 θ 2 ] T ; Step 2-2, under global coordinates, according to the principle of rigid body kinematics, the instantaneous center of the velocity of each wheel group during the coordinated motion of the dual AGV formation must intersect at one point, and the target control information of the eight differential wheel groups can be calculated; first, the instantaneous center of the rigid body motion is calculated based on the control information of the virtual spindles of the two vehicles; secondly, the control information of the virtual spindles 1 and 2 of vehicle 1 and vehicle 2 is calculated based on the instantaneous center; finally, the target control information of the virtual spindles of the two vehicles is used to calculate the target control information of the eight differential wheel group units.
4. According to the method for controlling the coordinated motion of a dual AGV formation as described in claim 1, it is characterized in that: In step 3, a kinematic model for the coordinated motion control of the dual AGV formation is established based on a two-dimensional Cartesian coordinate system. The steps to achieve the convergence of the formation error of the dual AGVs during the coordinated motion of the formation are as follows: Step 3-1, d 1 and d 2 The two points are the front car and the rear car at a target distance of L_g The ideal position under the generalized coordinate system XOY; the position information of the two vehicle centers P1 and P2 are respectively ( x 1 , y 1 , θ 1 )and( x 2 , y 2 , θ 2 ); The angle between the center line P1P2 of the two vehicles and the generalized coordinate system is the attitude angle of the two vehicle targets. According to the geometric relationship and the dot product and cross product of the vector, the angle between the center lines of the two vehicles of the dual AGV can be calculated. β 1 and β 2 ; After the target driving speed of the virtual main axis of the two vehicles is given, that is, the speed at point P ( V x , V y , w ), where the velocity coordinate system is defined in the ISO direction of travel. V x The positive direction, perpendicular to the forward direction and to the left, is V y Positive direction: the angular velocity direction is counterclockwise for positive and clockwise for negative; Step 3-2, the distance deviation between the two vehicle centers is obtained based on the geometric relationship ΔL The angle deviation between the two vehicles Δφ 1 and Δ φ 2 : Step 3-3, then the dual AGV is relative to the ideal point d 1 and d 2 The deviation is: Step 3-4, closed-loop control is performed according to the distance deviation and angle deviation between the two vehicles, and the speed information of the two vehicles can be determined (in the speed coordinate system of the virtual spindles of the two vehicles): Step 3-5: Since the speeds of the two vehicles obtained in the above formula are in the speed coordinate system of the virtual spindles of the two vehicles, they need to be transformed into the body coordinates of the two vehicles. The collaborative kinematic model of the dual AGV formation is: in, K L >0, K φ >0, the kinematic model can well realize the convergence of the formation error between the two vehicles during the coordinated movement of the dual AGVs in the formation while ensuring that the dual AGV fleet moves at the basic driving speed.
Citation Information
Cited By
Unmanned double-vehicle collaborative transportation system and trajectory tracking control method thereof
CN120447438A
An unmanned double-vehicle cooperative transportation system and a trajectory tracking control method thereof
CN120447438B
AGV double-vehicle linkage adaptive motion control method and system
CN120909256A
Mobile aircraft wing body docking equipment and method based on AGV (Automatic Guided Vehicle)
CN121291789A
