A method, system, device and medium for automatic navigation of agricultural machinery
By calculating the lateral position and azimuth deviation of the agricultural machinery in real time, controlling the agricultural machinery to drive along the target linear path and automatically turn, solving the problem that agricultural machinery in the prior art is difficult to achieve accurate linear driving and automatic steering, and improving operational efficiency and navigation accuracy.
Patent Information
- Application Number
- CN202210367091.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-04-08
- Publication Date
- 2024-11-01
- Estimated Expiration
- 2042-04-08
AI Technical Summary
The existing agricultural machinery automatic navigation technology is difficult to achieve accurate linear driving and automatic steering to another linear path, resulting in inefficient operation and waste of resources.
By determining the lateral position deviation and azimuth deviation of the agricultural machinery in real time, calculating the target rotation angle, and controlling the agricultural machinery to travel along the target straight line path based on the angle until it leaves the preset driving range, and then turning to the next straight line path according to the preset path sequence.
It improves the straightness and operating efficiency of agricultural machinery driving, avoids manual steering operations, and enhances the accuracy and safety of automatic navigation.
Smart Images

Figure CN114721387B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of agricultural mechanization, and in particular to an automatic navigation method, system, equipment and medium for agricultural machinery. Background Art
[0002] At present, as traditional agriculture moves towards modern agriculture, operating efficiency is increasingly valued, and the demand for agricultural automation is becoming more and more obvious. At present, most agricultural machinery and equipment in China are driven manually, but there are some problems that cannot be ignored when driving agricultural machinery and equipment manually. For example, it is difficult for humans to ensure the straightness of driving, resulting in missed tillage and re-tillage, which leads to reduced land resource utilization and increased losses, and thus leads to low overall operating efficiency. This puts forward a higher requirement for agricultural machinery driving: to ensure a precise straight line accuracy during the cultivation and harvesting process to ensure the maximum operating efficiency.
[0003] At present, there are many solutions for realizing satellite navigation of agricultural machinery based on global satellite positioning technologies such as GNSS (Global Navigation Satellite System), BDS (BeiDou Navigation Satellite System), GPS (Global Positioning System), and GSNS (Galileo Satellite Navigation System). In the early stage, the navigation indicator cursor system prompted the driver through GPS, the navigation accuracy was poor, and the real automatic navigation was not realized. With the development of navigation technology, there are various automatic navigation systems based on global satellite positioning technology, which realize the automatic navigation function, but the specific implementation methods are different, such as satellite positioning technology, path design method, control parameters, control algorithm, steering drive method, etc. In addition, in the prior art, it is not realized that agricultural machinery can automatically drive to another navigation line when the navigation of one navigation line ends.
[0004] In summary, how to enable agricultural machinery to automatically travel along a straight path and automatically turn to another straight path is a problem that needs to be solved urgently. Summary of the invention
[0005] In view of this, the purpose of the present invention is to provide an automatic navigation method, system, device and medium for agricultural machinery, which can enable the agricultural machinery to automatically travel along a straight path and automatically turn to another straight path. The specific scheme is as follows:
[0006] In a first aspect, the present application discloses an automatic navigation method for agricultural machinery, which is applied to an automatic navigation system for agricultural machinery, comprising:
[0007] Determine a current path and a current driving direction corresponding to the current path from a plurality of target straight-line paths, determine a current position corresponding to the agricultural machine in real time, and then obtain a lateral position deviation and an azimuth deviation of the agricultural machine between the current position and the current path in real time;
[0008] Determining whether the agricultural machine is currently entering or exiting a preset driving range according to the current position; the preset driving range is a driving range determined according to a plurality of the target straight line paths;
[0009] If the agricultural machine is currently entering the preset driving range, determining a target turning angle corresponding to the agricultural machine based on the lateral position deviation and the azimuth angle deviation, and then controlling the agricultural machine to travel along the current path based on the target turning angle until the agricultural machine is out of the preset driving range;
[0010] If the agricultural machinery is currently out of the preset driving range, another target straight path is determined as the current path according to the preset path sequence, and the opposite direction of the current driving direction is used as the current driving direction. The agricultural machinery is then controlled to turn to the current path based on the lateral position deviation and the azimuth deviation until the agricultural machinery enters the preset driving range.
[0011] Optionally, the method of determining a current path and a current driving direction corresponding to the current path from a plurality of target straight line paths, determining a current position corresponding to the agricultural machine in real time, and then obtaining a lateral position deviation and an azimuth deviation of the agricultural machine between the current position and the current path in real time, further includes:
[0012] A target straight path is selected from the plurality of target straight paths as the current path, and the preset path sequence and the current driving direction corresponding to the current path are set, and then the preset driving range is determined according to the plurality of target straight paths, and the agricultural machinery is controlled to start driving.
[0013] Optionally, the step of selecting one of the target straight paths as the current path from the plurality of target straight paths, setting the preset path sequence and the current driving direction corresponding to the current path, and then determining a preset driving range according to the plurality of target straight paths, and controlling the agricultural machine to start driving, further includes:
[0014] Determine a first target point and a second target point, and obtain a first longitude and latitude coordinate corresponding to the first target point and a second longitude and latitude coordinate corresponding to the second target point, then obtain a first azimuth and a second azimuth corresponding to the agricultural machinery at the first target point and the second target point, respectively, and perform coordinate conversion on the first longitude and latitude coordinates and the second longitude and latitude coordinates to obtain a first plane coordinate and a second plane coordinate;
[0015] Determine a first path based on the first plane coordinates and the second plane coordinates, and determine a plurality of target straight line paths based on the first path according to a preset path arrangement direction, a preset path number, and a preset path interval;
[0016] Determine the target plane coordinates corresponding to each position in a plurality of the target straight line paths based on the first plane coordinates, the second plane coordinates, the first path, the preset path arrangement direction, and the preset path interval;
[0017] The direction corresponding to the first target point to the second target point is taken as the first driving direction, and the direction corresponding to the second target point to the first target point is taken as the second driving direction, and then the first azimuth angle and the second azimuth angle are used as the target azimuth angles corresponding to the first driving direction and the second driving direction respectively; the first driving direction and the second driving direction are opposite directions to each other.
[0018] Optionally, the real-time acquisition of the lateral position deviation and azimuth deviation of the agricultural machine between the current position and the current path includes:
[0019] Acquire the current longitude and latitude coordinates and the current azimuth of the agricultural machine at the current position in real time, and perform coordinate conversion on the current longitude and latitude coordinates to obtain current plane coordinates;
[0020] Determine the target plane coordinates of the target position corresponding to the current position in the current path, and determine the target azimuth corresponding to the current driving direction; the current driving direction is the first driving direction or the second driving direction;
[0021] The lateral position deviation of the agricultural machinery between the current position and the current path is obtained based on the target plane coordinates and the current plane coordinates, and the azimuth deviation of the agricultural machinery between the current position and the current path is obtained based on the target azimuth and the current azimuth.
[0022] Optionally, controlling the agricultural machine to turn to the current path based on the lateral position deviation and the azimuth deviation comprises:
[0023] Based on the preset path interval and based on the lateral position deviation and the azimuth deviation, the agricultural machine is controlled to travel along an arc path to a first preset position, and the agricultural machine is controlled to travel straight forward from the preset position to a distance corresponding to the preset path interval to reach a second preset position; wherein the azimuth deviation corresponding to the agricultural machine at the first preset position is a preset value; and the preset path interval is the minimum turning radius corresponding to the agricultural machine;
[0024] Determining the target turning angle corresponding to the agricultural machine based on the lateral position deviation and the azimuth angle deviation, and then determining the steering angle according to the target turning angle;
[0025] Based on the steering angle, the agricultural machine is controlled to travel from the second preset position until the steering angle is zero, and the agricultural machine is controlled to travel straight forward to the current path.
[0026] Optionally, determining the target turning angle corresponding to the agricultural machine based on the lateral position deviation and the azimuth deviation includes:
[0027] Based on the lateral position deviation and the azimuth deviation, the target turning angle corresponding to the agricultural machine is determined according to a first preset formula; wherein the first preset formula is:
[0028]
[0029]
[0030]
[0031] Among them, K1, K2, K3, K4 are preset coefficients, Δd is the lateral position deviation, Δθ is the azimuth deviation, and α is the target rotation angle.
[0032] Optionally, determining the steering angle according to the target angle includes:
[0033] The steering angle is determined according to the target angle and based on a second preset formula; wherein the second preset formula is:
[0034]
[0035] Among them, δ is the steering angle and α is the target angle.
[0036] Optionally, the agricultural machinery automatic navigation method further includes:
[0037] If the lateral position deviation is greater than a first value and / or the azimuth angle deviation is greater than a second value, the speed of the agricultural machinery is limited to control the speed not to be greater than a third value until the corresponding lateral position deviation is less than the first value and the azimuth angle deviation is less than the second value, and then the speed limit is released.
[0038] In a second aspect, the present application discloses an automatic navigation system for agricultural machinery, characterized in that it includes a host computer and a controller; wherein:
[0039] The host computer is used to determine the current path and the current driving direction corresponding to the current path from a plurality of target straight-line paths, and determine the current position corresponding to the agricultural machine in real time, and then obtain the lateral position deviation and azimuth deviation of the agricultural machine between the current position and the current path in real time;
[0040] The host computer is further used to determine whether the agricultural machine is currently entering or exiting a preset driving range according to the current position; the preset driving range is a driving range determined according to a plurality of target straight line paths;
[0041] The host computer is further configured to determine a target turning angle corresponding to the agricultural machine based on the lateral position deviation and the azimuth angle deviation if the agricultural machine currently enters the preset driving range;
[0042] The controller is used for controlling the agricultural machine to travel along the current path based on the target turning angle if the agricultural machine currently enters the preset driving range until the agricultural machine exits the preset driving range;
[0043] The host computer is further configured to determine another target straight path as the current path according to a preset path sequence if the agricultural machine is currently out of the preset driving range, and to use the opposite direction of the current driving direction as the current driving direction;
[0044] The controller is further used to control the agricultural machine to turn to the current path based on the lateral position deviation and the azimuth deviation until the agricultural machine enters the preset driving range.
[0045] In a third aspect, the present application discloses an electronic device, comprising a processor and a memory; wherein, when the processor executes a computer program stored in the memory, the aforementioned disclosed agricultural machinery automatic navigation method is implemented.
[0046] In a fourth aspect, the present application discloses a computer-readable storage medium for storing a computer program; wherein, when the computer program is executed by a processor, the aforementioned disclosed agricultural machinery automatic navigation method is implemented.
[0047] It can be seen that the present application determines the current path and the current driving direction corresponding to the current path from a plurality of target straight paths, determines the current position corresponding to the agricultural machinery in real time, and then obtains the lateral position deviation and azimuth deviation of the agricultural machinery between the current position and the current path in real time; determines whether the agricultural machinery is currently entering or exiting a preset driving range according to the current position; the preset driving range is a driving range determined according to a plurality of target straight paths; if the agricultural machinery is currently entering the preset driving range, the target turning angle corresponding to the agricultural machinery is determined based on the lateral position deviation and the azimuth deviation, and then the agricultural machinery is controlled to travel along the current path based on the target turning angle until the agricultural machinery exits the preset driving range; if the agricultural machinery is currently exiting the preset driving range, another target straight path is determined as the current path according to the preset path sequence, and the opposite direction of the current driving direction is used as the current driving direction, and then the agricultural machinery is controlled to turn to the current path based on the lateral position deviation and the azimuth deviation until the agricultural machinery enters the preset driving range. It can be seen that the present application calculates the target turning angle through the lateral position deviation and the azimuth deviation, and enables the agricultural machinery to travel along the target straight path based on the target turning angle; wherein, the use of the lateral position deviation and the azimuth deviation to calculate the target turning angle improves the accuracy of the target turning angle and further increases the straightness of the agricultural machinery's travel; in addition, the present application enables the agricultural machinery to automatically turn to another target straight path based on the lateral position deviation and the azimuth deviation, thereby avoiding the operation of manually turning to another target straight path. BRIEF DESCRIPTION OF THE DRAWINGS
[0048] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on the provided drawings without paying creative work.
[0049] Figure 1 A flow chart of an automatic navigation method for agricultural machinery provided in this application;
[0050] Figure 2 A schematic diagram of a target straight line path setting provided for this application;
[0051] Figure 3 A schematic diagram of an initial navigation setting provided for this application;
[0052] Figure 4 A schematic diagram of a preset driving range setting provided for this application;
[0053] Figure 5A specific flow chart of an automatic navigation method for agricultural machinery provided in this application;
[0054] Figure 6 A schematic diagram of an automatic steering path for agricultural machinery provided in this application;
[0055] Figure 7 A structural diagram of an automatic navigation system for agricultural machinery provided for this application;
[0056] Figure 8 A structural diagram of an electronic device provided for this application. DETAILED DESCRIPTION
[0057] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only 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.
[0058] As traditional agriculture moves towards modern agriculture, operating efficiency is increasingly valued, and the demand for agricultural automation is becoming more and more obvious. In addition, the implementation methods of various automatic navigation functions are different, and it has not been achieved that agricultural machinery can automatically drive to another navigation line at the end of one navigation line.
[0059] In order to overcome the above problems, the present application provides an automatic navigation solution for agricultural machinery, which can enable the agricultural machinery to automatically travel along a straight path and automatically turn to another straight path.
[0060] See also Figure 1 As shown, the embodiment of the present application discloses an automatic navigation method for agricultural machinery, which is applied to an automatic navigation system for agricultural machinery. The method includes:
[0061] Step S11: Determine the current path and the current driving direction corresponding to the current path from a plurality of target straight line paths, determine the current position corresponding to the agricultural machinery in real time, and then obtain the lateral position deviation and azimuth deviation of the agricultural machinery between the current position and the current path in real time.
[0062] In the embodiment of the present application, before navigation is performed, it is first necessary to set a number of target straight line paths, and determine the driving direction corresponding to the path and the azimuth corresponding to the driving direction; specifically, determine a first target point and a second target point, and obtain a first longitude and latitude coordinate corresponding to the first target point and a second longitude and latitude coordinate corresponding to the second target point, and then obtain a first azimuth and a second azimuth corresponding to the first target point and the second target point, respectively, and perform coordinate conversion on the first longitude and latitude coordinates and the second longitude and latitude coordinates to obtain first plane coordinates and second plane coordinates; determine a first path based on the first plane coordinates and the second plane coordinates, and obtain a first path root based on the first path. Determine a number of target straight line paths according to the preset path arrangement direction, the preset path number and the preset path interval; determine the target plane coordinates corresponding to each position in a number of the target straight line paths based on the first plane coordinates, the second plane coordinates, the first path, the preset path arrangement direction and the preset path interval; take the direction corresponding to the first target point to the second target point as the first driving direction, and take the direction corresponding to the second target point to the first target point as the second driving direction, and then take the first azimuth and the second azimuth as the target azimuths corresponding to the first driving direction and the second driving direction respectively; the first driving direction and the second driving direction are opposite directions. It should be pointed out that the latitude and longitude coordinates and azimuth are sent to the host computer after being received by the Beidou satellite global navigation and positioning system, and then the host computer converts the latitude and longitude coordinates into plane coordinates; in addition, the method of converting the latitude and longitude coordinates into plane coordinates can be the Gauss projection method, the UTM (Universal Transverse Mercator) projection method and the Mercator projection method.
[0063] In the embodiment of the present application, the process of setting a plurality of target straight line paths is as follows: Figure 2 As shown, first, point A corresponds to the first target point, and point B corresponds to the second target point. The agricultural machinery stops at point A and point B respectively, and the upper computer clicks buttons such as "calibrate point A" or "calibrate point B" to obtain the first plane coordinates and the second plane coordinates corresponding to point A and point B respectively; the upper computer sets the number of preset paths to n, and the preset path interval to d, to generate n straight line paths with an interval distance of d; if the preset path arrangement direction is set to right at the same time, the serial number of the straight line path from left to right is 1, 2, 3...n; if the preset path arrangement direction is set to left at the same time, the serial number of the straight line path from left to right is n...3, 2, 1. Figure 2As shown, the number of preset paths is 4, the path interval is 6 meters, and the preset path arrangement direction is right. It should be pointed out that when the first plane coordinates and the second plane coordinates corresponding to point A and point B are obtained, the first azimuth and the second azimuth corresponding to point A and point B are also obtained. The first azimuth is the azimuth when driving strictly along the straight path from point A to point B, and the second azimuth is the azimuth when driving strictly along the straight path from point B to point A; in addition, the direction from point A to point B is the first driving direction, and the direction from point B to point A is the second driving direction; the first driving direction and the second driving direction are opposite directions to each other.
[0064] In the embodiment of the present application, after setting a plurality of target straight paths and determining the driving direction corresponding to the path and the azimuth corresponding to the driving direction, it is necessary to perform initial navigation settings, select a target straight path from the plurality of target straight paths as the current path, set the preset path sequence and the current driving direction corresponding to the current path, and then determine the preset driving range according to the plurality of target straight paths, and control the agricultural machine to start driving. Figure 3 As shown, firstly, the current straight line is selected as the target straight line path with sequence number 3, and the current driving direction of the current straight line is determined to be from point B to point A, that is, the second driving direction, and the preset path sequence is determined to be in descending order, that is, from sequence number 3 to sequence number 1. It should be noted that the current driving direction can be the first driving direction or the second driving direction, and the preset path sequence can be in descending order or ascending order. It should be noted that the preset driving range needs to be determined based on a number of the target straight line paths, such as Figure 4 As shown in , the preset driving range refers to the area enclosed by the first target straight line path and the last target straight line path. The straight lines where the four sides of the area are located can be calculated, such as Figure 4 The shown are y1, y2, y3, and y4. It should be noted that after the initial navigation setting is completed, navigation can be started through a button similar to "Start Navigation" in the host computer. At this time, a forward speed signal needs to be sent through the driving control handle to start the agricultural machinery to drive; it should be noted that when performing the initial navigation setting, the setting order of the preset path sequence, the current driving direction corresponding to the current path, and the preset path sequence can be changed.
[0065] In the embodiment of the present application, after the agricultural machinery starts to travel, it is necessary to determine the current path and the current driving direction corresponding to the current path, determine the current position corresponding to the agricultural machinery in real time, and then obtain the lateral position deviation and azimuth deviation of the agricultural machinery between the current position and the current path in real time. Specifically, the current longitude and latitude coordinates and the current azimuth of the agricultural machinery at the current position are obtained in real time, and the current longitude and latitude coordinates are converted to obtain the current plane coordinates; the target plane coordinates of the target position corresponding to the current position in the current path are determined, and the target azimuth corresponding to the current driving direction is determined; the current driving direction is the first driving direction or the second driving direction; based on the target plane coordinates and the current plane coordinates, the lateral position deviation of the agricultural machinery between the current position and the current path is obtained, and based on the target azimuth and the current azimuth, the azimuth deviation of the agricultural machinery between the current position and the current path is obtained, so as to control the travel of the agricultural machinery using the lateral position deviation and azimuth deviation.
[0066] Step S12: judging whether the agricultural machine is currently entering or exiting a preset driving range according to the current position; the preset driving range is a driving range determined according to a plurality of the target straight line paths.
[0067] In the embodiment of the present application, it is determined according to the current position whether the agricultural machine is currently entering or exiting the preset driving range. The specific determination method is as follows: Figure 4 As shown, the preset driving range is between y1, y2, y3, and y4, and the plane coordinates of the current position of the agricultural machinery are (x, y); when the coordinates of the agricultural machinery satisfy (y-y1)*(y-y2)<0 and (y-y3)*(y-y4)<0, it is judged that the agricultural machinery is in the preset driving area. If the agricultural machinery is not judged in the preset driving area at the previous moment, it is now entering the preset driving area. When the agricultural machinery is in the preset driving range, the agricultural machinery needs to travel along the target straight path; when the coordinates of the agricultural machinery satisfy (y-y1)*(y-y2)>0 or (y-y3)*(y-y4)>0, the agricultural machinery is not in the preset driving range. If the agricultural machinery is judged in the preset driving area at the previous moment, it is now exiting the preset driving area. When the agricultural machinery is not in the preset driving range, the agricultural machinery needs to turn to the next target straight path.
[0068] It should be pointed out that when the agricultural machinery is within the preset driving range, the target position in step S11 is the intersection of the vertical line drawn from the current position to the current path and the current path; when the agricultural machinery is within the preset driving range, the target position in step S11 is the position pre-set according to the steering method.
[0069] Step S13: If the agricultural machinery is currently entering the preset driving range, the target turning angle corresponding to the agricultural machinery is determined based on the lateral position deviation and the azimuth deviation, and then the agricultural machinery is controlled to travel along the current path based on the target turning angle until the agricultural machinery drives out of the preset driving range.
[0070] In the embodiment of the present application, the agricultural machine is currently entering the preset driving range, and the agricultural machine needs to travel along the target straight path. At this time, based on the lateral position deviation and the azimuth deviation, the target turning angle corresponding to the agricultural machine is determined according to the first preset formula, and then the agricultural machine is controlled to travel along the current path based on the target turning angle until the agricultural machine leaves the preset driving range. It should be noted that the first preset formula is:
[0071]
[0072]
[0073]
[0074] Among them, K1, K2, K3, K4 are preset coefficients, Δd is the lateral position deviation, Δθ is the azimuth deviation, and α is the target rotation angle.
[0075] It should be pointed out that and The specific calculation method of can be changed.
[0076] It should be noted that after obtaining the target turning angle, it is necessary to obtain the current turning angle of the steering wheel of the agricultural machine, and then control the current turning angle to be equal to the target turning angle so that the agricultural machine travels along the current path. It should be noted that the current turning angle is controlled using the PID (Proportion Integral Differential) algorithm.
[0077] It should be pointed out that the scheme of controlling the agricultural machinery to travel along the current path based on the target turning angle can increase the straightness of the agricultural machinery's travel trajectory, avoid repeated operations, and improve work efficiency.
[0078] It should be pointed out that in the present application, lateral position deviation and azimuth deviation are used to calculate the target turning angle, while the existing methods calculate the target turning angle through lateral deviation and speed, through lateral deviation, wheelbase, heading angle and vehicle speed, and also calculate the preview point of the preset path through position coordinate information, agricultural machinery posture information, angle information and pressure information, and then calculate the target turning angle through the preview point. These existing methods are different from the present application.
[0079] Step S14: If the agricultural machinery is currently out of the preset driving range, another target straight path is determined as the current path according to the preset path sequence, and the opposite direction of the current driving direction is used as the current driving direction, and then the agricultural machinery is controlled to turn to the current path based on the lateral position deviation and the azimuth deviation until the agricultural machinery enters the preset driving range.
[0080] In the embodiment of the present application, the agricultural machine is currently out of the preset driving range, and the agricultural machine needs to turn to the next target straight path. At this time, another target straight path is determined as the current path according to the preset path sequence, and the opposite direction of the current driving direction is used as the current driving direction. Then, the agricultural machine is controlled to turn to the current path based on the lateral position deviation and the azimuth deviation until the agricultural machine enters the preset driving range. Figure 3 As shown in FIG. 1 , when the target straight path numbered 3 is completed, the agricultural machine turns to the target straight path numbered 2, and the target path driving direction changes from the second driving direction from B to A to the first driving direction from A to B, so the corresponding target azimuth angle also changes from the first azimuth angle to the second azimuth angle. It should be noted that when there is no next target straight path, the agricultural machine stops driving, as shown in FIG. Figure 3 As described above, the agricultural machine travels from the path with sequence number 3 to the path with sequence number 1. After traveling to the path with sequence number 1, if there is no set travel path, the agricultural machine stops traveling.
[0081] In an embodiment of the present application, the lateral position deviation and azimuth deviation of the agricultural machinery between the current position and the current path are obtained in real time. If the lateral position deviation is greater than a first value and / or the azimuth deviation is greater than a second value, the speed of the agricultural machinery is limited to control the speed to be no greater than a third value, until the corresponding lateral position deviation is less than the first value and the azimuth deviation is less than the second value, and then the speed limit is released.
[0082] In an embodiment of the present application, when a fault occurs during the navigation process, the automatic navigation function is terminated and the automatic braking mode is entered. When the travel control handle in the agricultural machinery returns to the zero position, the braking mode is released. This setting improves the safety of automatic navigation.
[0083] It can be seen that the present application determines the current path and the current driving direction corresponding to the current path from a plurality of target straight paths, determines the current position corresponding to the agricultural machinery in real time, and then obtains the lateral position deviation and azimuth deviation of the agricultural machinery between the current position and the current path in real time; determines whether the agricultural machinery is currently entering or exiting a preset driving range according to the current position; the preset driving range is a driving range determined according to a plurality of target straight paths; if the agricultural machinery is currently entering the preset driving range, the target turning angle corresponding to the agricultural machinery is determined based on the lateral position deviation and the azimuth deviation, and then the agricultural machinery is controlled to travel along the current path based on the target turning angle until the agricultural machinery exits the preset driving range; if the agricultural machinery is currently exiting the preset driving range, another target straight path is determined as the current path according to the preset path sequence, and the opposite direction of the current driving direction is used as the current driving direction, and then the agricultural machinery is controlled to turn to the current path based on the lateral position deviation and the azimuth deviation until the agricultural machinery enters the preset driving range. It can be seen that the present application calculates the target turning angle through the lateral position deviation and the azimuth deviation, and enables the agricultural machinery to travel along the target straight path based on the target turning angle; wherein, the use of the lateral position deviation and the azimuth deviation to calculate the target turning angle improves the accuracy of the target turning angle and further increases the straightness of the agricultural machinery's travel; in addition, the present application enables the agricultural machinery to automatically turn to another target straight path based on the lateral position deviation and the azimuth deviation, thereby avoiding the operation of manually turning to another target straight path.
[0084] See also Figure 5 As shown, the embodiment of the present application discloses a specific agricultural machinery automatic navigation method, which is applied to an agricultural machinery automatic navigation system. The method includes:
[0085] Step S21: Determine the current path and the current driving direction corresponding to the current path from a plurality of target straight paths, and determine the current position corresponding to the agricultural machine in real time. Obtain the lateral position deviation and azimuth deviation of the agricultural machine between the current position and the current path in real time.
[0086] For a more specific processing procedure of step S21, reference may be made to the corresponding contents disclosed in the aforementioned embodiments, which will not be described in detail here.
[0087] Step S22: judging whether the agricultural machine is currently entering or exiting a preset driving range according to the current position; the preset driving range is a driving range determined according to a plurality of the target straight line paths.
[0088] For a more specific processing procedure of step S22, reference may be made to the corresponding contents disclosed in the aforementioned embodiments, which will not be described in detail here.
[0089] Step S23: If the agricultural machinery is currently entering the preset driving range, the target turning angle corresponding to the agricultural machinery is determined based on the lateral position deviation and the azimuth deviation, and then the agricultural machinery is controlled to travel along the current path based on the target turning angle until the agricultural machinery drives out of the preset driving range.
[0090] For a more specific processing procedure of step S23, reference may be made to the corresponding contents disclosed in the aforementioned embodiments, which will not be described in detail here.
[0091] Step S24: If the agricultural machine is currently out of the preset driving range, another target straight path is determined as the current path according to the preset path sequence, and the opposite direction of the current driving direction is used as the current driving direction.
[0092] In an embodiment of the present application, if the agricultural machinery is currently out of the preset driving range, the agricultural machinery needs to turn to the next target straight path. Therefore, it is necessary to determine another target straight path as the current path according to the preset path sequence, and use the opposite direction of the current driving direction as the current driving direction, so as to calculate the lateral position deviation and azimuth deviation of the agricultural machinery between the current position and the current path in real time.
[0093] Step S25: Based on the preset path interval and based on the lateral position deviation and the azimuth deviation, the agricultural machinery is controlled to travel in a circular arc path to a first preset position, and the agricultural machinery is controlled to travel straight forward from the preset position a distance corresponding to the preset path interval to reach a second preset position; wherein, the azimuth deviation corresponding to the agricultural machinery at the first preset position is a preset value; and the preset path interval is the minimum turning radius corresponding to the agricultural machinery.
[0094] In the embodiment of the present application, the lateral position deviation and azimuth deviation of the agricultural machine between the current position and the current path are calculated in real time. After the lateral position deviation and azimuth deviation are obtained, the agricultural machine is controlled to travel to the first preset position along an arc path based on the preset path interval and based on the lateral position deviation and the azimuth deviation, and the agricultural machine is controlled to travel straight forward from the preset position to the distance corresponding to the preset path interval to reach the second preset position; Figure 6As shown in the figure, the agricultural machinery steering process is from the target straight path corresponding to point C to the target straight path corresponding to point F. First, the target position when steering is determined in this trajectory diagram, that is, the preset position is point F. First, the agricultural machinery passes point C, and it is judged that the agricultural machinery is currently out of the preset driving range. At this time, the current path changes from the target straight path where point C is located to the target straight path where point F is located. The current driving direction also changes, and the target azimuth also changes. Then, the lateral position deviation and azimuth deviation between the current position and the current path where point F is located are calculated using the current position and point F. According to the lateral position deviation and azimuth deviation and the preset path interval, the agricultural machinery is controlled to travel to point G along an arc path; after reaching point G, the agricultural machinery travels forward the distance of the preset path interval to point D. It should be pointed out that the first preset position is point G, which is on the extension line of the target straight path where point F is located, and R corresponds to the preset path interval. Since the preset path interval is the minimum turning radius corresponding to the agricultural machinery, the distance from point F to point G is not less than the preset path interval. In addition, the second preset position is point D. When the agricultural machine is located at the first preset position, the corresponding azimuth angle deviation is 90°.
[0095] Step S26: determining the target turning angle corresponding to the agricultural machinery based on the lateral position deviation and the azimuth angle deviation, and then determining the steering angle according to the target turning angle.
[0096] In the embodiment of the present application, after obtaining the lateral position deviation and the azimuth deviation between the current position and the current path, the target turning angle corresponding to the agricultural machine is determined based on the lateral position deviation and the azimuth deviation and according to a first preset formula, and then the steering angle is determined based on the target turning angle and according to a second preset formula; it should be noted that, if Figure 6 As shown, the current position is the position between point D and point E, and the target straight line path where point F is located on the current path, the first preset formula is:
[0097]
[0098]
[0099]
[0100] Among them, K1, K2, K3, K4 are preset coefficients, Δd is the lateral position deviation, Δθ is the azimuth deviation, and α is the target rotation angle.
[0101] It should be pointed out that if Figure 6As shown, since the agricultural machine is moving backward from point D to point E at this time, which is different from the previous calculation of the turning angle during the forward movement of the agricultural machine, it is necessary to further calculate the target turning angle. Specifically, the steering angle is determined based on the target turning angle and a second preset formula; the second preset formula is:
[0102]
[0103] Among them, δ is the steering angle and α is the target angle.
[0104] Step S27: Based on the steering angle, the agricultural machine is controlled to travel from the second preset position until the steering angle is zero, and the agricultural machine is controlled to travel straight forward to the current path until the agricultural machine enters the preset driving range.
[0105] In the embodiment of the present application, after the steering angle is determined, the current angle of the agricultural machine is obtained, the current angle is controlled to be equal to the target angle, from the second preset position to the steering angle is zero, and the agricultural machine is controlled to drive straight forward to the current path until the agricultural machine enters the preset driving range. Figure 6 As shown, the agricultural machinery is controlled to move backward from point D to point E according to the steering angle and the current angle, and then the agricultural machinery is controlled to move forward in a straight line from point E to point F, that is, to the current path, until the agricultural machinery enters the preset driving range.
[0106] It should be pointed out that the steering trajectory of this scheme can effectively reduce the distance required for automatic U-turn and save working space; in addition, in addition to the steering method in this scheme, other steering methods such as "pear-shaped" and "bow-shaped" can also be used.
[0107] In an embodiment of the present application, the lateral position deviation and azimuth deviation of the agricultural machinery between the current position and the current path are obtained in real time. If the lateral position deviation is greater than a first value and / or the azimuth deviation is greater than a second value, the speed of the agricultural machinery is limited to control the speed to be no greater than a third value, until the corresponding lateral position deviation is less than the first value and the azimuth deviation is less than the second value, and then the speed limit is released.
[0108] In an embodiment of the present application, when a fault occurs during the navigation process, the automatic navigation function is terminated and the automatic braking mode is entered. When the travel control handle in the agricultural machinery returns to the zero position, the braking mode is released. This setting improves the safety of automatic navigation.
[0109] It can be seen that the present application determines the current path and the current driving direction corresponding to the current path from a plurality of target straight paths, determines the current position corresponding to the agricultural machinery in real time, and then obtains the lateral position deviation and azimuth deviation of the agricultural machinery between the current position and the current path in real time; determines whether the agricultural machinery is currently entering or exiting a preset driving range according to the current position; the preset driving range is a driving range determined according to a plurality of target straight paths; if the agricultural machinery is currently entering the preset driving range, the target turning angle corresponding to the agricultural machinery is determined based on the lateral position deviation and the azimuth deviation, and then the agricultural machinery is controlled to travel along the current path based on the target turning angle until the agricultural machinery exits the preset driving range; if the agricultural machinery is currently exiting the preset driving range, another target straight path is determined as the current path according to the preset path sequence, and the opposite direction of the current driving direction is used as the current driving direction, and then the agricultural machinery is controlled to turn to the current path based on the lateral position deviation and the azimuth deviation until the agricultural machinery enters the preset driving range. It can be seen that the present application calculates the target turning angle through the lateral position deviation and the azimuth deviation, and enables the agricultural machinery to travel along the target straight path based on the target turning angle; wherein, the use of the lateral position deviation and the azimuth deviation to calculate the target turning angle improves the accuracy of the target turning angle and further increases the straightness of the agricultural machinery's travel; in addition, the present application enables the agricultural machinery to automatically turn to another target straight path based on the lateral position deviation and the azimuth deviation, thereby avoiding the operation of manually turning to another target straight path.
[0110] See also Figure 7 As shown, the embodiment of the present application discloses an automatic navigation system for agricultural machinery, including a host computer 11 and a controller 12; wherein,
[0111] The host computer 11 is used to determine the current path and the current driving direction corresponding to the current path from a plurality of target straight paths, and determine the current position corresponding to the agricultural machine in real time, and then obtain the lateral position deviation and azimuth deviation of the agricultural machine between the current position and the current path in real time;
[0112] The host computer 11 is also used to determine whether the agricultural machine is currently entering or exiting a preset driving range according to the current position; the preset driving range is a driving range determined according to a plurality of target straight line paths;
[0113] The host computer 11 is further configured to determine a target turning angle corresponding to the agricultural machine based on the lateral position deviation and the azimuth angle deviation if the agricultural machine currently enters the preset driving range;
[0114] The controller 12 is used for controlling the agricultural machine to travel along the current path based on the target turning angle if the agricultural machine currently enters the preset driving range until the agricultural machine exits the preset driving range;
[0115] The host computer 11 is further configured to determine another target straight path as the current path according to a preset path sequence if the agricultural machine is currently out of the preset driving range, and to use the opposite direction of the current driving direction as the current driving direction;
[0116] The controller 12 is further used to control the agricultural machine to turn to the current path based on the lateral position deviation and the azimuth deviation until the agricultural machine enters the preset driving range.
[0117] Specifically, the agricultural machinery automatic navigation system includes the host computer 11, the controller 12, the Beidou satellite global navigation positioning system 13, the electric steering wheel 14, the angle sensor 15, the forward travel valve group 16, the reverse travel valve group 17, and the travel control handle 18; wherein,
[0118] The Beidou satellite global navigation positioning system 13 includes a satellite receiver 131 and two satellite antennas 132 and 133, which are used to receive satellite positioning signals, send the first longitude and latitude coordinates and the first azimuth of the first target point to the host computer, and send the second longitude and latitude coordinates and the second azimuth of the second target point to the host computer; wherein the antennas 132 and 133 are symmetrically distributed on the central axis of the agricultural machinery, with an interval of 1 meter; the satellite positioning signal is at the centimeter level;
[0119] The host computer 11 is used to receive the first longitude and latitude coordinates, the first azimuth, the second longitude and latitude coordinates and the second azimuth sent by the Beidou satellite global navigation and positioning system 13, perform coordinate conversion on the first longitude and latitude coordinates and the second longitude and latitude coordinates to obtain first plane coordinates and second plane coordinates, determine a plurality of target straight line paths based on the first plane coordinates, the second plane coordinates, the preset path arrangement direction, the preset path number and the preset path interval, and determine the target plane coordinates of each position in the plurality of target straight line paths, and then determine the target azimuths corresponding to the direction from the first target point to the second target point and the direction from the second target point to the first target point respectively based on the first azimuth and the second azimuth;
[0120] The Beidou satellite global navigation and positioning system 13 is also used to receive the current longitude and latitude coordinates and the current azimuth of the agricultural machinery at the current position in real time, and send the current longitude and latitude coordinates and the current azimuth to the host computer;
[0121] The host computer 11 is used to receive the current longitude and latitude coordinates and the current azimuth sent by the host computer, perform coordinate conversion on the current longitude and latitude coordinates to obtain the current plane coordinates, determine the lateral position deviation and the azimuth deviation based on the target plane coordinates, the current plane coordinates, the target azimuth and the current azimuth, and then use the lateral position deviation and the azimuth deviation to obtain the target rotation angle, and send the lateral position deviation, the azimuth deviation and the target rotation angle to the controller 12;
[0122] The controller 12 is used to obtain the lateral position deviation, the azimuth deviation and the target angle sent by the host computer, and obtain the current angle sent by the angle sensor 15, and then control the electric steering wheel 14 according to the current angle and based on the target angle to achieve straight-line navigation, and control the electric steering wheel 14 according to the current angle and based on the target angle, and achieve automatic steering according to the lateral position deviation and the azimuth deviation;
[0123] The controller 12 is further used to obtain target data sent by the travel control handle 18, and control the travel forward valve group 16 or the travel reverse valve group 17 based on the target data to control the forward speed or reverse speed of the agricultural machine;
[0124] The controller 12 is also used to obtain the lateral position deviation and the azimuth deviation sent by the host computer. If the lateral position deviation is greater than a first value and / or the azimuth deviation is greater than a second value, the speed of the agricultural machinery is limited to control the speed to be no greater than a third value until the corresponding lateral position deviation is less than the first value and the azimuth deviation is less than the second value, and then the speed limit is released.
[0125] It should be pointed out that in the agricultural machinery automatic navigation system, the two antennas 131 and 133 are connected to the satellite receiver 131, the satellite receiver 131 communicates with the host computer 11, the host computer 11 communicates with the controller 12, the driving control handle 18 communicates with the controller 12, the controller 12 communicates with the electric steering wheel 14, the steering angle sensor 14 is connected to the controller 12, the forward driving valve group 16 is connected to the controller 12, and the reverse driving valve group 17 is connected to the controller 12.
[0126] It should be pointed out that the host computer 11 and the controller 12 are connected via Ethernet, and the communication between the host computer 11 and the controller 12 can be through the CAN bus, or through other serial ports or communication buses such as RS232 and RS458; the communication between the host computer 11 and the controller 12, the communication between the electric steering wheel 14 and the controller 12, and the communication between the driving control handle 18 and the host computer 11 can be through the CAN bus, or through other serial ports or communication buses such as RS232 and RS458. In addition, the electric steering wheel 14 can be replaced by a hydraulic steering.
[0127] It should be noted that if the centimeter-level satellite positioning signal is lost, or the electric steering wheel 14 fails, or the driver turns the electric steering wheel 14 without turning off the automatic navigation function, the agricultural machinery automatic navigation system will receive a fault signal. After receiving the fault signal, the agricultural machinery automatic navigation system will automatically end the automatic navigation function and enter the emergency brake mode to deal with such an emergency. The emergency brake mode can only be released by returning the travel control handle 18 to zero position once.
[0128] It can be seen that the present application determines the current path and the current driving direction corresponding to the current path from a plurality of target straight paths, determines the current position corresponding to the agricultural machinery in real time, and then obtains the lateral position deviation and azimuth deviation of the agricultural machinery between the current position and the current path in real time; determines whether the agricultural machinery is currently entering or exiting a preset driving range according to the current position; the preset driving range is a driving range determined according to a plurality of target straight paths; if the agricultural machinery is currently entering the preset driving range, the target turning angle corresponding to the agricultural machinery is determined based on the lateral position deviation and the azimuth deviation, and then the agricultural machinery is controlled to travel along the current path based on the target turning angle until the agricultural machinery exits the preset driving range; if the agricultural machinery is currently exiting the preset driving range, another target straight path is determined as the current path according to the preset path sequence, and the opposite direction of the current driving direction is used as the current driving direction, and then the agricultural machinery is controlled to turn to the current path based on the lateral position deviation and the azimuth deviation until the agricultural machinery enters the preset driving range. It can be seen that the present application calculates the target turning angle through the lateral position deviation and the azimuth deviation, and enables the agricultural machinery to travel along the target straight path based on the target turning angle; wherein, the use of the lateral position deviation and the azimuth deviation to calculate the target turning angle improves the accuracy of the target turning angle and further increases the straightness of the agricultural machinery's travel; in addition, the present application enables the agricultural machinery to automatically turn to another target straight path based on the lateral position deviation and the azimuth deviation, thereby avoiding the operation of manually turning to another target straight path.
[0129] Furthermore, an embodiment of the present application also provides an electronic device, Figure 8 This is a structural diagram of an electronic device 20 according to an exemplary embodiment. The content in the diagram cannot be considered as any limitation on the scope of use of the present application.
[0130] Figure 8 The present invention provides a schematic diagram of the structure of an electronic device 20 provided in an embodiment of the present application. The electronic device 20 may specifically include: at least one processor 21, at least one memory 22, a power supply 23, an input / output interface 24, a communication interface 25, and a communication bus 26. The memory 22 is used to store a computer program, which is loaded and executed by the processor 21 to implement the relevant steps of the agricultural machinery automatic navigation method disclosed in any of the aforementioned embodiments.
[0131] In this embodiment, the power supply 23 is used to provide working voltage for each hardware device on the electronic device 20; the communication interface 25 can create a data transmission channel between the electronic device 20 and the external device, and the communication protocol it follows is any communication protocol that can be applied to the technical solution of the present application, and is not specifically limited here; the input and output interface 24 is used to obtain external input data or output data to the outside world, and its specific interface type can be selected according to specific application needs and is not specifically limited here.
[0132] In addition, the memory 22, as a carrier for resource storage, can be a read-only memory, a random access memory, a disk or an optical disk, etc. The memory 22 can include a random access memory as a running memory and a non-volatile memory for external memory storage purposes. The storage resources thereon include an operating system 221, a computer program 222, etc., and the storage method can be temporary storage or permanent storage.
[0133] The operating system 221 is used to manage and control the hardware devices on the electronic device 20 on the source host and the computer program 222. The operating system 221 can be Windows, Unix, Linux, etc. In addition to the computer program that can be used to complete the agricultural machinery automatic navigation method performed by the electronic device 20 disclosed in any of the aforementioned embodiments, the computer program 222 can further include computer programs that can be used to complete other specific tasks.
[0134] In this embodiment, the input and output interface 24 may specifically include but is not limited to a USB interface, a hard disk reading interface, a serial interface, a voice input interface, a fingerprint input interface, and the like.
[0135] Furthermore, an embodiment of the present application also discloses a computer-readable storage medium for storing a computer program; wherein, when the computer program is executed by a processor, the aforementioned disclosed agricultural machinery automatic navigation method is implemented.
[0136] For the specific steps of the method, reference may be made to the corresponding contents disclosed in the aforementioned embodiments, which will not be described in detail here.
[0137] The computer-readable storage medium mentioned here includes random access memory (RAM), memory, read-only memory (ROM), electrically programmable ROM, electrically erasable programmable ROM, register, hard disk, magnetic disk or optical disk or any other form of storage medium known in the technical field. Wherein, when the computer program is executed by the processor, the aforementioned agricultural machinery automatic navigation method is implemented. For the specific steps of the method, reference can be made to the corresponding contents disclosed in the aforementioned embodiments, and no further description will be given here.
[0138] In this specification, each embodiment is described in a progressive manner, and each embodiment focuses on the differences from other embodiments. The same or similar parts between the embodiments can be referred to each other. For the device disclosed in the embodiment, since it corresponds to the agricultural machinery automatic navigation method disclosed in the embodiment, the description is relatively simple, and the relevant parts can be referred to the method part description.
[0139] Professionals may further appreciate that the units and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented in electronic hardware, computer software, or a combination of the two. In order to clearly illustrate the interchangeability of hardware and software, the composition and steps of each example have been generally described in the above description according to function. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Professionals and technicians may use different methods to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of this application.
[0140] The steps of the algorithm described in conjunction with the embodiments disclosed herein can be implemented directly using hardware, a software module executed by a processor, or a combination of the two. The software module can be placed in a random access memory (RAM), a memory, a read-only memory (ROM), an electrically programmable ROM, an electrically erasable programmable ROM, a register, a hard disk, a removable disk, a CD-ROM, or any other form of storage medium known in the art.
[0141] Finally, it should be noted that, in this article, relational terms such as first and second, etc. are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the sentence "comprise a ..." do not exclude the presence of other identical elements in the process, method, article or device including the elements.
[0142] The above is a detailed introduction to the agricultural machinery automatic navigation method, system, equipment and medium provided by the present invention. Specific examples are used in this article to illustrate the principles and implementation methods of the present invention. The description of the above embodiments is only used to help understand the method of the present invention and its core idea; at the same time, for general technical personnel in this field, according to the idea of the present invention, there will be changes in the specific implementation method and application scope. In summary, the content of this specification should not be understood as a limitation on the present invention.
Claims
1. An automatic navigation method for agricultural machinery, characterized in that: Applied to agricultural machinery automatic navigation system, including: Determine a current path and a current driving direction corresponding to the current path from a plurality of target straight paths, determine a current position corresponding to the agricultural machine in real time, and then obtain a lateral position deviation and an azimuth deviation of the agricultural machine between the current position and the current path in real time; the plurality of target straight paths are straight paths separated by a distance d; Determining whether the agricultural machine is currently entering or exiting a preset driving range according to the current position; the preset driving range is a driving range determined according to a plurality of target straight paths; the preset driving range is an area enclosed by the first target straight path and the last target straight path; If the agricultural machine is currently entering the preset driving range, determining a target turning angle corresponding to the agricultural machine based on the lateral position deviation and the azimuth angle deviation, and then controlling the agricultural machine to travel along the current path based on the target turning angle until the agricultural machine is out of the preset driving range; If the agricultural machinery is currently out of the preset driving range, another target straight path is determined as the current path according to the preset path sequence, and the opposite direction of the current driving direction is used as the current driving direction. The agricultural machinery is then controlled to turn to the current path based on the lateral position deviation and the azimuth deviation until the agricultural machinery enters the preset driving range.
2. The agricultural machinery automatic navigation method according to claim 1, characterized in that: The method of determining a current path and a current driving direction corresponding to the current path from a plurality of target straight paths, determining a current position corresponding to the agricultural machine in real time, and then obtaining a lateral position deviation and an azimuth deviation of the agricultural machine between the current position and the current path in real time, further includes: A target straight path is selected from the plurality of target straight paths as the current path, and the preset path sequence and the current driving direction corresponding to the current path are set, and then the preset driving range is determined according to the plurality of target straight paths, and the agricultural machinery is controlled to start driving.
3. The agricultural machinery automatic navigation method according to claim 2, characterized in that: The method further comprises: selecting one of the target straight paths as the current path, setting the preset path sequence and the current driving direction corresponding to the current path, and then determining a preset driving range according to the target straight paths, and controlling the agricultural machine to start driving. Determine a first target point and a second target point, and obtain a first longitude and latitude coordinate corresponding to the first target point and a second longitude and latitude coordinate corresponding to the second target point, then obtain a first azimuth and a second azimuth corresponding to the agricultural machinery at the first target point and the second target point, respectively, and perform coordinate conversion on the first longitude and latitude coordinates and the second longitude and latitude coordinates to obtain a first plane coordinate and a second plane coordinate; Determine a first path based on the first plane coordinates and the second plane coordinates, and determine a plurality of target straight line paths based on the first path according to a preset path arrangement direction, a preset path number, and a preset path interval; Determine the target plane coordinates corresponding to each position in a plurality of the target straight line paths based on the first plane coordinates, the second plane coordinates, the first path, the preset path arrangement direction, and the preset path interval; The direction corresponding to the first target point to the second target point is taken as the first driving direction, and the direction corresponding to the second target point to the first target point is taken as the second driving direction, and then the first azimuth angle and the second azimuth angle are used as the target azimuth angles corresponding to the first driving direction and the second driving direction respectively; the first driving direction and the second driving direction are opposite directions to each other.
4. The agricultural machinery automatic navigation method according to claim 3, characterized in that: The real-time acquisition of the lateral position deviation and azimuth deviation of the agricultural machine between the current position and the current path includes: Acquire the current longitude and latitude coordinates and the current azimuth of the agricultural machine at the current position in real time, and perform coordinate conversion on the current longitude and latitude coordinates to obtain current plane coordinates; Determine the target plane coordinates of the target position corresponding to the current position in the current path, and determine the target azimuth corresponding to the current driving direction; the current driving direction is the first driving direction or the second driving direction; The lateral position deviation of the agricultural machinery between the current position and the current path is obtained based on the target plane coordinates and the current plane coordinates, and the azimuth deviation of the agricultural machinery between the current position and the current path is obtained based on the target azimuth and the current azimuth.
5. The agricultural machinery automatic navigation method according to claim 3, characterized in that: The controlling the agricultural machine to turn to the current path based on the lateral position deviation and the azimuth deviation comprises: Based on the preset path interval and based on the lateral position deviation and the azimuth deviation, the agricultural machine is controlled to travel along an arc path to a first preset position, and the agricultural machine is controlled to travel straight forward from the preset position to a distance corresponding to the preset path interval to reach a second preset position; wherein the azimuth deviation corresponding to the agricultural machine at the first preset position is a preset value; and the preset path interval is the minimum turning radius corresponding to the agricultural machine; Determining the target turning angle corresponding to the agricultural machine based on the lateral position deviation and the azimuth angle deviation, and then determining the steering angle according to the target turning angle; Based on the steering angle, the agricultural machine is controlled to travel from the second preset position until the steering angle is zero, and the agricultural machine is controlled to travel straight forward to the current path.
6. The agricultural machinery automatic navigation method according to claim 5, characterized in that: The determining the target turning angle corresponding to the agricultural machine based on the lateral position deviation and the azimuth deviation comprises: Based on the lateral position deviation and the azimuth deviation, the target turning angle corresponding to the agricultural machine is determined according to a first preset formula; wherein the first preset formula is: Among them, K1, K2, K3, K4 are preset coefficients, △d is the lateral position deviation, △θ is the azimuth deviation, and α is the target rotation angle.
7. The agricultural machinery automatic navigation method according to claim 6, characterized in that: The determining the steering angle according to the target angle comprises: The steering angle is determined according to the target angle and based on a second preset formula; wherein the second preset formula is: Among them, δ is the steering angle and α is the target angle.
8. The agricultural machinery automatic navigation method according to claim 1, characterized in that: Also includes: If the lateral position deviation is greater than a first value and / or the azimuth angle deviation is greater than a second value, the speed of the agricultural machinery is limited to control the speed not to be greater than a third value until the corresponding lateral position deviation is less than the first value and the azimuth angle deviation is less than the second value, and then the speed limit is released.
9. An automatic navigation system for agricultural machinery, characterized in that: It includes a host computer and a controller; among which, The host computer is used to determine the current path and the current driving direction corresponding to the current path from a plurality of target straight paths, determine the current position corresponding to the agricultural machine in real time, and then obtain the lateral position deviation and azimuth deviation of the agricultural machine between the current position and the current path in real time; the plurality of target straight paths are straight paths with an interval distance d; The host computer is further used to determine whether the agricultural machine is currently entering or exiting a preset driving range according to the current position; the preset driving range is a driving range determined according to a plurality of target straight line paths; the preset driving range is an area enclosed by the first target straight line path and the last target straight line path; The host computer is further configured to determine a target turning angle corresponding to the agricultural machine based on the lateral position deviation and the azimuth angle deviation if the agricultural machine currently enters the preset driving range; The controller is used for controlling the agricultural machine to travel along the current path based on the target turning angle if the agricultural machine currently enters the preset driving range until the agricultural machine exits the preset driving range; The host computer is further configured to determine another target straight path as the current path according to a preset path sequence if the agricultural machine is currently out of the preset driving range, and to use the opposite direction of the current driving direction as the current driving direction; The controller is further used to control the agricultural machine to turn to the current path based on the lateral position deviation and the azimuth deviation until the agricultural machine enters the preset driving range.
10. An electronic device, characterized in that: It comprises a processor and a memory; wherein, when the processor executes the computer program stored in the memory, the agricultural machinery automatic navigation method as described in any one of claims 1 to 8 is implemented.
11. A computer-readable storage medium, characterized in that: Used to store computer programs; wherein, when the computer program is executed by a processor, the agricultural machinery automatic navigation method as described in any one of claims 1 to 8 is implemented.
