CN106568443A - Automatic spray bow-shaped path planning method and plant protection unmanned aerial vehicle spray operation method - Google Patents
Automatic spray bow-shaped path planning method and plant protection unmanned aerial vehicle spray operation method Download PDFInfo
- Publication number
- CN106568443A CN106568443A CN201610912176.3A CN201610912176A CN106568443A CN 106568443 A CN106568443 A CN 106568443A CN 201610912176 A CN201610912176 A CN 201610912176A CN 106568443 A CN106568443 A CN 106568443A
- Authority
- CN
- China
- Prior art keywords
- coordinate
- point
- alpha
- centerdot
- max
- 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.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- 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/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Abstract
The invention discloses an automatic spray bow-shaped path planning method comprising the following steps: S101, position coordinates of four end points A, B, C and D of a to-be-operated quadrilateral farmland are obtained one by one by a plant protection unmanned aerial vehicle, and an operation height value of the plant protection unmanned aerial vehicle is determined; S102, a group of equidistant straight lines parallel to one selected edge of a quadrangle are taken, the spacing is H, the group of straight lines have at least one intersection point J with two side edges of the selected edge; and S103, all the intersection points are ranked, the intersection points are arrayed in a bow-shaped manner during series connection, and the path planning is completed. Through bow-shaped spraying of a drug, the working intensity of a drone flyer can be reduced, and the automatic spraying efficiency of the plant protection unmanned aerial vehicle also can be improved.
Description
Technical field
The present invention relates to plant protection unmanned air vehicle technique field, more particularly to a kind of automatic spraying bow vee path V planing method and
Fog machine spraying operation method.
Background technology
In recent years, the market of unmanned plane is flourished, and also more and more extensively, agricultural is exactly that one of them is huge to application
Market.Used as large agricultural country, 1,800,000,000 mu of basic arable lands need every year substantial amounts of personnel to be engaged in agriculture plant protection operation, together for China
When, rural area person between twenty and fifty labour is gradually rare, and human cost increasingly increases, and when plant protection operation is carried out, agricultural chemicals is to human body
Injury is larger, and agricultural is also required to be found a way out from agricultural machinery, and plant protection unmanned plane is exactly a good solution.Four rotations
Wing plant protection unmanned plane has operation height low, can hover, and without the need for special landing airport, the downdraught that rotor is produced contributes to increasing
Plus penetrability of the agricultural chemicals spray to crop, than artificial laxative more preferably, long-distance remote control is operated prevention effect, and spraying operation personnel keep away
The danger being exposed under agricultural chemicals aerosol is exempted from, many advantages, such as improve spraying operation security.In addition, compared to traditional hand
Dynamic sprinkling, plant protection unmanned plane can at least save 50% Pesticide use amount using spray mode, save 90% and use water
Amount, this will significantly reduces cost.
Nowadays, realize that the company of the technology of plant protection unmanned plane automatic spraying is few, there are some to need artificial to go collection
The boundary point in one piece of field, then can just calculate sprinkling path.For different farmlands, each piece is required for artificially going to adopt
Collection, can so substantially reduce spraying efficiency;In addition, also there are some simply to gather two points, unmanned plane is then allowed according to the two
Boundary point carries out traversing operation, and this method may be only available for the farmland of square or rectangle, and if 2 points of collection have
Some deviations, can cause entirely to spray path and deflect away from farmland, cause drain spray and waste, while needing artificial going at the end of sprinkling
Judge and stop unmanned plane.
Using traversing operational method, plant protection unmanned plane can be caused ceaselessly to accelerate in operation process, slow down, and it is traversing
When can also cause border to repeat to spray, on the one hand reduce efficiency, on the other hand also cause crops by secondary sprinkling, cause agriculture
Medicine residual is too high.
The unmanned plane of plant protection at present mainly realizes spraying operation by the manual manipulation of the winged hand of specialty, but due to daily
The sprinkling task on hundreds of mu of ground is very high to the requirement for flying hand, therefore realizes that the automatic spraying function of plant protection unmanned plane is necessary
's.On the one hand, can reduce flying the working strength of hand, on the other hand can also improve the spraying efficiency of plant protection unmanned plane.
The content of the invention
It is an object of the invention to overcome the deficiency of above-mentioned prior art and provide a kind of automatic spraying bow vee path V rule
The method of drawing, the present invention is aiming at the automatic spraying function of plant protection unmanned plane, there is provided a kind of efficient, convenient automatic spraying road
Footpath algorithm.The present invention is primarily to improve the automatic spraying efficiency of plant protection unmanned plane.The present invention can pass through unmanned plane during flying
Sampling site replacing artificially going to the sampling site mode on border, such that it is able to reducing the workload of winged hand and reducing the standard of spraying operation
The standby time;Meanwhile, the present invention can realize the sprinkling path planning in the quadrangle field of irregular terrain profiles, and spreadability is strong, more
Accurately, the demand in more different fields can be met.
For achieving the above object, the present invention provides a kind of automatic spraying bow vee path V planing method, comprises the steps:
S101, plant protection unmanned plane obtains one by one the position coordinates of four summits A, B, C, the D in the quadrangle farmland for treating operation,
Any a line in the quadrangle farmland is chosen as selected side, two summits on the selected side as task point, and really
The operation height value of unmanned plane is protected in field planting;
S102, takes parallel with the selected side and equidistant one group of straight line, and the spacing between adjacent straight line is H, this
Its excess-three bar in group straight line and the quadrangle farmland while two of which while intersect, intersection point is J, and the intersection point J is task point;
S103, by all task points according to predetermined rule compositor, in the arrangement of " bow " font when making each task point connect,
Complete path planning.
Preferably, S101 by control plant protection unmanned plane under winged hand manual mode specifically, fly to successively four tops in farmland
Point A, B, C, D, by the switch control rule of remote control, to the flight control system of plant protection unmanned plane the instruction of coordinate acquisition are sent, and are obtained
The GPS location coordinate of this four points, by four edges circle in farmland at this four points determination.
Preferably, when any end points is gathered, unmanned plane is flown to into specified altitude assignment, and gathers this height value, will
This is highly as operation height H during automatic spraying.
Preferably, the step of S102 also includes coordinate transform before performing, specially:
S102-1, GPS location coordinate when being unlocked according to unmanned plane is as origin and former as coordinate system using the origin
Point O, with towards due south as x-axis positive direction, towards due west as y-axis positive direction, the GPS location coordinate of summit A, B, C, D to be turned
Change the x/y coordinates in units of rice into;
S102-2, X/Y coordinate systems are converted to using Euler's transformation by x/y coordinate systems, in the X/Y coordinate systems, with to
AmountDirection be X-axis positive direction, perpendicular to vectorAnd towards C points and B points side be Y-axis positive direction.
Preferably, in S102-1, the coordinate of four summits A, B, C, D under x/y coordinate systems is set to (Ax, Ay), (Bx, By),
(Cx, Cy), (Dx, Dy),
In S102-1, coordinate is (A under four summit X/Y coordinate systems after conversionX, AY), (BX, BY), (CX, CY), (DX,
DY),
If auxiliary angle [alpha], is defined as:
Coordinate system transformation formula is:
Preferably, the linear equation of three sides AB, BC, CD under X/Y coordinate systems is calculated:
The linear equation on AB sides is:
The linear equation on BC sides is:
The linear equation on CD sides is:
Take AD while for select while;
Definition sprinkling path separation H, takes one group of straight line Y=ZH, this group of straight line and the selected side under X/Y coordinate systems
It is parallel, wherein, Z is the positive integer more than or equal to 1, the AB of this group of straight line and quadrangle, BC, CD tri- while two of which while phase
Hand over, obtain all intersection point J2, J3, J4... ... Ji……JMax.Wherein, 2≤i≤Max, Max >=2, JMaxFor straight line and quadrangle
Last intersection point, if (JiX, JiY) it is JiCoordinate value of the point under X/Y coordinate systems;
Two task points on the farmland quadrangle are respectively defined as into J0And J1。
Preferably, the intersection point J2, J3, J4... ... Ji……JMaxCoding rule be:Every straight line and the farmland four
The intersection point queueing discipline of side shape is:Successively according to the task point J with the selected side1It is intersecting while with it is described selected while it is right
While with it is described selected while task point J0Intersecting side, serial number from small to large, the order of straight line is with adjacent with selected side
Straight line is initial straight line, the direction serial number successively of the straight line on the selected side is directed away from, then to JiPoint is numbered
Adjustment, when i is more than 1, X-coordinate is exchanged by i with i divided by the point that 4 remainders are 0 divided by the point that 4 remainders are 1, then, each
Business point is incremented by series connection and forms " bow " font according to i values.
Preferably, after the completion of path planning, to from J0To JMaxThe coordinate of series of points carry out the inversion of Euler's transformation
Change, obtain J'0To J'MaxCoordinate of the series of points under x/y coordinate systems,For Ji' seat under x/y coordinate systems
Scale value,
Specifically mapping mode is:
Again by J0To JMaxSeries of points Coordinate Conversion be true farmland region longitude coordinate and latitude coordinate series
Point Z0To ZMax。
Preferably, with the operation height there is positive correlation, within the specific limits, operation height in the sprinkling spacing
Higher, sprinkling spacing is bigger.
Preferably, it is 2 to 4 meters to spray spacing H.
Preferably, each position coordinate is stored in the flight control system of plant protection unmanned plane.
The present invention also provides a kind of fog machine spraying operation method, comprises the steps:
S1, using a kind of automatic spraying bow vee path V algorithm implementation method path planning is carried out;
S2, by point Z comprising GPS location coordinate0To ZMaxAnd height value is delivered to the memory of plant protection unmanned plane
In, plant protection unmanned plane passes sequentially through Z0To ZMaxEach point performs spraying operation automatically.
The present invention also provides a kind of fog machine, is sprayed using a kind of automatic spraying bow vee path V algorithm implementation method
Operation.That is, a kind of automatic spraying bow vee path V algorithm implementation method is applied on fog machine.Fog machine be plant protection without
Man-machine abbreviation.
The invention has the beneficial effects as follows:
The present invention can fly to four boundary point coordinate acquisition positions in farmland by plant protection unmanned plane, then calculate in real time
Go out and spray path, realize the automatic path planning of " bow " font, so make plant protection unmanned plane after collection point completes, at once
Automatic spraying can be performed." bend " path planning of font in addition, it is possible to reduce repetition of the plant protection unmanned plane in operation process
The region of sprinkling, so as to further improve the efficiency of automatic spraying.The inventive method goes for the four of irregular terrain profiles
Side shape field.The present invention can realize that automatic path planning and sprinkling are made by the sampling site of plant protection unmanned plane and from host computer
Industry, it is not necessary to which artificial goes field border sampling site with equipment;The present invention than only gather two points method for, be not in compared with
Big skew, more accurately;After the path planning of the present invention, the sprinkling of plant protection unmanned plane is more uniform, reduces and repeats or omit
Spray area.
Description of the drawings
Fig. 1 is the schematic diagram of farmland in the present embodiment under coordinate system O;
Fig. 2 is the schematic diagram that the farmland in the present embodiment carries out after Euler's transformation under coordinate system P;
Fig. 3 is that the schematic diagram after task point numbering is chosen in the farmland in the present embodiment under coordinate system P;
Fig. 4 is that the farmland in the present embodiment adjusts the schematic diagram after task point numbering under coordinate system P;
Fig. 5 be the farmland in the present embodiment task point after the inverse transformation for carrying out Euler's transformation showing under coordinate system O
It is intended to;
Fig. 6 is that the task point in the farmland in the present embodiment is converted to showing after the GPS location coordinate system in true farmland region
It is intended to;
Fig. 7 is the FB(flow block) of the present embodiment.
The realization of the object of the invention, functional characteristics and advantage will be described further referring to the drawings in conjunction with the embodiments.
Specific embodiment
Embodiments of the invention are described below in detail, the example of the embodiment is shown in the drawings, wherein from start to finish
Same or similar label represents same or similar element or the element with same or like function.Below with reference to attached
The embodiment of figure description is exemplary, it is intended to for explaining the present invention, and be not considered as limiting the invention.
Embodiment one:
The path design of the present invention, can be directed to irregular quadrangle field carries out the planning of automated path.It is logical
Cross plant protection unmanned plane and fly to collection of the boundary end point to position coordinates and height, calculate, cook up rational " bow " vee path V.
Fig. 1 to Fig. 6 is referred to, specific implementation is as follows:
First, by four summits A, B, C, D that plant protection unmanned plane flies to successively farmland are controlled under winged hand manual mode, pass through
The switch control rule of remote control, to flight control system send coordinate acquisition instruction, so as to and obtain this four points GPS location sit
Mark, i.e. latitude and longitude coordinates.Four edges circle in farmland are can determine by this four points.And gather the 4th end points D when
Wait, while returning the height value for collecting D points, the path come is cooked up afterwards, just the height using D points is used as work during automatic spraying
Industry height.Any a line in quadrangle farmland is chosen as selected side, two summits on side is selected as task point.In this reality
In applying example, to select side, summit A and summit D is task point to AD.
Flight control system can store unmanned plane GPS coordinate data at that time as unmanned plane when unmanned plane is unlocked
Origin, using this origin as coordinate origin O points, with towards due south as x-axis positive direction, with towards due west as y-axis positive direction,
The plane right-angle coordinate O that can be converted in units of rice by four GPS latitude and longitude coordinates selected that the first step is collected, puts down
Face rectangular coordinate system O is x/y coordinate systems, as shown in figure 1, coordinate of tetra- points of A, B, C, D under coordinate system O is set to (Ax,
Ay),(Bx,By),(Cx,Cy),(Dx,Dy)。
Plane right-angle coordinate P is built, coordinate system P is X/Y coordinate systems.The coordinate system with summit A as origin, with vectorDirection be X-axis positive direction, perpendicular to vectorFor Y-axis, and C points and B points is placed in Y-axis positive direction, that is, be distributed in
First or second quadrant.The coordinate of 4 points is carried out into Euler's transformation.
Result after conversion is as shown in Figure 2.
Point coordinates of tetra- points of A, B, C, D after conversion under P coordinate systems is (AX,AY),(BX,BY),(CX,CY),(DX,
DY),
If auxiliary angle [alpha], is defined as:
Coordinate system transformation formula is:
Wherein, by the change of above-mentioned transformation for mula, each point is transformed under coordinate system P under coordinate system O.Wherein, A points are seat
Origin under mark system P, now, A points coordinate value (A under coordinate system PX,AY) for (0,0).The auxiliary angle is being sat with selected side AD
Slope under mark system O is related.
Calculate three side AB under P coordinate systems, the linear equation of BC, CD:
The linear equation on AB sides is:
The linear equation on BC sides is:
The linear equation on CD sides is:
Definition sprinkling path separation H, sprinkling spacing is that concrete measurement draws under certain altitude.Because unmanned plane is sprayed
Liquid form cone in path when falling, therefore within the specific limits, operation height is higher, and sprinkling spacing is bigger, but by
In the impact of many factors, without specific calculated relationship.The height value and sprinkling spacing of operation needs to set as the case may be
It is fixed.In the present embodiment, optimum sprinkling spacing is 2-4 rice.
One group of straight line Y=ZH is taken under X/Y coordinate systems, this group of straight line is parallel and equidistant with the selected side, adjacent
Spacing between two straight lines is H, wherein, Z is the positive integer more than or equal to 1, this group of straight line and AB, BC and CD of quadrangle
Two of which side is intersected, and obtains all intersection points, and respectively numbering is J2, J3, J4... ... Ji……JMAX, wherein, 2≤i≤Max,
Max≥2.It is J by D points numbering0, A points numbering is J1.Wherein J2, J3, J4... ... Ji……JMaxCoding rule be:It is straight per bar
Line is with the intersection point queueing discipline of farmland quadrangle:According to the task on selected side point J1It is intersecting while → with it is selected while opposite side
→ task point the J with selected side0Intersecting side, descending order numbering, the order of straight line is with the straight line adjacent with selected side
For initial straight line, the direction of the straight line for being directed away from selecting side serial number successively.
In the present embodiment, AD is while to select, the intersection point of every straight line and quadrangle with AB in → BC → CD sides
Intersecting order is numbered from small to large, and the direction of the order of straight line with AD when adjacent straight line is as initial straight towards BC is successively
Serial number, as shown in Figure 3.JMaxFor straight line and quadrangle last intersection point, if last root straight line only has one with quadrangle
Individual intersection point, then JMaxFor C points, as shown in Figure 3.IfFor JiCoordinate value of the point under coordinate system P.
To JiPoint carries out the numbering adjustment of pre-defined rule, when i is more than 1, i is removed divided by the point that 4 remainders are 0 with i
X-coordinate is exchanged with the point that 4 remainders are 1, as shown in Figure 4.Numbering being linked in sequence from small to large when each task point connects, it will
Make plant protection unmanned plane directly proceed by automatic spraying task from D points, and sprayed with " bow " font order.
To J0、J1、J2……Ji……JMaxThe coordinate of series of points carry out the inverse transformation of Euler's transformation, obtain J'0、
J1'、J'2……Ji'……J'MaxSeries of points coordinate.J'0To J'MaxFor the coordinate in plane right-angle coordinate O,For Ji' coordinate value under plane right-angle coordinate O.
Specifically mapping mode is:
Again by J'0To J'MaxEach point is converted to the GPS location coordinate series Z in true farmland region0Point arrives ZMax, it is now just complete
Into path planning.According to Z0Point arrives ZMaxOrder be exactly the three-back-shaped path cooked up of the present invention.
It is pointed out that it is first under coordinate system O by true GPS location Coordinate Conversion to employ in the present embodiment.Coordinate
It is that O is referred to as x/y coordinate systems, then coordinate system O is transformed under coordinate system P, coordinate system P is properly termed as X/Y coordinate systems again,
Thus, being that quadrangle is carried out into rotation process on two dimensional surface from from geometric figure, AD sides and plane right-angle coordinate are made
X-axis alignment, and A points are set to into origin.Thus, the purpose for simplifying calculating can be reached.But, directly sat using GPS location
Mark carries out follow-up calculating can similarly realize the purpose of the present invention.Additionally, operation height value can be by A, B, C, D point
Obtain at any point, it is of course also possible to use the mean value of the height value of two points or multiple points in this four points.
In the present embodiment, as shown in figure 4, employ parallel with X-axis group straight line to go to cut quadrangle, this group of straight line
There is crosspoint in, CD with AB.The coordinate in these crosspoints is tried to achieve by seeking straight line with the formula of straight-line intersection.
Refer to Fig. 6, Z0→Z1→Z2→Z3→Z4→……Zi……ZMAXIt is the bow vee path V planning of the present invention.Need
It is noted that it is the zonule put comprising each that each point can also be expanded, when plant protection unmanned plane is sequentially passed through comprising each
During the region of point, it is treated as by the point, this mainly considers the positioning precision of plant protection unmanned plane, by adjusting the region
Radius, can control the precision of spraying operation and the requirement of the positioning precision for plant protection unmanned plane.
The necessary implementation steps of the present invention are given in Fig. 7, in path planning algorithm, can be by computer according to this
The algorithm of invention obtains computer program, and then plant protection unmanned plane removes the extreme coordinates for obtaining quadrangle farmland by program, and
Outbound path is calculated by program.It is of course also possible to use mode of manual calculations etc..Comprise the steps of in Fig. 7:S101, plants
The position coordinates that unmanned plane obtains one by one four summits A, B, C, the D in the quadrangle farmland for treating operation is protected, the quadrangle is chosen
Used as selected side, two summits on the selected side determine plant protection unmanned plane to any a line in farmland as task point
Operation height value;S102, takes parallel with the selected side and equidistant one group of straight line, and the spacing between adjacent straight line is H,
Its excess-three bar in this group of straight line and the quadrangle farmland while two of which while intersect, intersection point is J, and the intersection point J is task
Point;S103, by all task points according to predetermined rule compositor, in " bow " font row when making each described task point connect
Row, complete path planning.If the area in quadrangle farmland is less, each intersection point J can be determined by way of reduction spacing H;
It is to be noted that the horizontal linear can also be the neutrality line of the quadrangle.If farmland is too small, using plant protection unmanned plane
Manual mode spraying operation.Any one of quadrangle is when can serve as selecting.
Embodiment two:
The present invention provides a kind of fog machine spraying operation method, and step is as follows:Using the paths planning method of embodiment one
Path planning is finished, then by point Z comprising true GPS latitude and longitude coordinates0Point arrives ZMaxAnd the D for collecting before
Point height value all upload in the internal memory of flight controller, aircraft is switched to into mission mode, then aircraft will automatically from
First point starts a sprinkling to the last point.It is pointed out that internal memory can also be replaced by other storage mediums, to
Store these data.
The inventive method goes for the quadrangle field of irregular terrain profiles;The present invention can pass through plant protection unmanned plane
Sampling site and from host computer realizing automatic path planning and spraying operation, it is not necessary to artificial goes to field border to adopt with equipment
Point;Be not in larger skew, more accurately for the present invention is than the only method of two points of collection;The path rule of the present invention
After drawing, the sprinkling of plant protection unmanned plane is more uniform, reduces the spray area for repeating or omitting.
Although embodiments of the invention have been shown and described above, it is to be understood that above-described embodiment is example
Property, it is impossible to limitation of the present invention is interpreted as, one of ordinary skill in the art is in the principle and objective without departing from the present invention
In the case of above-described embodiment can be changed within the scope of the invention, change, replace and modification.
Claims (10)
1. a kind of automatic spraying bends vee path V planing method, it is characterised in that comprise the steps:
S101, plant protection unmanned plane obtains one by one the position coordinates of four summits A, B, C, the D in the quadrangle farmland for treating operation, chooses
Used as selected side, two summits on the selected side determine plant to any a line in the quadrangle farmland as task point
Protect the operation height value of unmanned plane;
S102, takes parallel with the selected side and equidistant one group of straight line, and the spacing between adjacent straight line is H, and this group is straight
Its excess-three bar in line and the quadrangle farmland while two of which while intersect, intersection point is J, and the intersection point J is task point;
S103, all task points are sorted according to pre-defined rule, in " bow " font row when making each described task point connect
Row, complete path planning.
2. according to claim 1 automatic spraying bends vee path V planing method, it is characterised in that:
S101 is specifically, by four summits A, B, C, D that plant protection unmanned plane flies to successively farmland are controlled under winged hand manual mode, lead to
The switch control rule of remote control is crossed, to the flight control system of plant protection unmanned plane the instruction of coordinate acquisition is sent, obtain this four tops
The GPS location coordinate of point, by this four described summits four edges circle in farmland are determined.
3. according to claim 2 automatic spraying bends vee path V planing method, it is characterised in that:Gathering arbitrary summit
When, unmanned plane is flown to into specified altitude assignment, and this height value is gathered, using this highly as operation height during automatic spraying
Value.
4. according to claim 2 automatic spraying bends vee path V planing method, it is characterised in that:
The step of S102 also includes coordinate transform before performing, specially:
S102-1, GPS location coordinate when being unlocked according to unmanned plane as origin, and using the origin as coordinate origin O,
With towards due south as x-axis positive direction, with towards due west as y-axis positive direction, by the GPS location Coordinate Conversion of summit A, B, C, D into
X/y coordinates in units of rice;
S102-2, X/Y coordinate systems are converted to using Euler's transformation by x/y coordinate systems, in the X/Y coordinate systems, with vector
Direction be X-axis positive direction, perpendicular to vectorAnd towards C points and B points side be Y-axis positive direction.
5. according to claim 4 automatic spraying bends vee path V planing method, it is characterised in that:
In S102-1, the coordinate of four described summit A, B, C, D under x/y coordinate systems is set to (Ax, Ay),(Bx, By),(Cx, Cy),
(Dx, Dy),
In S102-2, the coordinate under X/Y coordinate systems of four summits after conversion is (AX, AY), (BX, BY), (CX, CY), (DX,
DY),
If auxiliary angle [alpha], is defined as:
Coordinate system transformation formula is:
6. according to claim 4 automatic spraying bends vee path V planing method, it is characterised in that:
Calculate the linear equation of three sides AB, BC, CD under X/Y coordinate systems:
The linear equation on AB sides is:
The linear equation on BC sides is:
The linear equation on CD sides is:
Definition sprinkling path separation H, takes one group of straight line Y=ZH under X/Y coordinate systems, and this group of straight line is flat with the selected side
OK, wherein, Z is the positive integer more than or equal to 1, its excess-three bar of this group of straight line and quadrangle while two of which while intersect, obtain
All intersection point J2, J3, J4... ... Ji……JMax, wherein, 2≤i≤Max, Max >=2, JMaxFor straight line and quadrangle last
Intersection point, ifFor JiCoordinate value of the point under X/Y coordinate systems;
Two task points on the farmland quadrangle are respectively defined as into J0And J1。
7. according to claim 6 automatic spraying bends vee path V planing method, it is characterised in that:
The pre-defined rule is:The intersection point J2, J3, J4... ... Ji……JMaxCoding rule be:Every straight line and the agriculture
The intersection point queueing discipline of field quadrangle is:Successively according to the task point J with the selected side1It is intersecting while with it is described selected while
Opposite side and the selected side task point J0Intersecting side, serial number from small to large, the order of straight line with selected side phase
Adjacent straight line is initial straight line, the direction serial number successively of the straight line on the selected side is directed away from, then, to JiPoint is carried out
Numbering adjustment, when i is more than 1, X-coordinate is exchanged by i with i divided by the point that 4 remainders are 0 divided by the point that 4 remainders are 1, finally,
Each task point is incremented by series connection and forms " bow " font according to i values.
8. according to claim 7 automatic spraying bends vee path V planing method, it is characterised in that:
After the completion of path planning, to from J0To JMaxThe coordinate of series of points carry out the inverse transformation of Euler's transformation, obtain J'0Arrive
J'MaxCoordinate of the series of points under x/y coordinate systems,For J 'iCoordinate value under x/y coordinate systems,
Specifically mapping mode is:
Again by J0To JMaxSeries of points Coordinate Conversion be true farmland region longitude coordinate and latitude coordinate point Z0
To ZMax。
9. according to claim 1 automatic spraying bends vee path V planing method, it is characterised in that:
The position coordinates of each task point is stored in the flight control system of plant protection unmanned plane.
10. a kind of fog machine spraying operation method, it is characterised in that comprise the steps:
S1, using a kind of automatic spraying bow vee path V planing method described in any one of claim 1 to 9 path rule are carried out
Draw;
S2, by point Z comprising GPS location coordinate0To ZMaxAnd height value is delivered in the memory of plant protection unmanned plane, plant
Protect unmanned plane and pass sequentially through Z0To ZMaxEach point performs spraying operation automatically.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610912176.3A CN106568443B (en) | 2016-10-19 | 2016-10-19 | Automatic spraying bends vee path V planing method and fog machine spraying operation method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610912176.3A CN106568443B (en) | 2016-10-19 | 2016-10-19 | Automatic spraying bends vee path V planing method and fog machine spraying operation method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106568443A true CN106568443A (en) | 2017-04-19 |
CN106568443B CN106568443B (en) | 2019-11-29 |
Family
ID=58533920
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610912176.3A Active CN106568443B (en) | 2016-10-19 | 2016-10-19 | Automatic spraying bends vee path V planing method and fog machine spraying operation method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106568443B (en) |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107272739A (en) * | 2017-07-24 | 2017-10-20 | 湘潭大学 | A kind of pesticide spraying system and method based on primary and secondary system |
CN107368094A (en) * | 2017-08-25 | 2017-11-21 | 上海拓攻机器人有限公司 | A kind of unmanned plane plant protection operation flight course planning method and device |
CN108513643A (en) * | 2017-08-31 | 2018-09-07 | 深圳市大疆创新科技有限公司 | A kind of paths planning method, aircraft, flight system |
CN108719242A (en) * | 2018-03-27 | 2018-11-02 | 钟静海 | Pesticide spraying system |
CN109032165A (en) * | 2017-07-21 | 2018-12-18 | 广州极飞科技有限公司 | The generation method and device in unmanned plane course line |
CN109118502A (en) * | 2018-10-18 | 2019-01-01 | 信阳师范学院 | Operation overlay area Real-time Reconstruction method and system based on breakpoint segmentation |
CN109144100A (en) * | 2018-09-03 | 2019-01-04 | 南京嘉谷初成通信科技有限公司 | Spray control method, device, earth station and storage medium |
CN109407701A (en) * | 2018-11-30 | 2019-03-01 | 广州极飞科技有限公司 | Control the method, system and device of operation |
CN109496287A (en) * | 2017-10-31 | 2019-03-19 | 深圳市大疆创新科技有限公司 | Movable equipment job control method and device, paths planning method and device |
CN109933091A (en) * | 2019-04-19 | 2019-06-25 | 北方天途航空技术发展(北京)有限公司 | Paths planning method, storage medium and the electronic equipment of unmanned machine operation |
CN110057367A (en) * | 2019-05-08 | 2019-07-26 | 广州知行机器人科技有限公司 | A kind of method and device of the flight course planning of unmanned plane |
CN110118555A (en) * | 2019-05-27 | 2019-08-13 | 深圳市贝贝特科技实业有限公司 | UAV Navigation System and method |
CN110134147A (en) * | 2019-06-20 | 2019-08-16 | 安阳全丰航空植保科技股份有限公司 | A kind of autonomous paths planning method and device of plant protection drone |
CN111273647A (en) * | 2018-11-19 | 2020-06-12 | 苏州宝时得电动工具有限公司 | Automatic walking equipment and control method thereof |
CN112208761A (en) * | 2020-09-08 | 2021-01-12 | 刘红光 | Three-dimensional rainfall system based on unmanned aerial vehicle |
CN113867371A (en) * | 2021-12-02 | 2021-12-31 | 深圳市普渡科技有限公司 | Path planning method and electronic equipment |
WO2023246802A1 (en) * | 2022-06-21 | 2023-12-28 | 松灵机器人(深圳)有限公司 | Mowing method and apparatus, robotic lawn mower, and storage medium |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102937443A (en) * | 2012-01-13 | 2013-02-20 | 唐粮 | Target rapid positioning system and target rapid positioning method based on unmanned aerial vehicle |
CN103017753A (en) * | 2012-11-01 | 2013-04-03 | 中国兵器科学研究院 | Unmanned aerial vehicle route planning method and device |
CN105116913A (en) * | 2015-08-12 | 2015-12-02 | 北京农业智能装备技术研究中心 | Plant protection UAV operation route planning method and device |
CN105222779A (en) * | 2015-08-26 | 2016-01-06 | 北京农业智能装备技术研究中心 | The path planning method of plant protection unmanned plane and device |
CN105843250A (en) * | 2016-03-28 | 2016-08-10 | 深圳高科新农技术有限公司 | Unmanned plane-based chemical spraying method, unmanned plane and unmanned plane system |
CN105955294A (en) * | 2016-05-26 | 2016-09-21 | 北京大工科技有限公司 | Method and device used for controlling plant protection work of unmanned plane |
-
2016
- 2016-10-19 CN CN201610912176.3A patent/CN106568443B/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102937443A (en) * | 2012-01-13 | 2013-02-20 | 唐粮 | Target rapid positioning system and target rapid positioning method based on unmanned aerial vehicle |
CN103017753A (en) * | 2012-11-01 | 2013-04-03 | 中国兵器科学研究院 | Unmanned aerial vehicle route planning method and device |
CN105116913A (en) * | 2015-08-12 | 2015-12-02 | 北京农业智能装备技术研究中心 | Plant protection UAV operation route planning method and device |
CN105222779A (en) * | 2015-08-26 | 2016-01-06 | 北京农业智能装备技术研究中心 | The path planning method of plant protection unmanned plane and device |
CN105843250A (en) * | 2016-03-28 | 2016-08-10 | 深圳高科新农技术有限公司 | Unmanned plane-based chemical spraying method, unmanned plane and unmanned plane system |
CN105955294A (en) * | 2016-05-26 | 2016-09-21 | 北京大工科技有限公司 | Method and device used for controlling plant protection work of unmanned plane |
Cited By (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109032165B (en) * | 2017-07-21 | 2021-09-10 | 广州极飞科技股份有限公司 | Method and device for generating unmanned aerial vehicle air route |
CN109032165A (en) * | 2017-07-21 | 2018-12-18 | 广州极飞科技有限公司 | The generation method and device in unmanned plane course line |
CN107272739A (en) * | 2017-07-24 | 2017-10-20 | 湘潭大学 | A kind of pesticide spraying system and method based on primary and secondary system |
CN107368094A (en) * | 2017-08-25 | 2017-11-21 | 上海拓攻机器人有限公司 | A kind of unmanned plane plant protection operation flight course planning method and device |
CN108513643A (en) * | 2017-08-31 | 2018-09-07 | 深圳市大疆创新科技有限公司 | A kind of paths planning method, aircraft, flight system |
CN109496287A (en) * | 2017-10-31 | 2019-03-19 | 深圳市大疆创新科技有限公司 | Movable equipment job control method and device, paths planning method and device |
CN108719242A (en) * | 2018-03-27 | 2018-11-02 | 钟静海 | Pesticide spraying system |
CN108719242B (en) * | 2018-03-27 | 2020-12-29 | 钟静海 | Pesticide spraying system |
CN109144100A (en) * | 2018-09-03 | 2019-01-04 | 南京嘉谷初成通信科技有限公司 | Spray control method, device, earth station and storage medium |
CN109118502A (en) * | 2018-10-18 | 2019-01-01 | 信阳师范学院 | Operation overlay area Real-time Reconstruction method and system based on breakpoint segmentation |
CN109118502B (en) * | 2018-10-18 | 2021-11-02 | 信阳师范学院 | Operation coverage area real-time reconstruction method and system based on breakpoint segmentation |
CN111273647A (en) * | 2018-11-19 | 2020-06-12 | 苏州宝时得电动工具有限公司 | Automatic walking equipment and control method thereof |
CN109407701A (en) * | 2018-11-30 | 2019-03-01 | 广州极飞科技有限公司 | Control the method, system and device of operation |
CN109407701B (en) * | 2018-11-30 | 2022-12-27 | 广州极飞科技股份有限公司 | Method, system and device for controlling operation |
CN109933091A (en) * | 2019-04-19 | 2019-06-25 | 北方天途航空技术发展(北京)有限公司 | Paths planning method, storage medium and the electronic equipment of unmanned machine operation |
CN109933091B (en) * | 2019-04-19 | 2022-07-05 | 北方天途航空技术发展(北京)有限公司 | Unmanned aerial vehicle operation path planning method, storage medium and electronic equipment |
CN110057367A (en) * | 2019-05-08 | 2019-07-26 | 广州知行机器人科技有限公司 | A kind of method and device of the flight course planning of unmanned plane |
CN110118555A (en) * | 2019-05-27 | 2019-08-13 | 深圳市贝贝特科技实业有限公司 | UAV Navigation System and method |
CN110134147A (en) * | 2019-06-20 | 2019-08-16 | 安阳全丰航空植保科技股份有限公司 | A kind of autonomous paths planning method and device of plant protection drone |
CN112208761A (en) * | 2020-09-08 | 2021-01-12 | 刘红光 | Three-dimensional rainfall system based on unmanned aerial vehicle |
CN113867371A (en) * | 2021-12-02 | 2021-12-31 | 深圳市普渡科技有限公司 | Path planning method and electronic equipment |
CN113867371B (en) * | 2021-12-02 | 2022-06-07 | 深圳市普渡科技有限公司 | Path planning method and electronic equipment |
WO2023246802A1 (en) * | 2022-06-21 | 2023-12-28 | 松灵机器人(深圳)有限公司 | Mowing method and apparatus, robotic lawn mower, and storage medium |
Also Published As
Publication number | Publication date |
---|---|
CN106568443B (en) | 2019-11-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106568443A (en) | Automatic spray bow-shaped path planning method and plant protection unmanned aerial vehicle spray operation method | |
CN106547276A (en) | The three-back-shaped paths planning method of automatic spraying and fog machine spraying operation method | |
CN108205326B (en) | The method and device of unmanned machine operation | |
CN105222779B (en) | The path planning method and device of plant protection unmanned plane | |
CN106020237B (en) | The multimachine operation flight course planning and its spraying operation method and system of plant protection drone | |
CN108362285B (en) | Plant protection unmanned aerial vehicle accurate coverage track planning method and system | |
CN104808660B (en) | Bumps mixing complex polygon farmland unmanned plane spraying operation path planning method | |
CN106227237A (en) | The distribution method of the aerial mission of unmanned plane and device | |
CN103679774B (en) | A kind of polygon farmland operation zone boundary modeling method | |
CN104216382B (en) | Spatial small aircraft formation flying control system | |
CN105955294A (en) | Method and device used for controlling plant protection work of unmanned plane | |
CN107272726A (en) | Operating area based on unmanned plane plant protection operation determines method and device | |
CN109871029A (en) | A kind of plant protection drone flight course planning optimization method based on image processing techniques | |
CN107933921A (en) | Aircraft and its sprinkling Route Generation and execution method, apparatus, control terminal | |
CN107065929A (en) | A kind of unmanned plane is around flying method and system | |
WO2021051278A1 (en) | Earth surface feature identification method and device, unmanned aerial vehicle, and computer readable storage medium | |
CN107264806A (en) | A kind of plant protection spray method of unmanned plane | |
CN107808550A (en) | A kind of unmanned machine management system of plant protection | |
CN107289944A (en) | A kind of method and device of control unmanned plane plant protection operation | |
CN107526367A (en) | A kind of fruit tree plant protection unmanned plane operating system based on geography information integration technology | |
CN111982097A (en) | Method and device for generating target route of unmanned operation equipment and plant protection system | |
CN103714563B (en) | A kind of boundary of curve type farmland operation area modeling method | |
CN108184794A (en) | Plant protection operation method, terminal, plant protection unmanned plane and computer readable storage medium | |
CN106774403A (en) | A kind of flight course planning method and device | |
CN103824324A (en) | Fruit tree crown layer leaf and fruit three-dimensional reconstruction method and system |
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 | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20190709 Address after: 414000 Xindeng Incubator Office, Yungang Road, Chenglingji New Port District, Yueyang City, Hunan Province, 3rd Floor Applicant after: Pangu Industrial Technology (Yueyang) Co., Ltd. Address before: 201206 2 floor of building 13, 27 Jinqiao Road, Pudong New Area Free Trade Zone, Shanghai. Applicant before: SHANGHAI SHENGYAO INTELLIGENT TECHNOLOGY CO., LTD. |
|
TA01 | Transfer of patent application right | ||
GR01 | Patent grant | ||
GR01 | Patent grant |