CN112363504B - Unmanned turning method for agricultural machinery - Google Patents
Unmanned turning method for agricultural machinery Download PDFInfo
- Publication number
- CN112363504B CN112363504B CN202011231532.8A CN202011231532A CN112363504B CN 112363504 B CN112363504 B CN 112363504B CN 202011231532 A CN202011231532 A CN 202011231532A CN 112363504 B CN112363504 B CN 112363504B
- Authority
- CN
- China
- Prior art keywords
- straight line
- section
- stage
- arc section
- agricultural machinery
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 16
- 238000010586 diagram Methods 0.000 description 5
- 241000282414 Homo sapiens Species 0.000 description 1
- 238000005299 abrasion Methods 0.000 description 1
- 230000004075 alteration Effects 0.000 description 1
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011065 in-situ storage Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012806 monitoring device Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/0088—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
Abstract
The invention discloses an unmanned turning method of an agricultural machine, which belongs to the technical field of automatic driving of the agricultural machine and comprises the following specific steps of: the unmanned turning method of the agricultural machinery is divided into five operation sections: s1: advancing operation straight line segment 1: straight running, wherein the running direction is parallel to the road direction; s2: advancing the arc section 2; s3: reversing a straight line segment 3; s4: arc section 4; s5: and (5) working a straight line segment. The agricultural machinery is unmanned, automatic turning control needs to be conducted on the ground, the circular arc section of the scheme is planned by using Euler spirals, an agricultural machinery automatic turning path is intersected, the circular arc section is segmented, the front section and the rear section are planned by using Euler spirals, the middle section is planned by using the minimum turning radius of a vehicle, the minimization of the ground space is guaranteed, curvature continuity is guaranteed, and therefore the agricultural machinery turning control can be conducted by strictly following the path, and the agricultural machinery is prevented from deviating from the planned path.
Description
Technical Field
The invention relates to the technical field of automatic driving of agricultural machinery, in particular to an unmanned turning method of the agricultural machinery.
Background
The automatic driving automobile relies on cooperation of artificial intelligence, visual computing, radar, monitoring device and global positioning system, so that the computer can automatically and safely operate the motor vehicle without any active operation of human beings.
With the development and popularization of agricultural automation, agricultural automatic driving is gradually promoted, and the field of agricultural automatic driving often relates to turning path planning when the land is automatically turned around.
There are generally three schemes, dubins curve path planning:
no reverse path planning (as shown in fig. 4), longer paths, larger space in the ground, and discontinuous curvature are required.
Reeds-shepp curve path planning (as shown in FIG. 5): backing path planning is supported, the path is shorter, but is not optimal or optimal, and the curvature is discontinuous.
Intersection curve path planning (as shown in fig. 6) with the same arc radius: backing path planning is supported, the optimal path, but the curvature is discontinuous.
Disclosure of Invention
The invention aims to provide an unmanned turning method of an agricultural machine, which aims to solve the problems of longer path, larger required land space, discontinuous curvature and discontinuous curvature in the prior art.
In order to achieve the above purpose, the present invention provides the following technical solutions: an unmanned turning method of an agricultural machine comprises the following specific steps:
the unmanned turning method of the agricultural machinery is divided into five operation sections:
s1: advancing operation straight line segment 1: straight running, wherein the running direction is parallel to the road direction;
s2: advancing arc section 2: at the step S1, the tail end enters this stage, the advancing arc segment 2 is in an arc shape moving to the left and the front, and the advancing arc segment 2 is divided into three stages: the first stage and the third stage use Euler spiral formulas to calculate the running direction and the running distance, the second stage is to keep running with a fixed radius, and the head end and the tail end of the second stage are respectively connected with the tail end of the first stage and the head end of the third stage;
s3: reversing straight line segment 3: reversing along a reversing straight line section 3 after the forward arc section 2 is finished, wherein the reversing straight line section 3 is perpendicular to the forward operation straight line section 1;
s4: arc segment 4: the circular arc section 4 and the forward circular arc section 2 are symmetrical about the perpendicular bisector of the reversing straight line section 3, and the reversing straight line section 3 is the starting point of the circular arc section 4;
s5: operation straight line segment 5: the end of the arc section 4 is the starting point of the working straight-line section 5, and the working straight-line section 5 and the advancing working straight-line section 1 are parallel and opposite in direction.
Preferably, the coordinate points K (x k ，y k ) The Euler spiral formula is adopted for definition, and the method specifically comprises the following steps:
wherein c is the rate of change of curvature, s is the arc length, a 2 Is the tangential angle.
Compared with the prior art, the invention has the beneficial effects that:
the agricultural machinery is unmanned, needs to carry out automatic turning control at the ground, and the circular arc section of this scheme uses Euler spiral to plan, can guarantee the curvature continuity of circular arc section route to make the agricultural machinery can strictly reasonable follow the route and carry out automatic turning control.
The automatic turning path of the agricultural machine adopts a cross type, the arc section adopts a sectional type, the front section and the rear section are planned by using Euler screws, the middle section is planned by using the minimum turning radius of the vehicle, so that the minimum space of the ground is ensured, the curvature continuity is ensured, the agricultural machine turning control can be performed by strictly following the path, and the agricultural machine is prevented from deviating from the planned path.
Drawings
FIG. 1 is a schematic illustration of a travel path of the present invention;
FIG. 2 is a schematic diagram of the step S2 of the present invention in three steps;
FIG. 3 is a calculated scribe line diagram of the present invention;
FIG. 4 is a prior art Dubin curve path planning diagram;
FIG. 5 is a prior art Reeds-shepp curve path planning diagram;
fig. 6 is a prior art cross curve path planning diagram with the same radius of the arc.
Detailed Description
The following description of the embodiments of the present invention will be made clearly and completely with reference to the accompanying drawings, in which it is apparent that the embodiments described are only some embodiments of the present invention, but not all embodiments. All other embodiments, which can be made by those skilled in the art based on the embodiments of the invention without making any inventive effort, are intended to be within the scope of the invention.
In the description of the present invention, it should be understood that the terms "upper," "lower," "front," "rear," "left," "right," "top," "bottom," "inner," "outer," and the like indicate or are based on the orientation or positional relationship shown in the drawings, merely to facilitate description of the present invention and to simplify the description, and do not indicate or imply that the devices or elements referred to must have a specific orientation, be configured and operated in a specific orientation, and thus should not be construed as limiting the present invention.
Examples:
referring to fig. 1-6, the present invention provides a technical solution: an unmanned turning method of an agricultural machine comprises the following specific steps:
the unmanned turning method of the agricultural machinery is divided into five operation sections:
s1: advancing operation straight line segment 1: straight running, wherein the running direction is parallel to the road direction;
s2: advancing arc section 2: at the step S1, the tail end enters this stage, the advancing arc segment 2 is in an arc shape moving to the left and the front, and the advancing arc segment 2 is divided into three stages: the first stage and the third stage use Euler spiral formulas to calculate the running direction and the running distance, the second stage is to keep running with a fixed radius, and the head end and the tail end of the second stage are respectively connected with the tail end of the first stage and the head end of the third stage;
s3: reversing straight line segment 3: reversing along a reversing straight line section 3 after the forward arc section 2 is finished, wherein the reversing straight line section 3 is perpendicular to the forward operation straight line section 1;
s4: arc segment 4: the circular arc section 4 and the forward circular arc section 2 are symmetrical about the perpendicular bisector of the reversing straight line section 3, and the reversing straight line section 3 is the starting point of the circular arc section 4;
s5: operation straight line segment 5: the end of the arc section 4 is the starting point of the working straight-line section 5, and the working straight-line section 5 and the advancing working straight-line section 1 are parallel and opposite in direction.
Preferably, the coordinate points K (x k ，y k ) The Euler spiral formula is adopted for definition, and the method specifically comprises the following steps:
wherein c is the rate of change of curvature, s is the arc length, a 2 Is the tangential angle.
As shown in fig. 3, included angles EF and AB are equal to included angles HI and CD, the curvatures of the a point and the b point are the same, the track of the arc sections 6 and 8 can be calculated according to the euler spiral curve formula, and the arc section 7 can keep the curvatures of the a point and the b point to make a circle.
The agricultural machinery is unmanned, automatic turning control is needed to be carried out on the ground, the minimization of ground space can be met by using the cross-type path planning supporting the reversing path, but if the arc section is planned by directly using a fixed turning radius, the agricultural machinery needs to stop first and turn around in situ, the abrasion of tires is very large, if the tires are not stopped and directly followed, the agricultural machinery is automatically controlled to deviate from the planned path due to the discontinuous curvature of the arc path, unpredictable results are caused, the arc section is planned by using the Euler spiral, and the continuity of the curvature of the arc section path can be ensured, so that the agricultural machinery can strictly and reasonably follow the path to carry out automatic turning control.
The automatic turning path of the agricultural machine adopts a cross type, the arc section adopts a sectional type, the front section and the rear section are planned by using Euler screws, the middle section is planned by using the minimum turning radius of the vehicle, so that the minimum space of the ground is ensured, the curvature continuity is ensured, the agricultural machine turning control can be performed by strictly following the path, and the agricultural machine is prevented from deviating from the planned path.
While the fundamental and principal features of the invention and advantages of the invention have been shown and described, it will be apparent to those skilled in the art that the invention is not limited to the details of the foregoing exemplary embodiments, but may be embodied in other specific forms without departing from the spirit or essential characteristics thereof; the present embodiments are therefore to be considered in all respects as illustrative and not restrictive, the scope of the invention being indicated by the appended claims rather than by the foregoing description, and all changes which come within the meaning and range of equivalency of the claims are therefore intended to be embraced therein.
Although embodiments of the present invention have been shown and described, it will be understood by those skilled in the art that various changes, modifications, substitutions and alterations can be made therein without departing from the principles and spirit of the invention, the scope of which is defined in the appended claims and their equivalents.
Claims (1)
1. An unmanned turning method of an agricultural machine is characterized in that: the unmanned turning method of the agricultural machinery comprises the following specific steps:
the unmanned turning method of the agricultural machinery is divided into five operation sections:
s1: advancing operation straight line segment (1): straight running, wherein the running direction is parallel to the road direction;
s2: advancing the arc section (2): at the stage that the tail end of the step S1 enters, the advancing circular arc section (2) is in a circular arc shape moving leftwards and forwards, and the advancing circular arc section (2) is divided into three stages: the first stage and the third stage use Euler spiral formulas to calculate the running direction and the running distance, the second stage is to keep running with a fixed radius, and the head end and the tail end of the second stage are respectively connected with the tail end of the first stage and the head end of the third stage;
s3: reversing straight line section (3): reversing along a reversing straight line section (3) after the forward arc section (2) is finished, wherein the reversing straight line section (3) is perpendicular to the forward operation straight line section (1);
s4: arc segment (4): the circular arc section (4) and the forward circular arc section (2) are symmetrical with respect to the perpendicular bisector of the reversing straight line section (3), and the reversing straight line section (3) is the departure point of the circular arc section (4);
s5: operation straight line segment (5): the tail end of the arc section (4) is a starting point of an operation straight line section (5), and the operation straight line section (5) and the forward operation straight line section (1) are parallel and opposite in direction;
coordinate points K (x k ，y k ) The Euler spiral formula is adopted for definition, and the method specifically comprises the following steps:
where c is the rate of change of curvature, s is the arc length, a 2 Is the tangential angle.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011231532.8A CN112363504B (en) | 2020-11-06 | 2020-11-06 | Unmanned turning method for agricultural machinery |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011231532.8A CN112363504B (en) | 2020-11-06 | 2020-11-06 | Unmanned turning method for agricultural machinery |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN112363504A CN112363504A (en) | 2021-02-12 |
| CN112363504B true CN112363504B (en) | 2024-04-12 |
Family
ID=74508784
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202011231532.8A Active CN112363504B (en) | 2020-11-06 | 2020-11-06 | Unmanned turning method for agricultural machinery |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN112363504B (en) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113406960B (en) * | 2021-07-08 | 2022-06-21 | 浙江大学 | Real-time path planning and control method for ground steering of agricultural unmanned vehicle |
Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102741109A (en) * | 2009-12-04 | 2012-10-17 | 罗伯特·博世有限公司 | Method and controller for determining an intersection trajectory of a curve section of a roadway |
| CN107767487A (en) * | 2017-09-05 | 2018-03-06 | 百度在线网络技术（北京）有限公司 | A kind of method and apparatus for determining data acquisition route |
| CN108413977A (en) * | 2018-02-11 | 2018-08-17 | 西安智加科技有限公司 | A kind of intelligent agricultural machinery automatic job exchange method and interactive system |
| CN108958260A (en) * | 2018-07-30 | 2018-12-07 | 黑龙江惠达科技发展有限公司 | A kind of agricultural machinery automated driving system based on farm implements position |
| CN109310043A (en) * | 2016-06-10 | 2019-02-05 | 凯斯纽荷兰工业美国有限责任公司 | The band tracking system of off-road vehicle |
| CN110189547A (en) * | 2019-05-30 | 2019-08-30 | 广州小鹏汽车科技有限公司 | A kind of obstacle detection method, device and vehicle |
| CN110286671A (en) * | 2019-04-29 | 2019-09-27 | 北京工业大学 | A kind of automatic driving vehicle path generating method based on clothoid |
| CN110749333A (en) * | 2019-11-07 | 2020-02-04 | 中南大学 | Unmanned vehicle motion planning method based on multi-objective optimization |
| CN111624988A (en) * | 2019-02-26 | 2020-09-04 | 北京合众思壮科技股份有限公司 | Planning method and device for U-turn path |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE102005058809A1 (en) * | 2005-12-09 | 2007-06-14 | Hella Kgaa Hueck & Co. | path planning |
| US9968025B2 (en) * | 2016-01-14 | 2018-05-15 | CNH Industrial American LLC | System and method for generating and implementing an end-of-row turn path |
-
2020
- 2020-11-06 CN CN202011231532.8A patent/CN112363504B/en active Active
Patent Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102741109A (en) * | 2009-12-04 | 2012-10-17 | 罗伯特·博世有限公司 | Method and controller for determining an intersection trajectory of a curve section of a roadway |
| CN109310043A (en) * | 2016-06-10 | 2019-02-05 | 凯斯纽荷兰工业美国有限责任公司 | The band tracking system of off-road vehicle |
| CN107767487A (en) * | 2017-09-05 | 2018-03-06 | 百度在线网络技术（北京）有限公司 | A kind of method and apparatus for determining data acquisition route |
| CN108413977A (en) * | 2018-02-11 | 2018-08-17 | 西安智加科技有限公司 | A kind of intelligent agricultural machinery automatic job exchange method and interactive system |
| CN108958260A (en) * | 2018-07-30 | 2018-12-07 | 黑龙江惠达科技发展有限公司 | A kind of agricultural machinery automated driving system based on farm implements position |
| CN111624988A (en) * | 2019-02-26 | 2020-09-04 | 北京合众思壮科技股份有限公司 | Planning method and device for U-turn path |
| CN110286671A (en) * | 2019-04-29 | 2019-09-27 | 北京工业大学 | A kind of automatic driving vehicle path generating method based on clothoid |
| CN110189547A (en) * | 2019-05-30 | 2019-08-30 | 广州小鹏汽车科技有限公司 | A kind of obstacle detection method, device and vehicle |
| CN110749333A (en) * | 2019-11-07 | 2020-02-04 | 中南大学 | Unmanned vehicle motion planning method based on multi-objective optimization |
Also Published As
| Publication number | Publication date |
|---|---|
| CN112363504A (en) | 2021-02-12 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110949374B (en) | Automatic parallel parking path planning method based on two-section second-order Bezier curve | |
| CN107544520B (en) | Control method for automatic driving of four-wheel carrier | |
| CN104960520B (en) | Pre- based on Pure Pursuit algorithms takes aim at a determination method | |
| CN112758084B (en) | Parking trajectory planning method, device, equipment and storage medium | |
| CN108791482B (en) | Automatic steering system | |
| Liang et al. | Automatic parking path optimization based on bezier curve fitting | |
| JP2021167194A (en) | Automated parking method, automated parking device, electronic apparatus, storage medium, and computer program | |
| CN102890511B (en) | Guide method for SD type automated guided vehicle (AGV) system under laser guidance | |
| CN111060108B (en) | Path planning method and device and engineering vehicle | |
| CN105278533A (en) | Omnidirectional moving platform navigation method | |
| CN112363504B (en) | Unmanned turning method for agricultural machinery | |
| CN105737838A (en) | AGV path tracking method | |
| CN107560620B (en) | Path navigation method, chip and robot | |
| CN113978452A (en) | Automatic parallel parking path planning method | |
| CN112141091A (en) | Secondary parking method and system for solving parking space deviation and positioning deviation and vehicle | |
| CN110825078A (en) | Ground turning path control system of autonomous navigation tracked vehicle | |
| CN115071686A (en) | Parking method for unmanned mining vehicle in long and narrow area | |
| CN113335270B (en) | Parking path planning method and device | |
| CN111674406A (en) | Method for controlling vehicle transverse direction of automatic driving system | |
| CN109782771B (en) | Orchard mobile robot and ground steering method | |
| CN113406960B (en) | Real-time path planning and control method for ground steering of agricultural unmanned vehicle | |
| CN111857148A (en) | Unstructured road vehicle path planning method | |
| JP5110437B2 (en) | vehicle | |
| CN110069066A (en) | A kind of method and terminal that unmanned vehicle tracks | |
| CN111427346B (en) | Local path planning and tracking method suitable for vehicle type robot |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant |