Tracking control method for unmanned articulated roller truck based on four antennas
By using a four-antenna GPS system and measurement deviation correction method on the unmanned articulated roller car, the problem of non-coincidence during the backward process is solved, and high-precision forward and backward tracking is achieved, ensuring the rolling machine Trajectory accuracy and coincidence.
Patent Information
- Application Number
- CN202211001240.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-08-19
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2042-08-19
AI Technical Summary
The existing technology is difficult to meet the high-precision tracking requirements of unmanned articulated roller trucks during the backing process, especially because the GPS positioning system has positioning deviations when the differential signal is unstable, resulting in the tracking of the front and rear roller machines that do not overlap, affecting the rollers. Pressure mass.
Using a four-antenna GPS positioning system, two antennas are arranged horizontally in the front body and two antennas are arranged horizontally in the rear body. By calculating the positioning and inclination information of the front and rear body, the lateral measurement deviation is indirectly calculated and compensated for the lateral measurement deviation to ensure the accuracy of the backward process. .
High-precision overlap of the forward and backward tracking process is achieved, ensuring the trajectory accuracy and overlap of the rolling machine. In multiple actual vehicle tests, the tracking accuracy is within 20cm, and the deviation of the front and backward tracking process is within 5cm.
Smart Images

Figure CN115407773B_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the technical field of unmanned driving, and in particular relates to a tracking control method for an unmanned articulated roller vehicle based on four antennas. Background Art
[0002] Existing technical solutions mostly adopt a single GPS antenna solution or a dual GPS antenna solution. The GPS antenna is arranged on the front body of the vehicle, arranged longitudinally or transversely, and is used to measure the positioning information and heading information of the roller.
[0003] This method can be used for positioning and orientation during the forward process, but it is difficult to meet the high-precision tracking requirements during the backward process. During the backward process, an angle encoder is used to measure the angle between the front and rear bodies, and the GPS information of the front body is superimposed to infer the positioning and orientation of the rear body. This calculation process will face calculation errors caused by the delay of different sensor changes, which is difficult to compensate; as well as the superposition of errors between sensors, resulting in large tracking errors during the backward process.
[0004] During the actual testing of the GPS positioning system, it was found that sometimes, especially when the differential signal was unstable, there was a positioning deviation between the systems, with the deviation value being approximately between 10 and 200 cm. This would cause the front and rear tracking processes of the roller to not overlap, resulting in a decrease in the rolling quality. Summary of the invention
[0005] The purpose of the present invention is to solve the problem that there is a non-overlapping situation in the front and rear tracking processes of a roller, and to propose a tracking control method for an unmanned articulated roller based on four antennas.
[0006] The present invention is achieved through the following technical solutions:
[0007] A tracking control method for an unmanned articulated roller based on four antennas, wherein a GPS positioning system is arranged on the unmanned articulated roller, and the GPS positioning system includes four antennas, wherein two antennas are arranged on the front body of the roller, and the two antennas are arranged in the transverse direction of the front body, and are respectively located at the left and right ends of the front body, and the two antennas are symmetrically placed; the other two antennas are arranged on the rear body of the roller, and the two antennas are arranged in the transverse direction of the rear body, and are respectively located at the left and right ends of the rear body, and the two antennas are symmetrically placed;
[0008] The tracking control method of an unmanned articulated roller vehicle based on four antennas includes the following steps:
[0009] Step 1: Initially, it is a forward process, and the target lateral error is set to 0;
[0010] Step 2, the roller moves forward along the set straight path;
[0011] Step 3: Determine whether the end point has been reached during the forward process. If so, proceed to step 4; if not, continue to step 2.
[0012] Step 4, when reaching the end point, based on the positioning and heading information obtained by the two antennas of the front vehicle body and the inclination information of the front vehicle body detected by the inclination sensor, calculate the lateral distance error L1 between the front vehicle body and the set end point position, based on the positioning and heading information obtained by the two antennas of the rear vehicle body and the inclination information of the rear vehicle body detected by the inclination sensor, calculate the lateral distance error L2 between the rear vehicle body and the set end point position; the calculation formulas of the lateral distance errors L1 and L2 are shown in the following formulas.
[0013]
[0014] A=y1-y2
[0015] B=x2-x1
[0016] C=(x1-x2)y1-(y1-y2)x1
[0017] In the formula, (x1, y1) is the starting point coordinate of the set path, (x2, y2) is the end point coordinate of the set path, (x fc ,y fc ) is the positioning coordinate of the front vehicle body after correction, x fc =x fm -hsinα f cosα f ,y fc =y fm +hsin 2 α f ,(x fm ,y fm ) represents the GPS positioning measurement point coordinates of the front vehicle body, α f It represents the tilt angle of the front vehicle body measured by the tilt sensor, and h represents the height from the GPS antenna to the bottom of the vehicle;
[0018]
[0019] A=y1-y2
[0020] B=x2-x1
[0021] C=(x1-x2)y1-(y1-y2)x1
[0022] In the formula, (x1, y1) is the starting point coordinate of the set path, (x2, y2) is the end point coordinate of the set path, (x rc ,y rc ) is the positioning coordinate of the rear vehicle body after correction, x rc =xrm -hsinα r cosα r ,y rc =y rm +hsin 2 α r ,(x rm ,y rm ) represents the GPS positioning measurement point coordinates of the rear vehicle body, α r It indicates the inclination angle of the rear vehicle body measured by the inclination sensor, and h indicates the height from the GPS antenna to the bottom of the vehicle;
[0023] Then, based on the positioning data of the front vehicle body, the estimated distance error of the rear vehicle body is indirectly calculated. Subtract the lateral distance error L2 to obtain the lateral measurement deviation L 2,ref :
[0024]
[0025] The calculation formula is:
[0026] in, l f is the front body length, l r is the rear body length, β f is the front vehicle heading angle, β r is the rear body heading angle;
[0027] Determine the lateral measurement deviation L 2,ref Is the absolute value of greater than the set threshold? If so, proceed to step 5; if not, proceed to step 6;
[0028] Step 5: Set the target lateral error of the retreat process equal to the lateral measurement deviation L 2,ref ;
[0029] Step 6, setting the target lateral error of the retreat process equal to 0;
[0030] Step 7, the roller performs a backward process;
[0031] Step 8, the backward process determines whether the starting point has been reached. If the starting point has been reached, the process proceeds to step 9. If the starting point has not been reached, the process proceeds to step 7.
[0032] Step 9, determine whether the rolling task is completed. If completed, end the operation. If not completed, continue to step 2.
[0033] The advantages and beneficial effects of the present invention are:
[0034] The roller compactor of the present invention adopts a four-antenna GPS system and a measurement deviation correction method, which can ensure high accuracy and high overlap in the forward and backward tracking process, solve the problem of positioning deviation between different GPS systems, and ensure the track overlap in the forward and backward tracking process. In multiple real vehicle tests, the tracking accuracy of the roller compactor can be guaranteed to be within 20cm, and the forward and backward track deviation can be guaranteed to be within 5cm. BRIEF DESCRIPTION OF THE DRAWINGS
[0035] Figure 1 It is a side view of the arrangement of the roller GPS positioning system of the present invention.
[0036] Figure 2 It is a top view of the arrangement of the roller GPS positioning system of the present invention.
[0037] Figure 3 It is a front view of the front body of the roller.
[0038] Figure 4 This is a top view of the roller compactor.
[0039] Figure 5 It is a flow chart of the roller tracking control method of the present invention.
[0040] For ordinary technicians in this field, other relevant drawings can be obtained based on the above drawings without any creative work. DETAILED DESCRIPTION
[0041] In order to enable those skilled in the art to better understand the technical solution of the present invention, the technical solution of the present invention is further described below in conjunction with specific embodiments.
[0042] The tracking control method of the unmanned articulated roller vehicle based on four antennas of the present invention is as follows:
[0043] See attached Figure 1-2 A GPS positioning system is set on the unmanned articulated roller, and the GPS positioning system includes four antennas. Among the four antennas, two antennas 201 and 202 are set on the front body of the roller, and the two antennas are arranged along the transverse direction of the front body, respectively located at the left and right ends of the front body, and the two are placed symmetrically; the other two antennas 203 and 204 are set on the rear body of the roller, and the two antennas are arranged along the transverse direction of the rear body, respectively located at the left and right ends of the rear body, and the two are placed symmetrically; when the front body is in the initial position (that is, when the front body is not turning), the four antennas are arranged in a rectangular shape.
[0044] The tracking control method of unmanned articulated roller based on four antennas is shown in the attached Figure 5 , including the following steps:
[0045] Step 1: Initially, it is a forward process, and the target lateral error is set to 0;
[0046] Step 2, the roller moves forward along the set straight path;
[0047] Step 3: Determine whether the end point has been reached during the forward process. If so, proceed to step 4; if not, continue to step 2.
[0048] Step 4, when reaching the end point, based on the positioning and heading information obtained by the two antennas of the front vehicle body and the inclination information of the front vehicle body detected by the inclination sensor, calculate the lateral distance error L1 between the front vehicle body and the set end point position, based on the positioning and heading information obtained by the two antennas of the rear vehicle body and the inclination information of the rear vehicle body detected by the inclination sensor, calculate the lateral distance error L2 between the rear vehicle body and the set end point position; the calculation formulas of the lateral distance errors L1 and L2 are shown in the following formulas.
[0049]
[0050] A=y1-y2
[0051] B=x2-x1
[0052] C=(x1-x2)y1-(y1-y2)x1
[0053] In the formula, (x1, y1) is the starting point coordinate of the set path, (x2, y2) is the end point coordinate of the set path, (x fc ,y fc ) is the positioning coordinate of the front vehicle body after correction, see the attached Figure 3 , x fc =x fm -hsinα f cosα f ,y fc =y fm +hsin 2 α f ,(x fm ,y fm ) represents the GPS positioning measurement point coordinates of the front vehicle body, α f It represents the inclination angle of the front vehicle body measured by the inclination sensor, and h represents the height from the GPS antenna to the bottom of the vehicle.
[0054] Similarly, we can get:
[0055]
[0056] A=y1-y2
[0057] B=x2-x1
[0058] C=(x1-x2)y1-(y1-y2)x1
[0059] In the formula, (x1, y1) is the starting point coordinate of the set path, (x2, y2) is the end point coordinate of the set path, (x rc ,y rc ) is the positioning coordinate of the rear vehicle body after correction, x rc =x rm -hsinα r cosα r ,y rc =y rm +hsin 2 α r ,(x rm ,y rm ) represents the GPS positioning measurement point coordinates of the rear vehicle body, α r It represents the inclination angle of the rear vehicle body measured by the inclination sensor, and h represents the height from the GPS antenna to the bottom of the vehicle.
[0060] Then, see Appendix Figure 4 , based on the positioning data of the front vehicle body, the estimated distance error of the rear vehicle body is indirectly calculated (The superscript triangle symbol indicates "estimate"), and subtract it from the lateral distance error L2 to obtain the lateral measurement deviation L 2,ref :
[0061]
[0062] The calculation formula is:
[0063] in, l f is the front body length, l r is the rear body length, β f is the front vehicle heading angle, β r is the rear body heading angle.
[0064] Determine the lateral measurement deviation L 2,ref Whether the absolute value of is greater than a set threshold (in this embodiment, the threshold is set to 10 cm), if it is greater than 10 cm, proceed to step 5, if not greater than 10 cm, proceed to step 6;
[0065] Step 5: Set the target lateral error of the retreat process equal to the lateral measurement deviation L 2,ref , make compensation;
[0066] Step 6, set the target lateral error of the retreat process equal to 0 (i.e., due to the lateral measurement deviation L 2,ref Relatively small and can be ignored);
[0067] Step 7, the roller performs a backward process;
[0068] Step 8, the backward process determines whether the starting point has been reached. If the starting point has been reached, the process proceeds to step 9. If the starting point has not been reached, the process proceeds to step 7.
[0069] Step 9, determine whether the rolling task is completed. If completed, end the operation. If not completed, continue to step 2.
[0070] For ease of explanation, spatial relative terms such as "upper", "lower", "left", "right" and the like are used in the embodiments to illustrate the relationship of one element or feature shown in the figure relative to another element or feature. It should be understood that, in addition to the orientation shown in the figure, the spatial terms are intended to include different orientations of the device in use or operation. For example, if the device in the figure is inverted, the element described as being "under" other elements or features will be positioned "on" other elements or features. Therefore, the exemplary term "under" can include both upper and lower orientations. The device can be positioned in other ways (rotated 90 degrees or in other orientations), and the spatial relative descriptions used here can be interpreted accordingly.
[0071] Furthermore, relational terms such as “first” and “second” and the like are merely used to distinguish one component from another having the same name, but do not necessarily require or imply any such actual relationship or order between these components.
[0072] The present invention is described above by way of example. It should be noted that, without departing from the core of the present invention, any simple deformation, modification or other equivalent replacement that can be made by those skilled in the art without inventive effort falls within the protection scope of the present invention.
Claims
1. A tracking control method for an unmanned articulated roller vehicle based on four antennas. Features: A GPS positioning system is set on the unmanned articulated roller, and the GPS positioning system includes four antennas. Among the four antennas, two antennas are set on the front body of the roller, and the two antennas are arranged in the transverse direction of the front body, respectively located at the left and right ends of the front body, and the two are placed symmetrically; the other two antennas are set on the rear body of the roller, and the two antennas are arranged in the transverse direction of the rear body, respectively located at the left and right ends of the rear body, and the two are placed symmetrically; The tracking control method of an unmanned articulated roller vehicle based on four antennas includes the following steps: Step 1: Initially, it is a forward process, and the target lateral error is set to 0; Step 2, the roller moves forward along the set straight path; Step 3: Determine whether the end point has been reached during the forward process. If so, proceed to step 4; if not, continue to step 2. Step 4, when reaching the end point, based on the positioning and heading information obtained by the two antennas of the front vehicle body and the tilt angle information of the front vehicle body detected by the tilt sensor, the lateral distance error L1 between the front vehicle body and the set end point position is calculated; based on the positioning and heading information obtained by the two antennas of the rear vehicle body and the tilt angle information of the rear vehicle body detected by the tilt sensor, the lateral distance error L2 between the rear vehicle body and the set end point position is calculated; the calculation formulas of the lateral distance errors L1 and L2 are shown in the following formulas: Oh 1 -and 2 B=x 2 -x 1 C=(x 1 -x 2 )and 1 -(and 1 -and 2 )x 1 In the formula, (x 1 ,y 1 ) is the starting point coordinate of the set path, (x 2 ,y 2 ) is the end point coordinate of the set path, (x fc ,y fc ) is the positioning coordinate of the front vehicle body after correction, x fc =x fm -hsinα f cosα f ,y fc =y fm +hsin 2 α f ,(x fm ,y fm ) represents the GPS positioning measurement point coordinates of the front vehicle body, α f It represents the tilt angle of the front vehicle body measured by the tilt sensor, and h represents the height from the GPS antenna to the bottom of the vehicle; Oh 1 -and 2 B=x 2 -x 1 C=(x 1 -x 2 )and 1 -(and 1 -and 2 )x 1 In the formula, (x 1 ,y 1 ) is the starting point coordinate of the set path, (x 2 ,y 2 ) is the end point coordinate of the set path, (x rc ,y rc ) is the positioning coordinate of the rear vehicle body after correction, x rc =x rm -hsinα r cosα r ,y rc =y rm +hsin 2 α r ,(x rm ,y rm ) represents the GPS positioning measurement point coordinates of the rear vehicle body, α r It indicates the inclination angle of the rear vehicle body measured by the inclination sensor, and h indicates the height from the GPS antenna to the bottom of the vehicle; Then, based on the positioning data of the front vehicle body, the estimated distance error of the rear vehicle body is indirectly calculated. Subtract the lateral distance error L2 to obtain the lateral measurement deviation L 2,ref : The calculation formula is: in, l f is the front body length, l r is the rear body length, β f is the front vehicle heading angle, β r is the rear body heading angle; Determine the lateral measurement deviation L 2,ref Is the absolute value of greater than the set threshold? If so, proceed to step 5; if not, proceed to step 6; Step 5: Set the target lateral error of the retreat process equal to the lateral measurement deviation L 2,ref ; Step 6, setting the target lateral error of the retreat process equal to 0; Step 7, the roller performs a backward process; Step 8, the backward process determines whether the starting point has been reached. If the starting point has been reached, the process proceeds to step 9. If the starting point has not been reached, the process proceeds to step 7. Step 9, determine whether the rolling task is completed. If completed, end the operation. If not completed, continue to step 2.
