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.

CN118915707APending Publication Date: 2024-11-08UNIV OF JINAN
View PDF 0 Cites 4 Cited by

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

Technical Problem

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.

Method used

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.

Benefits of technology

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.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118915707A_ABST
    Figure CN118915707A_ABST
Patent Text Reader

Abstract

The invention provides a double-AGV formation cooperative motion control method, which is mainly used for solving the motion control problem of double-AGV formation cooperative automatic carrying of super-long large workpieces, and ensures that a double-AGV fleet moves at a basic driving speed while realizing double-AGV formation cooperative motion control formation error convergence. The method comprises the following steps: firstly, analyzing a double-AGV formation cooperative motion process and determining a convergence target of formation errors between double vehicles; secondly, establishing a two-dimensional coordinate system in a double-AGV formation cooperative motion process, and performing kinematics analysis on the double-AGV formation cooperative motion process according to a rigid body kinematics principle; and finally, establishing a kinematics model in the formation cooperative motion process of the double AGVs based on the two-dimensional Cartesian coordinate system, so that the distance and angle deviation between the two AGVs in the formation cooperative motion process of the double AGVs can be converged at the same time, and in addition, the double AGVs can move at the basic driving speed while the convergence of the shape errors of the two AGVs is ensured.
Need to check novelty before this filing date? Find Prior Art

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