Double-vehicle collaborative carrying method and system for controlling relative displacement
By using PID control to adjust the movement parameters of the slave AGV in the dual-vehicle collaborative handling system, the problem of relative displacement of the master and slave AGV during turning is solved, and the stability and adaptability of the handling is improved. It is suitable for longer or heavier objects Transportation has expanded the scope of application.
Patent Information
- Application Number
- CN202411167520.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-23
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2044-08-23
AI Technical Summary
The existing two-vehicle collaborative handling method cannot avoid the relative displacement of the master and slave AGV during the turning process, affecting the safety and accuracy of handling, and lacks adaptability, and cannot cope with the needs of different objects under different paths and turning radii.
By setting the predetermined trajectory of the main AGV and obtaining its position and attitude information, adjusting the position of the slave AGV according to the material length, and calculating and adjusting the motion parameters of the slave AGV with PID control to control distance error, attitude error and lateral error, ensuring that the master and slave AGV are in Keep moving in a synchronous manner when turning.
It effectively avoids the relative displacement of objects during turning, improves the stability and safety of handling, is highly adaptable, meets the special needs of long or heavier objects, expands the application range, and improves the handling efficiency.
Smart Images

Figure CN118929116A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of automatic control technology, and in particular to a dual-vehicle collaborative transportation method and system for controlling relative displacement. Background Art
[0002] When transporting objects, some objects are long and heavy and need to be carried cooperatively by multiple carts. At the turning moment of transportation, the turning platform on the cart is needed to ensure the successful turning of the workpiece. This works better when handling lighter or smaller objects, but for longer or heavier objects, the performance of the turning platform may be insufficient and cannot provide stable turning support; and, during the turning process, the transported objects may undergo relative displacement between the front and rear sides, causing the objects to become unstable or shifted during the transportation process, which affects the safety and accuracy of the transportation; in addition, the existing collaborative transportation methods lack adaptability and cannot be flexibly adjusted to meet the needs of different objects under different transportation paths and turning radii, limiting their scope of application. Summary of the invention
[0003] In order to solve the problems existing in the above-mentioned prior art, the present invention provides a dual-vehicle collaborative transportation method and system for controlling relative displacement, which solves the technical problem that the existing dual-vehicle collaborative transportation method cannot avoid the relative displacement of the master and slave AGVs during the turning process, affecting the transportation safety, without setting up auxiliary turning mechanisms such as a turning platform.
[0004] A dual-vehicle collaborative transportation method for controlling relative displacement includes setting a predetermined trajectory of a master AGV and inputting the length of a material to be transported; obtaining the current position information and posture information of the master AGV, the position information and posture information of a slave AGV, and adjusting the position of the slave AGV according to the position information and posture information of the master AGV and the length of the material so that the master and slave AGVs keep moving in the same straight line; when the master AGV turns, calculating the distance error, posture error and lateral error between the master and slave AGVs, and using PID control to adjust the motion parameters of the slave AGV to control the three errors.
[0005] Furthermore, the adjustment of the position of the slave AGV requires calculating the target position (X Ftarget ,Y Ftarget ), the calculation formula is as follows:
[0006] X Ftarget =X L -L·cos(θ L )
[0007] Y Ftarget =Y L -L·sin(θ L )
[0008] Among them, (XL ,Y L ) is the center coordinate position of the main AGV, L is the material length, θ L The heading angle of the main AGV.
[0009] Furthermore, the distance error d is calculated as follows:
[0010]
[0011] Among them, (X L ,Y L ) and (X F ,Y F ) are the center coordinate positions of the master AGV and the slave AGV respectively, d X and d Y are the projections of the relative distance d between the master and slave AGVs in the horizontal and vertical directions respectively;
[0012] The calculation formula of the attitude error Δθ is as follows:
[0013]
[0014] Among them, θ L and θ F are the heading angles of the two AGVs respectively;
[0015] The calculation formula of the lateral error e1 is as follows:
[0016] e1=(Y F -Y L )·cos(θ L )-(X F -X L )·sin(θ L )
[0017] Furthermore, the use of PID control to adjust the three errors from the AGV posture control includes keeping the lateral error and the posture error at 0, and the distance error is the material length.
[0018] Furthermore, PID controls the distance error d and adjusts the speed or position of the slave AGV so that the slave AGV gradually approaches the set target position:
[0019]
[0020] PID controls the lateral error e1 and adjusts the lateral position of the slave AGV so that the slave AGV and the master AGV always run in a straight line:
[0021]
[0022] PID controls the posture error Δθ, adjusts the direction of the slave AGV, makes the posture of the slave AGV consistent with that of the master AGV, and keeps the slave AGV parallel to the master AGV:
[0023]
[0024] Furthermore, the control signals obtained by the PID control distance error d, the PID control lateral error e1, and the PID control posture error Δθ are weighted and synthesized as the integrated signal to control the slave AGV. The specific weighted synthesis process is as follows:
[0025] Set priorities for the control signals of the three PIDs, and then set initial weight coefficients for the PID control signals according to the priorities. The weight coefficient of the attitude error is ω Δθ , the lateral error weight coefficient is The distance error weight coefficient is ω d Then, the control signals of the three PIDs are weighted according to the initial weight coefficients to generate an integrated signal. The integrated signal is used to control the slave AGV. At the same time, the distance error, lateral error and posture error related data are obtained in real time to judge the tracking effect. The initial weight coefficient is dynamically adjusted based on the tracking effect until the tracking effect is optimal, that is, the sum of the errors in the three aspects is minimized.
[0026] A dual-vehicle collaborative handling system for controlling relative displacement applies a dual-vehicle collaborative handling method for controlling relative displacement, including a master AGV monitoring module, a master AGV control module, a slave AGV monitoring and control module, and a slave AGV tracking module. The master AGV monitoring module and the slave AGV monitoring module are respectively used to collect real-time position information and posture information of the master AGV and the slave AGV. The master AGV control module is used to obtain a set movement route to control the movement of the master AGV. The slave AGV tracking module is used to obtain the material length and the real-time position information and posture information of the master AGV and the slave AGV, and adjust the movement parameters of the slave AGV after processing to keep the master AGV and the slave AGV moving forward in coordination and avoid relative displacement between the two.
[0027] Furthermore, when the master AGV monitoring module monitors that the master AGV is moving straight, the slave AGV tracking module keeps the relative distance between the master and slave AGVs unchanged; when the master AGV monitoring module monitors that the master AGV is turning, the slave AGV tracking module adjusts the posture of the slave AGV synchronously according to the posture change of the master AGV, and uses the PID control method to ensure that the posture and position of the master and slave AGVs are synchronized during the turning process, ensuring consistency with the master AGV.
[0028] Furthermore, the slave AGV tracking module is provided with a distance error PID controller, a lateral error PID controller and a posture error PID controller. The distance error PID controller is used to eliminate the distance error d between the master and slave AGVs, and adjust the speed or position of the slave AGV so that the slave AGV gradually approaches the set target position. The lateral error PID controller is used to eliminate the lateral error e1 between the master and slave AGVs, and adjust the lateral position of the slave AGV so that the slave AGV and the master AGV always run in a straight line; the posture error PID controller is used to eliminate the posture error Δθ between the master and slave AGVs, and adjust the direction of the slave AGV so that the posture of the slave AGV is consistent with that of the master AGV, so that the slave AGV and the master AGV remain parallel.
[0029] Furthermore, the master AGV monitoring module and the slave AGV monitoring module both include GPS, IMU, laser radar, camera, wheel encoder, infrared sensor and communication module.
[0030] The beneficial effects of the present invention include:
[0031] 1. Solve the relative displacement problem: By acquiring and adjusting the position of the master and slave AGVs in real time, it is ensured that the transported objects do not undergo relative displacement when turning, thereby improving the stability and safety of transportation.
[0032] 2. Meet special handling needs: The present invention is particularly suitable for the handling needs of longer and heavier objects. It can maintain the stability of the objects under various complex paths and turning conditions, and meet the special working conditions where the workpiece cannot have relative movement with respect to the trolley and a moving or rotating pair cannot be installed on the trolley.
[0033] 3. Enhance system adaptability: Through flexible turning radius adjustment and real-time posture synchronization mechanism, this method can adapt to different handling tasks and expand the scope of application.
[0034] 4. Improve handling efficiency: reduce the pause and adjustment time caused by object shifting, and improve the overall handling efficiency and operation convenience. BRIEF DESCRIPTION OF THE DRAWINGS
[0035] Figure 1 Schematic diagram of following error model analysis.
[0036] Figure 2 Schematic diagram of the running trajectory of the master AGV and the slave AGV.
[0037] Figure 3 Motion state diagram of the master AGV, slave AGV and workpiece at the initial moment of the turning process.
[0038] Figure 4 Motion status diagram of the master AGV, slave AGV and workpiece in the first half of the turning process.
[0039] Figure 5 Motion status diagram of the master AGV, slave AGV and workpiece in the second half of the turning process.
[0040] Figure 6 Motion status diagram of the master AGV, slave AGV and workpiece at the end of the turning process.
[0041] Figure 7 Schematic diagram of a dual-vehicle collaborative handling system that controls relative displacement.
[0042] Figure 8 Schematic diagram of the movement of the master AGV and the slave AGV.
[0043] Fig. 9 The figure is a flow chart of a dual-vehicle collaborative transport method for controlling relative displacement. DETAILED DESCRIPTION
[0044] In order to make the purpose, technical scheme and advantages of the embodiments of the present application clearer, the technical scheme in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, rather than all of the embodiments. Therefore, the following detailed description of the embodiments of the present application provided in the drawings is not intended to limit the scope of the application for protection, but merely represents the selected embodiments of the present application. Based on the embodiments of the present application, all other embodiments obtained by those skilled in the art without making creative work belong to the scope of protection of the present application.
[0045] A dual-vehicle cooperative transport method for controlling relative displacement, such as Fig. 9 As shown, it includes setting the master AGV predetermined trajectory and inputting the length of the material to be transported; obtaining the current position information and posture information of the master AGV, the position information and posture information of the slave AGV, and adjusting the position of the slave AGV according to the position information and posture information of the master AGV and the length of the material, so that the master and slave AGVs keep moving in the same straight line; when the master AGV turns, the distance error, posture error and lateral error between the master and slave AGVs are calculated, and the motion parameters of the slave AGV including position and posture are adjusted by PID control to control the three errors. Specifically, the master AGV is the front vehicle and the slave AGV is the rear vehicle.
[0046] In addition, real-time monitoring is performed to determine whether the master AGV has reached the predetermined endpoint. If so, the master AGV stops moving, and after the slave AGV confirms that the master AGV has stopped, it gradually stops moving to complete the transport task; otherwise, the method is continued to be used to control the slave AGV.
[0047] In another embodiment, the slave AGV obtains the current position of the slave AGV, monitors the relative position and posture of the master AGV, and obtains the current posture of the slave AGV; and calculates the target position (X) of the slave AGV according to the position of the master AGV and the material length L. Ftarget ,Y Ftarget ), the calculation formula is as follows:
[0048] X Ftarget =X L -L·cos(θ L )
[0049] Y Ftarget =Y L -L·sin(θ L )
[0050] Among them, (X L ,Y L ) is the center coordinate position of the main AGV, L is the material length, θ L The heading angle of the main AGV.
[0051] In another embodiment, if Figure 1 As shown in the figure, after calculating the distance between the master and slave AGVs, the distance error between the master and slave AGVs is d, and the posture difference is Δθ,d X and d Y are the projections of the relative distance d between the two AGVs in the horizontal and vertical directions, β is the angle between the straight line d and the positive direction of the X axis, (X L ,Y L ) and (X F ,Y F ) are the center coordinate positions of the leader AGV and the follower AGV, θ L and θ F are the heading angles of the two AGVs, V xL 、V yL 、V xF 、V yF are the forward speed and lateral speed of the two AGVs in the vehicle body coordinate system, respectively. The distance error d is calculated as follows:
[0052]
[0053] Among them, (X L ,Y L ) and (X F ,Y F ) are the center coordinate positions of the master AGV and the slave AGV respectively, d X and d Y are the projections of the relative distance d between the master and slave AGVs in the horizontal and vertical directions respectively;
[0054] The calculation formula of the attitude error Δθ is as follows:
[0055] Δθ=θ L -θ F
[0056] Among them, θ L and θ F are the heading angles of the two AGVs respectively;
[0057] The calculation formula of the lateral error e1 is as follows:
[0058] e1=(Y F -Y L )·cos(θ L )-(X F -X L )·sin(θ L )
[0059] In another embodiment, the use of PID control to adjust the three errors of the slave AGV posture control includes keeping the lateral error and the posture error at 0, the distance error is the material length, and the lateral error refers to the error in the vertical direction of the line connecting the master AGV and the slave AGV.
[0060] In another embodiment, PID controls the distance error d and adjusts the speed or position of the slave AGV so that the slave AGV gradually approaches the set target position:
[0061]
[0062] PID controls the lateral error e1 and adjusts the lateral position of the slave AGV so that the slave AGV and the master AGV always run in a straight line:
[0063]
[0064] PID controls the posture error Δθ, adjusts the direction of the slave AGV, makes the posture of the slave AGV consistent with that of the master AGV, and keeps the slave AGV parallel to the master AGV:
[0065]
[0066] The control signals obtained by PID control distance error d, PID control lateral error e1, and PID control posture error Δθ are weighted and synthesized as integrated signals to control the slave AGV. The specific weighted synthesis process is as follows:
[0067] Set priorities for the control signals of the three PIDs, and then set initial weight coefficients for the PID control signals according to the priorities. The weight coefficient of the attitude error is ω Δθ , the lateral error weight coefficient is The distance error weight coefficient is ω d Then, the three PID control signals are weighted according to the initial weight coefficient to generate an integrated signal, and the integrated signal is used to control the slave AGV. At the same time, the distance error, lateral error and posture error related data are obtained in real time to judge the tracking effect. The initial weight coefficient is dynamically adjusted based on the tracking effect until the tracking effect is optimal, that is, the sum of the errors in the three aspects is minimized. Specifically:
[0068] Setting the attitude error has the highest priority, that is, the highest weight. The distance and lateral errors have the same priority, so similar weight ratios are required.
[0069]
[0070] Set the initial weight coefficient according to the priority, for example, the weight coefficient of the posture error is ω Δθ =0.5, the lateral error weight coefficient is The distance error weight coefficient is ω d =0.25, then run the system, observe the system response, and dynamically adjust the weight coefficients based on priority. For example, if it is found that the system performs poorly in distance control, the weight coefficient corresponding to the distance error can be increased, while the weight coefficients of the other two errors can be reduced, and vice versa. According to the system response, the appropriate weight coefficients are continuously adjusted (using methods such as grid search and particle swarm optimization to continuously search for the best weight coefficient combination) to eventually obtain a stable system.
[0071] Specifically, in order to make the master and slave AGVs always keep the same straight line motion at the turning moment, and there should be no relative displacement between the workpiece and the trolley, in addition, considering that for longer or heavier objects, the performance of the turning platform may be insufficient and cannot provide stable turning support, and the trolley cannot be installed with auxiliary turning modules such as rotating turntables or moving sliders, then the turning trajectories of the master and slave AGVs at the turning moment must be different, and the AGV trajectory is extended outward. The specific turning moment state diagram and master and slave AGV trajectory diagram are shown in the figure below. Figure 2-6 shown.
[0072] A dual-vehicle collaborative handling system for controlling relative displacement includes a master AGV monitoring module, a master AGV control module, a slave AGV monitoring control module and a slave AGV tracking module. The master AGV monitoring module and the slave AGV monitoring module are used to collect real-time position information and posture information of the master AGV and the slave AGV. The master AGV control module is used to obtain a set movement route to control the movement of the master AGV. The slave AGV tracking module is used to obtain the material length and the real-time position information and posture information of the master AGV and the slave AGV, and adjust the position and posture of the slave AGV after processing to keep the master AGV and the slave AGV moving forward in coordination and avoid relative displacement between the two.
[0073] Before handling, the system is initialized, the functions of each module are checked to be normal, the predetermined trajectory of the master AGV is set, and the material length is input for the follow-up control calculation of the slave AGV. The master AGV then moves along the predetermined trajectory and obtains the current position information and posture information; the slave AGV prepares for subsequent tracking control, adapts to the vehicle distance in advance, obtains the master AGV posture, etc., so as to measure and adjust the vehicle distance between the master and slave AGVs according to the material length.
[0074] When the predetermined end point is reached, the master AGV stops moving. After the slave AGV tracking module confirms that the master AGV has stopped through the master AGV monitoring module, it gradually controls the slave AGV to stop moving and completes the handling task.
[0075] In another embodiment, when the master AGV monitoring module monitors that the master AGV is moving straight, the slave AGV tracking module keeps the relative distance between the master and slave AGVs unchanged; when the master AGV monitoring module monitors that the master AGV is turning, the slave AGV tracking module adjusts the posture of the slave AGV synchronously according to the posture change of the master AGV, and uses the PID control method to ensure that the posture and position of the master and slave AGVs are synchronized during the turning process, ensuring consistency with the master AGV.
[0076] In another embodiment, the slave AGV tracking module is provided with a distance error PID controller, a lateral error PID controller and a posture error PID controller. The distance error PID controller is used to eliminate the distance error d between the master and slave AGVs, and adjust the speed or position of the slave AGV so that the slave AGV gradually approaches the set target position. The lateral error PID controller is used to eliminate the lateral error e1 between the master and slave AGVs, and adjust the lateral position of the slave AGV so that the slave AGV and the master AGV always run in a straight line; the posture error PID controller is used to eliminate the posture error Δθ between the master and slave AGVs, and adjust the direction of the slave AGV so that the posture of the slave AGV is consistent with that of the master AGV, so that the slave AGV and the master AGV remain parallel.
[0077] In another embodiment, the master AGV monitoring module and the slave AGV monitoring module both include GPS, IMU, laser radar, camera, wheel encoder, infrared sensor and communication module, wherein GPS is used to obtain the position of the vehicle, IMU is used to obtain the posture information of the vehicle, the laser radar and camera in the slave AGV monitoring module are used to monitor the relative position and posture of the master AGV, and the communication module is used to transmit the information collected by the module to the slave AGV tracking module; the wheel encoder is mainly used to measure the wheel angle and speed to achieve the control of the wheel angle and speed; the infrared sensor is mainly used to measure the distance between the master and slave AGVs and monitor whether the master and slave AGVs are lateral offset. The specific layout of the infrared sensor and the monitoring process are as follows:
[0078] Sensor layout:
[0079] Install infrared reflective plates on the left and right sides of the main AGV to ensure that the infrared sensor of the slave AGV can detect the reflected signal; install infrared sensors on the left and right sides of the slave AGV to ensure that they can cover the position of the reflection point of the main AGV.
[0080] Methods for detecting lateral deviation:
[0081] When the vehicle deviates laterally, the signals received from the left and right infrared sensors of the slave AGV will change, so that the relative deviation of the master and slave AGVs can be detected. The details are as follows:
[0082] Normal state:
[0083] When the master AGV and the slave AGV are in the same straight line, the infrared sensors on the left and right sides of the slave AGV should receive infrared signals of equal distance, that is, the distance difference detected by the left and right sensors is zero or within the allowable error range. The error range should be as small as possible, which is determined by the sensitivity and error of the actual sensor.
[0084] When the AGV deviates laterally (to the left or right), the signals detected by the infrared sensors on the left and right sides of the AGV will be different:
[0085] Leaning to the left: If the AGV deviates to the left, the distance of the left infrared sensor becomes shorter and the distance of the right infrared sensor becomes longer.
[0086] Deviating to the right: If the AGV deviates to the right, the distance of the infrared sensor on the right becomes shorter and the distance of the infrared sensor on the left becomes longer.
[0087] The above-mentioned embodiments only express the specific implementation methods of the present application, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the protection scope of the present application. It should be pointed out that, for ordinary technicians in this field, several variations and improvements can be made without departing from the technical solution concept of the present application, and these all belong to the protection scope of the present application.
Claims
1. A dual-vehicle collaborative transport method for controlling relative displacement, It is characterized in that It includes setting the predetermined trajectory of the master AGV and inputting the length of the material to be transported; obtaining the current position information and posture information of the master AGV, the position information and posture information of the slave AGV, and adjusting the position of the slave AGV according to the position information and posture information of the master AGV and the length of the material, so that the master and slave AGVs keep moving in the same straight line; when the master AGV turns, the distance error, posture error and lateral error between the master and slave AGVs are calculated, and the PID control is used to adjust the motion parameters of the slave AGV to control the three errors.
2. A dual-vehicle collaborative transport method for controlling relative displacement according to claim 1, It is characterized in that The adjustment of the position of the slave AGV requires calculating the target position (X Ftarget , Y Ftarget ), the calculation formula is as follows: X Ftarget =X L -L·cos(θ L ) AND Ftarget =And L -L·sin(θ L ) Among them, (X L , Y L ) is the center coordinate position of the main AGV, L is the material length, θ L The heading angle of the main AGV.
3. A dual-vehicle collaborative transport method for controlling relative displacement according to claim 1, It is characterized in that The distance error d is calculated as follows: Among them, (X L , Y L ) and (X F ,Y F ) are the center coordinate positions of the master AGV and the slave AGV respectively, d X and d Y are the projections of the relative distance d between the master and slave AGVs in the horizontal and vertical directions respectively; The calculation formula of the attitude error Δθ is as follows: Δθ=θ L -θ F Among them, θ L and θ F are the heading angles of the two AGVs respectively; The lateral error e 1 The calculation formula is as follows: e 1 =(Y F -Y L )·cos(θ L )-(X F -X L )·sin(θ L ) 4. A dual-vehicle cooperative transport method for controlling relative displacement according to claim 1, It is characterized in that The use of PID control to adjust the three errors from the AGV posture control includes keeping the lateral error and the posture error at 0, and the distance error is the material length.
5. A method for coordinated transport of two vehicles by controlling relative displacement according to claim 4, It is characterized in that PID controls the distance error d and adjusts the speed or position of the slave AGV to make the slave AGV gradually approach the set target position: PID control lateral error e 1 , adjust the lateral position of the slave AGV so that the slave AGV and the master AGV always run in a straight line: PID controls the posture error Δθ, adjusts the direction of the slave AGV, makes the posture of the slave AGV consistent with that of the master AGV, and keeps the slave AGV parallel to the master AGV:
6. A method for coordinated transport of two vehicles by controlling relative displacement according to claim 5, It is characterized in that The PID control distance error d and PID control lateral error e 1 The weighted synthesis of the control signal obtained by the PID control posture error Δθ is used as the integrated signal to control the slave AGV. The specific weighted synthesis process is as follows: Set priorities for the control signals of the three PIDs, and then set initial weight coefficients for the PID control signals according to the priorities. The weight coefficient of the attitude error is ω Δθ , the lateral error weight coefficient is The distance error weight coefficient is ω d Then, the control signals of the three PIDs are weighted according to the initial weight coefficients to generate an integrated signal. The integrated signal is used to control the slave AGV. At the same time, the distance error, lateral error and posture error related data are obtained in real time to judge the tracking effect. The initial weight coefficient is dynamically adjusted based on the tracking effect until the tracking effect is optimal, that is, the sum of the errors in the three aspects is minimized.
7. A dual-vehicle collaborative handling system that controls relative displacement. It is characterized in that A dual-vehicle collaborative transportation method for controlling relative displacement as described in any one of claims 1 to 6 is applied, comprising a main AGV monitoring module, a main AGV control module, a slave AGV monitoring and control module and a slave AGV tracking module, wherein the main AGV monitoring module and the slave AGV monitoring module are respectively used to collect real-time position information and posture information of the main AGV and the slave AGV, the main AGV control module is used to obtain a set movement route to control the movement of the main AGV, and the slave AGV tracking module is used to obtain the material length and the real-time position information and posture information of the main AGV and the slave AGV, and adjust the movement parameters of the slave AGV after processing to keep the main AGV and the slave AGV moving forward in a coordinated manner to avoid relative displacement between the two.
8. A dual-vehicle cooperative transport system for controlling relative displacement according to claim 7, It is characterized in that When the master AGV monitoring module monitors that the master AGV is moving straight, the slave AGV tracking module keeps the relative distance between the master and slave AGVs unchanged; when the master AGV monitoring module monitors that the master AGV is turning, the slave AGV tracking module adjusts the posture of the slave AGV synchronously according to the posture change of the master AGV, and uses the PID control method to ensure that the posture and position of the master and slave AGVs are synchronized during the turning process, ensuring consistency with the master AGV.
9. A dual-vehicle cooperative transport system for controlling relative displacement according to claim 8, It is characterized in that The slave AGV tracking module is provided with a distance error PID controller, a lateral error PID controller and a posture error PID controller. The distance error PID controller is used to eliminate the distance error d between the master and slave AGVs, adjust the speed or position of the slave AGV, and make the slave AGV gradually approach the set target position. The lateral error PID controller is used to eliminate the lateral error e between the master and slave AGVs. 1 , adjust the lateral position of the slave AGV so that the slave AGV and the master AGV always run in a straight line; the posture error PID controller is used to eliminate the posture error Δθ between the master and slave AGVs, adjust the direction of the slave AGV so that the posture of the slave AGV is consistent with that of the master AGV, and keep the slave AGV parallel to the master AGV.
10. A dual-vehicle cooperative transport system for controlling relative displacement according to claim 7, It is characterized in that The master AGV monitoring module and the slave AGV monitoring module both include GPS, IMU, laser radar, camera, wheel encoder, infrared sensor and communication module.
Citation Information
Patent Citations
Method for measuring posture of non-contact type excavator working device based on visual measurement
CN103900497A
Submersible AGV abut-joint method and system and submersible AGV
CN106379684A
Double-AGV cooperative carrying control system and method
CN110989526A
Double-steering-wheel automatic guided vehicle trajectory tracking control method and system
CN111273551A
Double-steering-wheel AGV path tracking method
CN112462760A
Cited By
Carrying device
CN120606750A
Distance-variable double-AGV synchronous collaborative transportation system and method
CN121300359A
