An optimization control method for turning and splicing rows of automatic driving agricultural machinery in the field
By using the point to straight line distance and heading angle change as the basis for judgment in autonomous driving agricultural machinery, and combining the ground slip coefficient to correct the deflection angle of the guide wheel, the problem of insufficient splicing accuracy of turning and turning in the agricultural machinery field is solved, and a higher operation is achieved Accuracy and stability.
Patent Information
- Application Number
- CN202310608694.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2023-05-28
- Publication Date
- 2024-11-08
- Estimated Expiration
- 2043-05-28
AI Technical Summary
The accuracy of the agricultural machinery autonomous driving equipment is insufficient during the turn and splicing process in the field, resulting in oscillation and affecting the operation effect.
The optimization control method of field turn-turn splicing row of autonomous driving agricultural machinery is used. The controller uses the distance from point to straight line instead of point to point as the basis for path switching judgment. The heading angle change amount or steering trajectory feature information is used to determine the end of the turn, and calculate the actual The ratio of the turning radius to the target turning radius is used as the ground slip coefficient, and the heading deviation is adjusted on the cross-row straight path section to correct the deflection angle of the guide wheel.
Adaptive adjustment of the turning and turning process is realized, the splicing accuracy is improved, the phenomenon of agricultural machinery deviating from the predetermined route when turning in large arcs at the field is improved, and the operation accuracy is improved.
Smart Images

Figure CN116594398B_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the technical field of intelligent control of agricultural machinery, and in particular relates to an optimization control method for field turning, U-turning and row splicing of automatic driving agricultural machinery. Background Art
[0002] Unmanned intelligent agricultural machinery equipment is based on traditional mechatronics technology and uses advanced sensor control technology to achieve unmanned and less-manned agricultural machinery operations, which not only ensures the quality and efficiency of operations, but also reduces agricultural production costs. The actual application effect of automatic driving equipment for agricultural machinery in recent years has also shown that automatic driving technology can reduce the difficulty of agricultural machinery operation, improve the efficiency of agricultural machinery operations, and improve the quality of agricultural machinery operations. It is an important support for the high-quality, efficient and green development of my country's modern agriculture.
[0003] At present, the automatic driving equipment for agricultural machinery has basically realized the function of automatic driving for the entire field based on the splicing of working rows. It can automatically turn around at the head of the field, but the accuracy of the spliced rows is still insufficient, resulting in the oscillation of the agricultural machinery's adjustment line at the beginning of a new working row, affecting the working effect.
[0004] The conventional control process of agricultural machinery turning and U-turn is as follows: Figure 2 As shown in the figure: when the agricultural machinery is traveling along the operation path segment ① toward the field head, the controller determines whether the distance from the agricultural machinery position point to point A is less than the set threshold. When it is less than the threshold, the current position is taken as point A', the steering process is started and the target path is indexed to the arc segment ②; when the agricultural machinery is traveling along the arc segment ②, the controller controls the steering mechanism to deflect and stabilize the guide wheel to the set angle (corresponding to the target turning radius), and then determines whether the steering process is completed through the delay (or the distance from the agricultural machinery position point to point B). When the steering is completed, the current position is taken as point B', the guide wheel returns to the center, and the agricultural machinery is indexed to the cross-row path segment ③; on the cross-row straight path segment ③, since the agricultural machinery may have a lateral deviation d and a heading deviation θ at point B' relative to point B, there will be an oscillation on-line process, and then Then it moves forward steadily along path segment ③, and the controller determines whether the distance from the position point of the agricultural machinery to point O is less than the set threshold. When it is less than the threshold, the current position is taken as point O', the steering process is started, and the target path is indexed to arc segment ④; when the agricultural machinery travels along arc segment ④, the controller controls the steering mechanism to deflect the guide wheel and stabilize it to the set angle (corresponding to the target turning radius), and then determines whether the steering process is completed through delay (or the distance from the position point of the agricultural machinery to point D). When the steering is completed, the current position is taken as point D', the guide wheel returns to the center, and the agricultural machinery is indexed to the operation path segment ⑤; on the operation path segment ⑤, since the agricultural machinery may have a lateral deviation d and a heading deviation θ at point D' relative to point D, there will be an oscillation on-line process, and then it moves forward steadily along path segment ⑤.
[0005] When agricultural machinery is turning in a large arc at the head of the field, the deflection amplitude and speed of the wheels are greater than when the operation is automatic, and it is more susceptible to factors such as hysteresis of the measurement and control system and wheel slippage, making it easier to deviate from the planned route, reducing the operation accuracy and causing damage. Conventional control methods do not achieve adaptive adjustment in the process of turning, turning and splicing rows.
[0006] Therefore, based on the above technical problems, it is necessary to design a new optimization control method for automatic driving agricultural machinery to turn around and splice rows in the field. Summary of the invention
[0007] The purpose of the present invention is to provide a method for optimizing control of turning, reversing and splicing rows of automatic driving agricultural machinery in the field.
[0008] In order to solve the above technical problems, the present invention provides an optimization control method for turning, turning and splicing rows of an automatic driving agricultural machinery in a field, comprising:
[0009] When the agricultural machine is traveling on the first operation path segment, the controller uses the distance from point to straight line instead of the distance from point to point as the basis for judging the path switching of the agricultural machine;
[0010] When the agricultural machinery is traveling in a turning arc segment, the controller uses the heading angle change or the steering trajectory characteristic information instead of the delay or the point-to-point distance as the basis for judging the end of the agricultural machinery turning arc segment;
[0011] The actual turning radius is calculated by using the trajectory information of the agricultural machine in the first turning arc segment, and the ratio of the actual turning radius to the target turning radius is used as the ground slip coefficient;
[0012] Only adjust the heading deviation of the agricultural machinery on the cross-row straight path segment;
[0013] On the second turning arc section, the target steering angle and the arc end point position are corrected according to the accumulated error, and the guide wheel deflection angle is corrected according to the ground slip coefficient.
[0014] Furthermore, when the agricultural machine is traveling on the first working path segment, the controller uses the distance from point to straight line instead of the distance from point to point as the basis for judging the path switching of the agricultural machine, including:
[0015] When the agricultural machine approaches point A along the first operation path segment, ensure the correct heading;
[0016] The distance between the real-time position of the agricultural machine and the straight line passing through point A and the perpendicular line of the first operation path segment is used as the end judgment condition of the first operation path segment;
[0017] When the distance is less than the set threshold, the operation is stopped and the speed is reduced. Then, the current position of the agricultural machine is taken as point A', the steering process is started and the index path is switched to the first turning arc segment.
[0018] Furthermore, point A is the connection point between the first operation path segment and the first turning arc segment, that is, the starting point of the first turning arc segment.
[0019] Furthermore, when the agricultural machine is traveling in a turning arc segment, the controller uses the heading angle change or the turning trajectory characteristic information instead of the delay or the point-to-point distance as the basis for judging whether the turning arc segment of the agricultural machine ends, including:
[0020] On the first turning arc segment, the coordinates of point A' (x0, y0) are first recorded, and then the steering mechanism is controlled to deflect the steering wheel of the agricultural machinery and stabilize it at the set angle;
[0021] During the steering process, the real-time position trajectory characteristics of the agricultural machinery are continuously monitored, Δx = |x-x0|, Δy = |y-y0|, dx = |x n -x n-1 |、dy=|y n -y n-1 |;
[0022] When the agricultural machine turns to 30 degrees, , record the coordinates of the first turning trajectory point (x1, y1);
[0023] When the agricultural machine turns to 45 degrees, , record the coordinates of the second turning trajectory point (x2, y2);
[0024] When the agricultural machine turns to 60 degrees, , record the coordinates of the third turning trajectory point (x3, y3);
[0025] The actual turning trajectory radius is solved through the coordinates of the three trajectory points, and the ground slip coefficient k is calculated;
[0026] When |Δx-Δy|≈0 and dx / dy is greater than the set threshold, the current position of the agricultural machine is taken as point B', the steering mechanism returns to the center and the steering is ended, and the agricultural machine indexes to the cross-row straight path segment.
[0027] Further, the actual turning radius is calculated by using the trajectory information of the agricultural machine in the first turning arc segment, and the ratio of the actual turning radius to the target turning radius is used as the ground slip coefficient, including:
[0028] Obtain the equation of the perpendicular line connecting the first turning trajectory point and the second turning trajectory point;
[0029] Obtain the equation of the perpendicular line connecting the second turning trajectory point and the third turning trajectory point;
[0030] Get the coordinates of the intersection of the two vertical lines. The distance from the intersection of the vertical lines to any track point is the actual turning radius.
[0031] Ground slip coefficient k:
[0032]
[0033] Among them, R' is the actual turning radius, and R is the target turning radius.
[0034] Furthermore, only the heading deviation of the agricultural machinery is adjusted on the cross-row straight path segment:
[0035] The distance from the real-time position of the agricultural machinery to the perpendicular line of the inter-row straight path segment passing through point O is used as the path end judgment condition. If the distance is less than the set threshold, the current position of the agricultural machinery is taken as point O', the steering process starts and the index path is switched to the second turning arc segment.
[0036] Furthermore, point O is the connection point between the cross-row straight line path segment and the second turning arc segment, that is, the starting point of the second turning arc segment.
[0037] Further, the target steering angle and the arc end point position are corrected according to the accumulated error on the second turning arc segment, and the guide wheel deflection angle is corrected according to the ground slip coefficient, including:
[0038] On the second turning arc segment, the target steering angle and the position of the arc end point D are corrected according to the accumulated error, and the guide wheel deflection angle is corrected according to the ground slip coefficient fed back from the first turning arc segment, so that the track of the agricultural machinery at the end of the turning is connected with the next working path segment;
[0039] Corrected target steering angle:
[0040] When the agricultural machine passes through the vertical line at point O, extend the heading line of the agricultural machine at point O' and the next operation path segment to obtain the intersection of the two, and draw an angle bisector through the intersection;
[0041] Draw a perpendicular line through point O' to the heading line of the agricultural machinery and intersect the angle bisector. The distance from the intersection point to point O' is the corrected target turning radius.
[0042] When the accumulated error causes the agricultural machine to deviate downward, the target turning radius increases, and the end point D of the turning arc moves down to point D' along the next working path segment;
[0043] When the accumulated heading error causes the agricultural machine to deviate upward, the target turning radius decreases, and the end point D of the turning arc moves up to point D' along the next working path segment.
[0044] Furthermore, the guide wheel deflection angle is corrected, and the kinematic relationship between the guide wheel deflection angle and the turning radius is:
[0045]
[0046] Among them, δ is the steering wheel deflection angle, L is the vehicle wheelbase, and R is the target turning radius;
[0047] According to the definition of the ground slip coefficient of the second turning arc line segment:
[0048] R'=k·R
[0049] The actual steering wheel deflection angle is
[0050]
[0051] On the other hand, the present invention also provides a control system using the above-mentioned automatic driving agricultural machinery field turning, turning and splicing row optimization control method, comprising:
[0052] A first switching judgment module, when the agricultural machine is traveling on the first operation path segment, the controller uses the distance from point to straight line instead of the distance from point to point as the judgment basis for the agricultural machine path switching;
[0053] The second switching judgment module, when the agricultural machine is traveling in a turning arc segment, the controller uses the heading angle change or the steering trajectory characteristic information instead of the delay or the point-to-point distance as the basis for judging the end of the turning arc segment of the agricultural machine;
[0054] The actual turning radius module calculates the actual turning radius through the trajectory information of the agricultural machinery in the first turning arc segment, and uses the ratio of the actual turning radius to the target turning radius as the ground slip coefficient;
[0055] The adjustment module only adjusts the heading deviation of the agricultural machinery on the cross-row straight path segment;
[0056] The correction module corrects the target steering angle and the arc end point position according to the accumulated error on the second turning arc segment, and corrects the guide wheel deflection angle according to the ground slip coefficient.
[0057] The beneficial effects of the present invention are as follows: when the agricultural machinery is traveling on the first working path section, the controller uses the point-to-straight line distance instead of the point-to-point distance as the basis for judging the path switching of the agricultural machinery; when the agricultural machinery is traveling on the turning arc section, the controller uses the heading angle change or the steering trajectory characteristic information instead of the delay or the point-to-point distance as the basis for judging the end of the turning arc section of the agricultural machinery; the actual turning radius is calculated by the trajectory information of the agricultural machinery in the first turning arc section, and the ratio of the actual turning radius to the target turning radius is used as the ground slip coefficient; only the heading deviation of the agricultural machinery is adjusted on the cross-row straight path section; on the second turning arc section, the target steering angle and the arc end point position are corrected according to the accumulated error, and the guide wheel deflection angle is corrected according to the ground slip coefficient; the deviation state of the front path is calculated, and the starting and ending positions, the target steering radius and the guide wheel deviation angle of the rear path are corrected, so as to realize adaptive adjustment of the turning process and improve the accuracy of splicing rows.
[0058] Other features and advantages of the present invention will be described in the following description, and partly become apparent from the description, or understood by practicing the present invention. The purpose and other advantages of the present invention are realized and obtained by the structures particularly pointed out in the description and the drawings.
[0059] In order to make the above-mentioned objects, features and advantages of the present invention more obvious and easy to understand, preferred embodiments are given below and described in detail with reference to the accompanying drawings. BRIEF DESCRIPTION OF THE DRAWINGS
[0060] In order to more clearly illustrate the specific implementation methods of the present invention or the technical solutions in the prior art, the drawings required for use in the specific implementation methods or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are some implementation methods of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.
[0061] Figure 1 It is a flow chart of an optimization control method for turning, U-turning and splicing rows of an automatic driving agricultural machinery in a field according to the present invention;
[0062] Figure 2 It is a schematic diagram of the process of turning, reversing and joining rows at the head of a field of an unmanned agricultural machine according to the present invention;
[0063] Figure 3 is a schematic diagram of the steering trajectory characteristic information of the present invention;
[0064] Figure 4 It is a schematic diagram of solving the actual turning trajectory and radius of the present invention;
[0065] Figure 5It is a schematic diagram of the cumulative error in the centralized correction method for cumulative heading errors of the present invention causing the agricultural machine to deviate downward;
[0066] Figure 6 It is a schematic diagram of the cumulative error in the centralized correction method for cumulative heading errors of the present invention causing the agricultural machinery to deviate upward;
[0067] Figure 7 It is a schematic diagram of the vehicle kinematics model of the present invention. DETAILED DESCRIPTION
[0068] In order to make the purpose, technical solution and advantages of the embodiments of the present invention clearer, the technical solution of the present invention will be clearly and completely described below in conjunction with the accompanying drawings. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0069] Example 1
[0070] like Figures 1 to 7 As shown, this embodiment 1 provides an optimization control method for turning and splicing rows of an automatic driving agricultural machinery in a field, including: when the agricultural machinery is traveling in the first working path section, the controller uses the distance from point to straight line instead of the point to point distance as the judgment basis for the agricultural machinery path switching, so as to avoid the failure to correctly switch the path when the distance that the agricultural machinery deviates from the predetermined route is greater than the switching threshold; when the agricultural machinery is traveling in the turning arc section, the controller uses the heading angle change or the steering trajectory characteristic information instead of the delay or the point to point distance as the judgment basis for the end of the agricultural machinery turning arc section; the actual turning radius is calculated according to the trajectory information of the agricultural machinery in the first turning arc section, and the ratio of the actual turning radius to the target turning radius is used as the ground slip coefficient; only the heading deviation of the agricultural machinery is adjusted on the cross-row straight path section; on the second turning arc section, the target steering angle and the arc end point position are corrected according to the accumulated error, and the guide wheel deflection angle is corrected according to the ground slip coefficient; the deviation state of the front path is calculated, and the starting and ending positions, the target steering radius and the guide wheel deviation angle of the rear path are corrected to achieve adaptive adjustment of the turning and turning process and improve the splicing row accuracy. The agricultural machinery can realize automatic U-turn to complete automatic driving. Even if the agricultural machinery is moved to another working area for operation, the agricultural machinery can also realize automatic U-turn.
[0071] In this embodiment, the controller decomposes the complete turning path into an operating path, a first arc path, a cross-row straight path, a second straight path, and a next operating path.
[0072] In this embodiment, if Figure 2As shown, when the agricultural machine is traveling on the first working path segment (working path segment ①), the controller uses the distance from point to straight line instead of the distance from point to point as the judgment basis for the agricultural machine path switching, including: when the agricultural machine approaches point A along the first working path segment, ensuring the correct heading; using the distance from the real-time position of the agricultural machine to the straight line passing through point A and the perpendicular line of the first working path segment
[0073] As the end judgment condition of the first operation path segment; when the distance is less than the set threshold, stop the operation and slow down, then take the current position of the agricultural machine as point A', start the turning process and switch the index path to the first turning arc segment.
[0074] In this embodiment, point A is the connection point between the target first working path segment and the target first turning arc segment, that is, the starting point of the first turning arc segment in the plan; point A' is the real-time position point of the actual agricultural machinery switching index path; the relationship between the following points B and B', O and O', and D and D' is similar.
[0075] In this embodiment, when the agricultural machinery is traveling in a turning arc segment (turning arc segment paths ② and ④), the controller uses the heading angle change or the steering trajectory characteristic information instead of the delay or point-to-point distance as the basis for judging the end of the agricultural machinery steering arc segment, including: avoiding the delay caused by ground slippage and the inability to correctly end the steering when the agricultural machinery deviates from the predetermined route by a distance greater than the switching threshold; if it is verified through actual measurement that "the real-time heading angle of the agricultural machinery provided by the posture measurement system in the arc segment is accurate and has no obvious lag", the heading angle change is preferably used as the basis for judging the end of the steering, otherwise the steering trajectory characteristic information is used for judgment. End the steering according to the heading angle change: first record the heading angle of the path segment before turning; during the turning process, continuously monitor the real-time heading angle of the agricultural machinery and compare it with the heading angle before turning. If the heading angle change reaches the set steering angle, control the guide wheel to return to the center and the steering ends; end the steering according to the steering trajectory feature information: taking the turning arc segment path ② as an example, on the first turning arc segment, first record the coordinates (x0, y0) of point A', and then control the steering mechanism to deflect the guide wheel of the agricultural machinery and stabilize it at the set angle; during the steering process, continuously monitor the real-time position trajectory features of the agricultural machinery Δx=|x-x0|, Δy=|y-y0|, dx=|x n -x n-1 |、dy=|y n -y n-1 |; When the agricultural machine turns to 30 degrees, When the agricultural machine turns to 45 degrees, the coordinates of the first turning trajectory point (x1, y1) are recorded; when the agricultural machine turns to 45 degrees, that is, When the agricultural machine turns to 60 degrees, the coordinates of the second turning trajectory point (x2, y2) are recorded; when the agricultural machine turns to 60 degrees, that is, When the coordinates of the third turning trajectory point (x3, y3) are recorded; the actual turning trajectory radius is solved by the coordinates of the three trajectory points, and the ground slip coefficient k is calculated; at the beginning of the turning, Δx is much smaller than Δy, dx is close to zero, and dy is very large; and near the end of the turning, Δx≈Δy, dx is very large, and dy is close to zero. According to these characteristics, the thresholds of |Δx-Δy| and dx / dy are reasonably set as the basis for accurately judging the end of the turning. When |Δx-Δy|≈0 and dx / dy is greater than the set threshold, the current position of the agricultural machinery is taken as point B', the steering mechanism returns to the center and the turning ends, and the agricultural machinery indexes to the cross-row straight path segment.
[0076] In this embodiment, the actual turning radius is calculated by using the trajectory information of the agricultural machinery in the first turning arc segment, and the ratio of the actual turning radius to the target turning radius is used as the ground slip coefficient, including: obtaining the equation of the perpendicular line connecting the first steering trajectory point and the second steering trajectory point; obtaining the equation of the perpendicular line connecting the second steering trajectory point and the third steering trajectory point; obtaining the coordinates of the intersection of the two perpendicular lines, and the distance from the intersection of the perpendicular lines to any trajectory point is the actual turning radius; the ground slip coefficient k: Among them, R' is the actual turning radius, and R is the target turning radius.
[0077] In this embodiment, only the heading deviation of the agricultural machinery is adjusted on the inter-row straight path segment: on the inter-row straight path segment ③, only the heading deviation of the agricultural machinery is adjusted, and the lateral deviation is not adjusted, so as to avoid insufficient adjustment time when the inter-row path segment ③ is short, resulting in a large heading deviation and entering the turning arc segment path ④, resulting in inaccurate steering control; the distance from the real-time position of the agricultural machinery to the vertical line of the inter-row straight path segment passing through point O is used as the path end judgment condition. If the distance is less than the set threshold, the current position of the agricultural machinery is taken as point O', the steering process is started and the index path is switched to the second turning arc segment.
[0078] In this embodiment, point O is the connection point between the cross-row straight line path segment and the second turning arc line segment, that is, the starting point of the second turning arc line segment.
[0079] In this embodiment, the target steering angle and the arc end point position are corrected according to the accumulated error on the second turning arc path segment, and the guide wheel deflection angle is corrected according to the ground slip coefficient, including: on the turning arc path segment ④, the target turning radius and the path end point D position are first corrected at point O' according to the accumulated error, and the guide wheel deflection angle corresponding to the corrected target turning radius is corrected according to the ground slip coefficient obtained in path segment ②; the steering mechanism is controlled to deflect the agricultural machinery guide wheel as quickly as possible and stabilize at the set angle; the distance from the point (the real-time position of the agricultural machinery) to the straight line (the perpendicular line of the operation planning path segment ⑤ passing through the corrected point D) is used as the steering end condition, and the distance is less than the set threshold, that is, the current position of the agricultural machinery is taken as point D', the steering mechanism returns to the center to end the steering, and the agricultural machinery indexes to the operation planning path segment ⑤.
[0080] In this embodiment, the method for correcting the target turning radius and the position of the path end point D is as follows: through the vertical line at point O, extend the heading line of the agricultural machinery at point O' and the next operating path segment to obtain the intersection of the two, and make an angle bisector through the intersection; make a perpendicular line to the heading line of the agricultural machinery through point O' and intersect the angle bisector, and the distance from the intersection to point O' is the corrected target turning radius; when the cumulative error causes the agricultural machinery to deviate downward, the target turning radius increases, and the end point D of the turning arc moves down to point D' along the next operating path segment; when the cumulative heading error causes the agricultural machinery to deviate upward, the target turning radius decreases, and the end point D of the turning arc moves up to point D' along the next operating path segment.
[0081] In this embodiment, the method for correcting the guide wheel deflection angle is as follows: the kinematic relationship between the guide wheel deflection angle and the turning radius is: Where δ is the steering wheel deflection angle, L is the vehicle wheelbase, and R is the target turning radius. According to the definition of the ground slip coefficient of the second turning arc segment, R' = k·R. Then the actual steering wheel deflection angle is: After passing point D, resume the operating speed and continue the operation.
[0082] Example 2
[0083] On the basis of Example 1, this Example 2 also provides a control system that adopts the automatic driving agricultural machinery field turning, U-turn and row splicing optimization control method in Example 1, including: a first switching judgment module, when the agricultural machinery is traveling in the first working path segment, the controller uses the point-to-straight line distance instead of the point-to-point distance as the judgment basis for the agricultural machinery path switching; a second switching judgment module, when the agricultural machinery is traveling in the turning arc segment, the controller uses the heading angle change or the steering trajectory characteristic information, instead of the delay or the point-to-point distance as the judgment basis for the end of the agricultural machinery turning arc segment; an actual turning radius module, which calculates the actual turning radius through the trajectory information of the agricultural machinery in the first turning arc segment, and uses the ratio of the actual turning radius to the target turning radius as the ground slip coefficient; an adjustment module, which only adjusts the heading deviation of the agricultural machinery on the cross-row straight path segment; a correction module, which corrects the target steering angle and the arc end point position according to the accumulated error on the second turning arc segment, and corrects the guide wheel deflection angle according to the ground slip coefficient.
[0084] In summary, the present invention uses the point-to-straight line distance instead of the point-to-point distance as the basis for judging the path switching of the agricultural machinery when the agricultural machinery is traveling on the first working path segment; uses the heading angle change or steering trajectory characteristic information instead of the delay or point-to-point distance as the basis for judging the end of the turning arc segment of the agricultural machinery when the agricultural machinery is traveling on the turning arc segment; calculates the actual turning radius through the trajectory information of the agricultural machinery in the first turning arc segment, and uses the ratio of the actual turning radius to the target turning radius as the ground slip coefficient; only adjusts the heading deviation of the agricultural machinery on the cross-row straight path segment; corrects the target steering angle and the arc end point position according to the accumulated error on the second turning arc segment, and corrects the guide wheel deflection angle according to the ground slip coefficient; calculates the deviation state of the front path segment, corrects the starting and ending positions, the target steering radius and the guide wheel deviation angle of the rear path segment, realizes adaptive adjustment of the turning process, and improves the accuracy of splicing rows.
[0085] In several embodiments provided in the present application, it should be understood that the disclosed devices and methods can also be implemented in other ways. The device embodiments described above are merely schematic. For example, the flowcharts and block diagrams in the accompanying drawings show the possible architecture, functions and operations of the devices, methods and computer program products according to multiple embodiments of the present invention. In this regard, each box in the flowchart or block diagram can represent a module, a program segment or a part of a code, and the module, a program segment or a part of a code contains one or more executable instructions for implementing the specified logical function. It should also be noted that in some alternative implementations, the functions marked in the box can also occur in a different order from the order marked in the accompanying drawings. For example, two consecutive boxes can actually be executed substantially in parallel, and they can sometimes be executed in the opposite order, depending on the functions involved. It should also be noted that each box in the block diagram and / or flowchart, and the combination of boxes in the block diagram and / or flowchart can be implemented with a dedicated hardware-based system that performs a specified function or action, or can be implemented with a combination of dedicated hardware and computer instructions.
[0086] In addition, the functional modules in the various embodiments of the present invention may be integrated together to form an independent part, or each module may exist independently, or two or more modules may be integrated to form an independent part.
[0087] If the functions are implemented in the form of software function modules and sold or used as independent products, they can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present invention, or the part that contributes to the prior art or the part of the technical solution, can be embodied in the form of a software product. The computer software product is stored in a storage medium, including several instructions for enabling a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the methods described in each embodiment of the present invention. The aforementioned storage medium includes: various media that can store program codes, such as a USB flash drive, a mobile hard disk, a read-only memory (ROM), a random access memory (RAM), a magnetic disk or an optical disk.
[0088] Based on the above ideal embodiments of the present invention, the relevant staff can make various changes and modifications without departing from the technical concept of the present invention through the above description. The technical scope of the present invention is not limited to the contents of the specification, and its technical scope must be determined according to the scope of the claims.
Claims
1. An optimization control method for turning and splicing rows of an automatic driving agricultural machinery in the field. It is characterized in that include: When the agricultural machine is traveling on the first operation path segment, the controller uses the distance from point to straight line instead of the distance from point to point as the basis for judging the path switching of the agricultural machine; When the agricultural machinery is traveling in a turning arc segment, the controller uses the heading angle change or the steering trajectory characteristic information instead of the delay or the point-to-point distance as the basis for judging the end of the agricultural machinery turning arc segment; The actual turning radius is calculated by using the trajectory information of the agricultural machine in the first turning arc segment, and the ratio of the actual turning radius to the target turning radius is used as the ground slip coefficient; Only adjust the heading deviation of the agricultural machinery on the cross-row straight path segment; On the second turning arc section, the target steering angle and the arc end point position are corrected according to the accumulated error, and the guide wheel deflection angle is corrected according to the ground slip coefficient; When the agricultural machine is traveling on the first working path segment, the controller uses the distance from point to straight line instead of the distance from point to point as the basis for judging the path switching of the agricultural machine, including: When the agricultural machine approaches point A along the first operation path segment, ensure the correct heading; The distance between the real-time position of the agricultural machine and the straight line passing through point A and the perpendicular line of the first operation path segment is used as the end judgment condition of the first operation path segment; When the distance is less than the set threshold, the operation is stopped and the speed is reduced. Then, the current position of the agricultural machine is taken as point A', the steering process is started and the index path is switched to the first turning arc segment; Point A is the connection point between the first operation path segment and the first turning arc segment, that is, the starting point of the first turning arc segment; When the agricultural machine is traveling in a turning arc segment, the controller uses the heading angle change or the turning trajectory characteristic information instead of the delay or the point-to-point distance as the basis for judging the end of the turning arc segment of the agricultural machine: On the first curved line segment, first record the coordinates of point A' (x 0 ,y 0 ), and then control the steering mechanism to deflect the steering wheels of the agricultural machinery and stabilize them at a set angle; During the steering process, the real-time position trajectory characteristics of the agricultural machinery are continuously monitored Δx=|xx 0 |、Δy=|yy 0 |、dx=|x n -x n-1 |、dy=|y n -y n-1 |; When the agricultural machine turns to 30 degrees, When the coordinates of the first turning trajectory point (x 1 ,y 1 ); When the agricultural machine turns to 45 degrees, When the coordinates of the second turning trajectory point (x 2 ,y 2 ); When the agricultural machine turns to 60 degrees, When the coordinates of the third turning trajectory point (x 3 ,y 3 ); The actual turning trajectory radius is solved through the coordinates of the three trajectory points, and the ground slip coefficient k is calculated; When |Δx-Δy|≈0 and dx / dy is greater than the set threshold, the current position of the agricultural machine is taken as point B', the steering mechanism returns to the center position to end the steering, and the agricultural machine indexes to the cross-row straight path segment; The method of correcting the target steering angle and the arc end point position according to the accumulated error on the second turning arc segment, and correcting the guide wheel deflection angle according to the ground slip coefficient includes: On the second turning arc segment, the target steering angle and the position of the arc end point D are corrected according to the accumulated error, and the guide wheel deflection angle is corrected according to the ground slip coefficient fed back from the first turning arc segment, so that the track of the agricultural machinery at the end of the turning is connected with the next working path segment; Corrected target steering angle: When the agricultural machine passes through the vertical line at point O, extend the heading line of the agricultural machine at point O' and the next operation path segment to obtain the intersection of the two, and draw an angle bisector through the intersection; Draw a perpendicular line through point O' to the heading line of the agricultural machinery and intersect the angle bisector. The distance from the intersection point to point O' is the corrected target turning radius. When the accumulated error causes the agricultural machine to deviate downward, the target turning radius increases, and the end point D of the turning arc moves down to point D' along the next working path segment; When the accumulated heading error causes the agricultural machine to deviate upward, the target turning radius decreases, and the end point D of the turning arc moves up to point D' along the next working path segment; Correct the guide wheel deflection angle. The kinematic relationship between the guide wheel deflection angle and the turning radius is: Among them, δ is the steering wheel deflection angle, L is the vehicle wheelbase, and R is the target turning radius; According to the definition of the ground slip coefficient of the second turning arc line segment: R'=k·R The actual steering wheel deflection angle is 2. The automatic driving agricultural machinery field turning and U-turn splicing row optimization control method according to claim 1, It is characterized in that The actual turning radius is calculated by using the track information of the agricultural machine in the first turning arc segment, and the ratio of the actual turning radius to the target turning radius is used as the ground slip coefficient, which includes: Obtain the equation of the perpendicular line connecting the first turning trajectory point and the second turning trajectory point; Obtain the equation of the perpendicular line connecting the second turning trajectory point and the third turning trajectory point; Get the coordinates of the intersection of the two vertical lines. The distance from the intersection of the vertical lines to any track point is the actual turning radius. Ground slip coefficient k: Among them, R' is the actual turning radius and R is the target turning radius.
3. The automatic driving agricultural machinery field turning and U-turn splicing row optimization control method as claimed in claim 2, It is characterized in that The above-mentioned adjustment of the heading deviation of the agricultural machinery on the cross-row straight path segment is as follows: The distance from the real-time position of the agricultural machinery to the perpendicular line of the inter-row straight path segment passing through point O is used as the path end judgment condition. If the distance is less than the set threshold, the current position of the agricultural machinery is taken as point O', the steering process starts and the index path is switched to the second turning arc segment.
4. The automatic driving agricultural machinery field turning and U-turn splicing row optimization control method as claimed in claim 3, It is characterized in that Point O is the connection point between the cross-row straight line path segment and the second turning arc line segment, that is, the starting point of the second turning arc line segment.
5. A control system using the automatic driving agricultural machinery field turning, U-turn and row splicing optimization control method as claimed in claim 1, It is characterized in that include: A first switching judgment module, when the agricultural machine is traveling on the first operation path segment, the controller uses the distance from point to straight line instead of the distance from point to point as the judgment basis for the agricultural machine path switching; The second switching judgment module, when the agricultural machine is traveling in a turning arc segment, the controller uses the heading angle change or the steering trajectory characteristic information instead of the delay or the point-to-point distance as the basis for judging the end of the turning arc segment of the agricultural machine; The actual turning radius module calculates the actual turning radius through the trajectory information of the agricultural machinery in the first turning arc segment, and uses the ratio of the actual turning radius to the target turning radius as the ground slip coefficient; The adjustment module only adjusts the heading deviation of the agricultural machinery on the cross-row straight path segment; The correction module corrects the target steering angle and the arc end point position according to the accumulated error on the second turning arc segment, and corrects the guide wheel deflection angle according to the ground slip coefficient.
