CN106681335A - Obstacle-avoiding route planning and control method for unmanned agricultural machine driving - Google Patents
Obstacle-avoiding route planning and control method for unmanned agricultural machine driving Download PDFInfo
- Publication number
- CN106681335A CN106681335A CN201710156019.9A CN201710156019A CN106681335A CN 106681335 A CN106681335 A CN 106681335A CN 201710156019 A CN201710156019 A CN 201710156019A CN 106681335 A CN106681335 A CN 106681335A
- Authority
- CN
- China
- Prior art keywords
- agricultural machinery
- points
- arc section
- obstacle
- theoretical
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 57
- 238000005457 optimization Methods 0.000 claims abstract description 17
- 230000004888 barrier function Effects 0.000 claims description 27
- 238000005304 joining Methods 0.000 claims description 9
- 238000004364 calculation method Methods 0.000 claims description 6
- 239000011159 matrix material Substances 0.000 claims description 6
- 230000000007 visual effect Effects 0.000 claims description 6
- 230000007613 environmental effect Effects 0.000 claims description 4
- 238000009825 accumulation Methods 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 238000003860 storage Methods 0.000 claims description 3
- 238000007689 inspection Methods 0.000 claims 1
- 238000004422 calculation algorithm Methods 0.000 description 8
- 238000010586 diagram Methods 0.000 description 4
- 238000004088 simulation Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 208000027418 Wounds and injury Diseases 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 230000006378 damage Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 208000014674 injury Diseases 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000035772 mutation Effects 0.000 description 1
- 230000036632 reaction speed Effects 0.000 description 1
- 238000011897 real-time detection Methods 0.000 description 1
- 239000004575 stone Substances 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, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Guiding Agricultural Machines (AREA)
Abstract
The invention provides an obstacle-avoiding route planning and control method for unmanned agricultural machine driving. A method for automatically avoiding obstacles of an agricultural machine comprises the specific steps that 1, agricultural machine information is obtained through a sensor to make an obstacle-avoiding decision; 2, an improved shortest tangent method is used for calculating a theoretical obstacle-avoiding route online; 3, a Bezier curve based route optimization method is utilized to optimize the theoretical obstacle-avoiding route in the step 2 to obtain an actual obstacle-avoiding route, a front wheel rotating angle of the agricultural machine is controlled by combining pre-viewing with PI controller, so that the agricultural machine walks along the actual obstacle-avoiding route to bypass obstacles. The obstacle-avoiding route planned by adopting the method is easy to control, a walking journey is short, and the control precision is high.
Description
Technical field
The present invention relates to a kind of automatic turn around path planning and its control method, more particularly to a kind of for agricultural machinery, nobody drives
The obstacle-avoiding route planning and its control method sailed.
Background technology
Agricultural machinery in self-navigation operation it is many it is unknown in environment division in the case of run, realization carries out safeguard protection to people
Reduce to minimum with the extent of injury to crops, while the production efficiency of performance independent navigation agricultural vehicle that again can be maximum, will
Be one it is important study a question, while agricultural machinery can be potentially encountered the relatively small barrier such as electric pole, finger stone, it is necessary to
Agricultural machinery can automatically bypass these barriers and rapidly return back to the route of operation.
In the prior art, for smaller barrier, avoidance path, most chopped collimation method shape are set using most chopped collimation method
Into avoidance path be made up of two sections of straightways and one section of arc section, straightway is tangent with arc section respectively, this avoidance path
Although simple and fast, it is difficult that control is turned and be difficult according to knuckle for the tractor with min. turning radius, if control
Agricultural machinery processed is walked according to this avoidance path, and the control accuracy of agricultural machinery is very low;In addition, control agricultural machinery is according to the avoidance road for setting
The control method of footpath walking has various, such as BUG algorithms, Artificial Potential Field Method, VFH algorithms, fuzzy logic algorithm, fuzzy neural network
Algorithm etc., the application scenarios of these algorithms are complicated operating environments, and the logic of algorithm is complicated, is applied to agricultural machinery working not
Under complicated operating environment, reaction speed is slower, and its control accuracy is reduced on the contrary;Sum it up, either path planning is still
The control method in avoidance path, control agricultural machinery is very low according to the precision that the path for setting is walked, and deviates the avoidance path of setting,
The distance for causing agricultural machinery cut-through thing to be walked is remote, from initially entering avoidance path to returning to agricultural machinery original rectilinear walking path
Time is long.
The content of the invention
For defect of the prior art, it is an object of the invention to overcome above-mentioned weak point of the prior art, solution
Certainly avoidance path is difficult in the prior art is controlled and the low technical problem of control accuracy, there is provided one kind is kept away for agricultural machinery to be unpiloted
Barrier path planning and its control method, the distance that the avoidance path in the present invention is easily controlled and walks are short, and control accuracy is high.
The object of the present invention is achieved like this:One kind is used for the unpiloted obstacle-avoiding route planning of agricultural machinery and its controlling party
Method, agricultural machinery gets around concretely comprising the following steps for barrier automatically,
Step 1:Agricultural machinery environmental information is obtained by sensor and makes avoidance decision-making;
Step 2:Go out a theoretical avoidance path using improved most chopped collimation method off-line calculation;
Step 3:Kept away using the theoretical avoidance path in the method for optimizing route Optimization Steps 2 based on Bezier curve is actual
Barrier path so that the path after optimization is more prone to control, gets up to control the front-wheel of agricultural machinery with PI controller combinations using taking aim in advance
Corner makes agricultural machinery get around barrier along the walking of actual avoidance path.
During present invention work, agricultural machinery is arranged on the environment letter around the sensor sensing agricultural machinery on agricultural machinery in the process of walking
Breath, when there is barrier in agricultural machinery front, makes avoidance decision-making, and a theoretical avoidance road is calculated using improved most chopped collimation method
Footpath, optimizes to theoretical avoidance path and obtains an actual avoidance path for being more prone to control, using preview control device and
PI controllers are combined together the front wheel angle for calculating agricultural machinery in real time, and agricultural machinery is in the process of walking by real-time adjustment agricultural machinery
Front wheel angle makes agricultural machinery be walked along the actual avoidance path of setting, so as to realize the automatic obstacle-avoiding of agricultural machinery;The present invention is by changing
Most chopped collimation method after entering calculates a theoretical avoidance path, using the method for optimizing route based on Bezier curve to theory
Avoidance path is optimized, and avoidance path is more prone to control, and agriculture is controlled by the combination of preview control device and PI controllers
The front wheel steering angle of machine makes agricultural machinery along the avoidance curved path walking for setting, and control accuracy is high;Can be applied to unpiloted agriculture
Machine is in farm work in the work of automatic obstacle-avoiding.
The reliability in theoretical avoidance path is obtained to further improve, in step 2, theoretical avoidance path is calculated specifically
To calculate the distance of the size, agricultural machinery and barrier of the characteristic circle of agricultural machinery preceding object thing, the size setting peace according to characteristic circle
Full distance, plough tool width and agricultural machinery min. turning radius according to agricultural machinery set a theoretical avoidance path.
In order that avoidance path is more prone to control, in step 2, most chopped collimation method is specifically, with the center of barrier
For characteristic circle is done in the center of circle, the radius of characteristic circle is rmin+ w/2, theoretical avoidance path is by arc section one, straightway one, arc section
2nd, straightway two and arc section three are constituted, and the straight line path that one end of arc section one is original with agricultural machinery is tangent, arc section one it is another
One end is tangent with one end of straightway one, and the other end of straightway one and one end of straightway two are tangent with arc section two respectively,
The other end of straightway two is tangent with arc section three, and arc section two is characterized a section on circle, and arc section one and arc section three are closed
It is symmetrical arranged in the center line of arc section two, agricultural machinery sequentially passes through arc section one, straightway one, arc section two, the and of straightway two
The cut-through thing of arc section three, wherein, rminIt is the min. turning radius of agricultural machinery, w is the working width of agricultural machinery, outside barrier
Radius of circle is connect less than min. turning radius.
Turned around the precision in path to further improve agricultural machinery, the radius of the arc section one is rmin, the arc section three
Radius be rmin, the starting point of arc section one is designated as H points, and the center of circle of arc section one is designated as O1Point, straightway one is original with agricultural machinery
The joining of straight line path is designated as J, and straightway one is designated as D, agricultural machinery original path and characteristic circle with the points of tangency of arc section two
Joining is designated as K and K ' respectively, and JK=w/2, the center of circle of arc section two is designated as O points, and the coordinate of O is set to(A, b), arc section two
Central point is designated as B points, and the coordinate of J points is designated as(X1, y1), the equation of JD can be write as:
(1-1);
The equation of characteristic circle can be write as:
(1-2)
Pass through(1-1)With(1-2)K can be obtained, D points are the joining of JD and characteristic circle, and D point coordinates is solved with this;
Set up an office O1Coordinate be(x2,y2), then point O1Distance to straight line JD is:
According to formula(1-3)With(1-4)Obtain O1Coordinate;Then the coordinate of H points is(x2, y1), the coordinate of B points is(A, b+r);
The contact of mathematical relationship is set up in this design to each line segment in constitution theory avoidance path, specifies the concrete shape of curve,
Coordinate at inflection point is obtained, facilitates optimization of the next step to theoretical avoidance path.
In order to optimize the theoretical avoidance path designed using improved most chopped collimation method in the present invention, in step 3, using base
Theoretical avoidance path in the method for optimizing route Optimization Steps 2 of Bezier curve, is specifically to set up Bezier equations,
(1) n+1, the space position vector of point is given, then the interpolation formula of each point coordinates is on parameter curve:
(2-1)
WhereinThe characteristic point of the curve is constituted,It is n Bernstein basic function:
(2-2)
By above-mentioned formula, it can be deduced that the mathematic(al) representation of three times and quadratic bezier curve, as n=3, Q (t) is more than three times
Item formula, there is four control points, and its matrix form is expressed as:
(2-3)
Work as n=2, Q (t) is quadratic polynomial, there are three control points, and matrix expression is:
(2-4)
(2)The curvature expression formula of Bezier curve is:
(2-5)
Wherein, y=f(x)The equation of curve is represented, y ' is the first derivative of curve, y " it is second dervative;
Radius of curvature is:
(2-6);
In this design, propose that Bezier curve optimization method is optimized to theoretical avoidance path, it is specifically that curvature is discontinuous
Theoretical avoidance path optimization into the actual avoidance path of continual curvature, actual avoidance path be more prone to control.
In order to improve the controllability of Bezier curve, three bezier curve is chosen, for three bezier curve:
(2-7)
(2-8)
Wherein, X0, X1, X2, X3 are respectively the lateral coordinates at P0 points, P1 points, P2 points and P3 points, and Y0, Y1, Y2 and Y3 are respectively
Longitudinal coordinate at P0 points, P1 points, P2 points and P3;
The starting point H of P0 points correspondence arc section one(x2, y1), the central point B of P3 points correspondence arc section two(A, b+r), P1 points((x2+
a)/ 2, y1), P2 points((x2+a)/ 2, b+r), then the curvature radius calculation formula of the corresponding curve in physical fault path be:
(2-9);
In this design, the inflection point on Choice Theory avoidance path is used as the optimization point in Bezier curve optimization method, optimization
Path afterwards is simpler, continual curvature, it is easy to control.
In order to improve the control accuracy of aircraft pursuit course, in step 3, theoretical front wheel angle is calculated using preview control device,
Be specifically to determine the forward sight of agricultural machinery apart from l, take on path a little to take aim at a little in advance(x0, y0), R is forward sight apart from corresponding circle
The radius of segmental arc, the relational expression between l, R and x is:
(3-1)
Agricultural machinery is reduced to cart, the kinematics model of agricultural machinery is set up:
(3-2)
According to Ackermann steering geometrical relationship, the radius of turn and front wheel angle of agricultural machinery, the relational expression of wheelbase are:
(3-3)
Will(3-2)With(3-3)Combine and obtain the computing formula of theoretical corner and be:
(3-4)
Wherein, θ is the course deviation angle of agricultural machinery, and agricultural machinery rear shaft center is designated as point A, agricultural machinery rear shaft center A and takes aim at point P lines in advance
AP is designated as, course deviation angle is the angle between agricultural machinery course and AP, and δ is the theoretical front wheel angle of agricultural machinery, and L is the axle of agricultural machinery
Away from v is the travel speed of agricultural machinery, and the point nearest apart from agricultural machinery center is M on the curved path of setting.
In order to further improve the control accuracy of aircraft pursuit course, in step 3, compensation front-wheel is calculated using PI control methods
Corner, specifically comprises the following steps:
(301)The course deviation angle θ that position according to agricultural machinery and taking aim in advance a little calculates agricultural machinery is input into e as the error of PI(k);
(302)Calculate current score accumulation error;
(303)PI controlled outputs compensate front wheel angle, and the computing formula for compensating front wheel angle is:
(4)
Wherein, KpIt is proportional gain, KiIt is storage gain, e(i)It is corresponding error input under i time points, when k is for total sampling
Between count, u(k)It is the output of PI controls, is specifically current compensation front wheel angle;
Before the compensation front wheel angle that is exported with PI controllers of theoretical front wheel angle that preview control device is exported is reality after being added
Wheel corner, actual front wheel corner exports give agricultural machinery model in real time, controls the front wheel angle of agricultural machinery to realize agricultural machinery automatic obstacle-avoiding;This sets
In meter, in actual motion, steering relation is not to fully meet the Ackermann steering principle in preview control device to agricultural machinery, can be deposited
In certain control error, PI control methods and preview control method are combined to eliminate the error that preview control device brings,
Further improve control accuracy.
As a further improvement on the present invention, the sensor includes position sensor, angular transducer and machine vision
Camera, the angular transducer detects the steering angle of agricultural machinery, and the position sensor obtains the positional information of agricultural machinery;The vision
Machine camera is provided with 2 and is separately positioned on the front and rear side of agricultural machinery, and visual machine camera obtains the geographical letter of agricultural machinery local environment
Breath.
Brief description of the drawings
Fig. 1 is the theoretical avoidance path locus figure in the present invention.
Fig. 2 is the performance plot one of three bezier curve in the present invention.
Fig. 3 is the performance plot two of three bezier curve in the present invention.
Fig. 4 is the actual avoidance path locus figure in the present invention.
Fig. 5 is the curvature chart in actual avoidance path in the present invention.
Fig. 6 is control block diagram of the invention.
Fig. 7 is that pre- in the present invention takes aim at algorithm keeps track schematic diagram.
Fig. 8 is the curve tracking schematic diagram in the present invention.
Fig. 9 is the analogue simulation curve tracking comparison diagram of setting curve and aircraft pursuit course in the present invention.
Figure 10 is the course deviation simulation drawing in the present invention.
Figure 11 is the lateral deviation simulation drawing in the present invention.
Figure 12 is the front wheel steering angle curve map in the present invention.
Specific embodiment
The present invention is further illustrated below in conjunction with the accompanying drawings.
One kind as shown in Fig. 1~12 is used for the unpiloted obstacle-avoiding route planning of agricultural machinery and its control method, and agricultural machinery is certainly
It is dynamic to get around concretely comprising the following steps for barrier,
Step 1:Agricultural machinery environmental information is obtained by sensor and makes avoidance decision-making;
Step 2:Go out a theoretical avoidance path using improved most chopped collimation method off-line calculation;
Step 3:Kept away using the theoretical avoidance path in the method for optimizing route Optimization Steps 2 based on Bezier curve is actual
Barrier path so that the path after optimization is more prone to control, gets up to control the front-wheel of agricultural machinery with PI controller combinations using taking aim in advance
Corner makes agricultural machinery get around barrier along the walking of actual avoidance path;
In step 1 of the invention, sensor includes position sensor, angular transducer and machine vision camera, angular transducer
The steering angle of agricultural machinery is detected, position sensor obtains the positional information of agricultural machinery;Visual machine camera is provided with 2 and is separately positioned on
The front and rear side of agricultural machinery, visual machine camera obtains the geography information of agricultural machinery local environment;
In step 2, calculate theoretical avoidance path and be in particular, calculate the size of the characteristic circle of agricultural machinery preceding object thing, agricultural machinery with
The distance of barrier, the size setting safe distance according to characteristic circle, the minimum turning half of plough tool width and agricultural machinery according to agricultural machinery
Footpath, sets a theoretical avoidance path.
In order that avoidance path is more prone to control, in step 2, most chopped collimation method is specifically, with the center of barrier
For characteristic circle is done in the center of circle, the radius of characteristic circle is rmin+ w/2, as shown in figure 1, theoretical avoidance path is by arc section one, straightway
First, arc section two, straightway two and arc section three are constituted, and the straight line path that one end of arc section one is original with agricultural machinery is tangent, circle
The other end of segmental arc one is tangent with one end of straightway one, the other end of straightway one and one end of straightway two respectively with circular arc
Section two is tangent, and the other end of straightway two is tangent with arc section three, and arc section two is characterized a section on circle, arc section one and circle
Center line of the segmental arc three on arc section two is symmetrical arranged, and agricultural machinery sequentially passes through arc section one, straightway one, arc section two, straight
Line segment two and the cut-through thing of arc section three, wherein, rminIt is the min. turning radius of agricultural machinery, w is the working width of agricultural machinery, barrier
The circumradius of thing is hindered to be less than min. turning radius;
The radius of arc section one is rmin, the radius of the arc section three is rmin, the starting point of arc section one is designated as H points, arc section
One center of circle is designated as O1Point, straightway one is designated as J, straightway one and arc section two with the joining of the original straight line path of agricultural machinery
Points of tangency be designated as D, agricultural machinery original path is designated as K and K ', JK=w/2, the center of circle of arc section two respectively with the joining of characteristic circle
O points are designated as, the coordinate of O is set to(A, b), the central point of arc section two is designated as B points, and the coordinate of J points is designated as(X1, y1), the side of JD
Journey can be write as:
(1-1);
The equation of characteristic circle can be write as:
(1-2)
Pass through(1-1)With(1-2)K can be obtained, D points are the joining of JD and characteristic circle, and D point coordinates is solved with this;
Set up an office O1Coordinate be(x2,y2), then point O1Distance to straight line JD is:
According to formula(1-3)With(1-4)Obtain O1Coordinate;Then the coordinate of H points is(x2, y1), the coordinate of B points is(A, b+r);
In order to optimize the theoretical avoidance path in the present invention using improved most chopped collimation method design, in step 3, using being based on
Theoretical avoidance path in the method for optimizing route Optimization Steps 2 of Bezier curve, is specifically to set up Bezier equations,
(1) n+1, the space position vector of point is given, then the interpolation formula of each point coordinates is on parameter curve:
(2-1)
WhereinThe characteristic point of the curve is constituted,It is n Bernstein basic function:
(2-2)
By above-mentioned formula, it can be deduced that the mathematic(al) representation of three times and quadratic bezier curve, as n=3, Q (t) is more than three times
Item formula, there is four control points, and its matrix form is expressed as:
(2-3)
Work as n=2, Q (t) is quadratic polynomial, there are three control points, and matrix expression is:
(2-4)
(2)The property of Bezier curve
The value of Bezier curve two-end-point is obtained by formula (2-1):
As t=0,
(2-10)
As t=1,
(2-11)
It is to the derived function that formula (2-1) obtains Bezier curve:
(2-12)
In starting point t=0,
(2-13)
In starting point t=1,
(2-14)
Quadratic bezier curve properties of end vertex:
(2-15)
Three bezier curve properties of end vertex is:
(2-16)
The first of tangential direction at beginning and end and characteristic polygon is can be seen that from the property of analysis Bezier curve
Trend of bar while with the last item is consistent, then by planning the tangential direction of Bezier curve starting point and terminal, realize
Determination to the initial pose of vehicle and object pose;As can be seen that three bezier curve all falls in spy from Fig. 2 and Fig. 3
Levy in polygon P0P1P2P3, increased the controllability of Bezier curve;
(3)The curvature expression formula of Bezier curve is:
(2-5)
Wherein, y=f(x)The equation of curve is represented, y ' is the first derivative of curve, y " it is second dervative;
Radius of curvature is:
(2-6);
Analyzed for more than, in order to improve the controllability of Bezier curve, the present invention chooses three bezier curve, for three times
Bezier curve:
(2-7)
(2-8)
Wherein, X0, X1, X2, X3 are respectively the lateral coordinates at P0 points, P1 points, P2 points and P3 points, and Y0, Y1, Y2 and Y3 are respectively
Longitudinal coordinate at P0 points, P1 points, P2 points and P3;
The starting point H of P0 points correspondence arc section one(x2, y1), the central point B of P3 points correspondence arc section two(A, b+r), P1 points((x2+
a)/ 2, y1), P2 points((x2+a)/ 2, b+r), then the curvature radius calculation formula of the corresponding curve in physical fault path be:
(2-9);
With the actual avoidance path of three bezier curve optimum theory avoidance path formation by two in arc section two
The symmetrically arranged actual avoidance curve ρ 0 of the heart is constituted(As shown in Figure 6);
In order to improve the control accuracy of aircraft pursuit course, in step 3, theoretical front wheel angle is calculated using preview control device, specifically
Be to determine the forward sight of agricultural machinery apart from l, take on path a little to take aim at a little in advance(x0, y0), R is forward sight apart from corresponding arc section
Radius, the relational expression between l, R and x is:
(3-5)
By(3-5)Can obtain:
(3-1)
Agricultural machinery is reduced to cart, the kinematics model of agricultural machinery is set up:
(3-2)
According to Ackermann steering geometrical relationship, the radius of turn and front wheel angle of agricultural machinery, the relational expression of wheelbase are:
(3-3)
Will(3-2)With(3-3)Combine and obtain the computing formula of theoretical corner and be:
(3-4)
Wherein, θ is the course deviation angle of agricultural machinery, and agricultural machinery rear shaft center is designated as point A, agricultural machinery rear shaft center A and pre- point P lines of taking aim at are remembered
It is AP, course deviation angle is the angle between agricultural machinery course and AP, and δ is the theoretical front wheel angle of agricultural machinery, and L is the wheelbase of agricultural machinery, v
It is the travel speed of agricultural machinery, the point nearest apart from agricultural machinery center is M on the curved path of setting;
In step 3, compensation front wheel angle is calculated using PI control methods, specifically comprised the following steps:
(301)The course deviation angle θ that position according to agricultural machinery and taking aim in advance a little calculates agricultural machinery is input into e as the error of PI(k);
(302)Calculate current score accumulation error;
(303)PI controlled outputs compensate front wheel angle, and the computing formula for compensating front wheel angle is:
(4)
Wherein, KpIt is proportional gain, KiIt is storage gain, e(i)It is corresponding error input under i time points, when k is for total sampling
Between count, u(k)It is the output of PI controls, is specifically current compensation front wheel angle;
Before the compensation front wheel angle that is exported with PI controllers of theoretical front wheel angle that preview control device is exported is reality after being added
Wheel corner, actual front wheel corner exports give agricultural machinery model in real time, controls the front wheel angle of agricultural machinery and makes agricultural machinery along the reality planned
Border avoidance path is walked, and realizes the automatic obstacle-avoiding of agricultural machinery.
Actual avoidance curvature of curve is emulated using matlab, such as Fig. 5 can be seen that actual avoidance curvature of curve and connect
It is continuous;Controlled for the PI proposed in the present invention using matlab softwares and preview control algorithm is emulated to setting curve, given
The original position for determining agricultural machinery is(-13,1), initial heading angle is 0rad, and Kp is taken as 2, Ki and is taken as 0.01;The horizontal stroke of Fig. 9~Figure 12
Coordinate is the operating range of agricultural machinery, it can be seen in figure 9 that aircraft pursuit course is essentially coincided with setting curve;Can from Figure 10
To find out, course deviation is probably in 0.08rad or so;It can be seen from fig. 11 that lateral deviation is in 10cm or so;From Figure 12
As can be seen that front wheel steering angle is 1 rank inertial element, without mutation, and actually it is consistent;Analyzed more than, use the present invention
In control method carry out the path clustering that turns around of agricultural machinery, control accuracy is high, curved path walking of the agricultural machinery substantially according to setting.
During present invention work, the environmental information around visual machine camera collection agricultural machinery confirms according to ambient condition information
Whether agricultural machinery enters avoidance, if detecting agricultural machinery front when having small barrier, agricultural machinery enters avoidance navigational state, and agricultural machinery is by passing
Sensor detection obtains the positional information of agricultural machinery, calculate agricultural machinery preceding object thing the size of characteristic circle, agricultural machinery and barrier away from
From plough tool width and agricultural machinery min. turning radius according to agricultural machinery determine the size of characteristic circle to set safe distance, using changing
The theoretical avoidance path of most chopped collimation method setting entered, but because the curvature in theoretical avoidance path is discontinuous, make agricultural machinery avoidance
Control accuracy reduction, using the new actual avoidance path of Bezier curve optimization method optimum theory avoidance coordinates measurement, passes through
Preview control device obtains theoretical front wheel angle, rotation before the control error output compensation that PI controller compensation preview controls device is produced
Angle, obtains actual front wheel corner and exports front wheel angle to agriculture after theoretical front wheel steering angle is added with expected compensation steering angle
Positional information is simultaneously sent to preview control device and PI controllers by machine model, position sensor real-time detection agricultural machinery position,
By the curved path walking for controlling the front wheel angle of agricultural machinery to make agricultural machinery along setting, so that agricultural machinery gets around barrier automatically;This hair
The bright most chopped collimation method by after improvement calculates a theoretical avoidance path, uses the path optimization side based on Bezier curve
Method is optimized to theoretical avoidance path, avoidance path is more prone to control, by preview control device and the knot of PI controllers
The front wheel steering angle for closing control agricultural machinery makes agricultural machinery along the avoidance curved path walking for setting, and control accuracy is high;Can be applied to nobody
The agricultural machinery of driving is avoided in the work of small barrier automatically in farm work.
The invention is not limited in above-described embodiment, on the basis of technical scheme disclosed by the invention, the skill of this area
Art personnel are according to disclosed technology contents, it is not necessary to which performing creative labour just can make one to some of which technical characteristic
A little to replace and deform, these are replaced and deformation all falls in the scope of protection of the present invention.
Claims (9)
1. it is a kind of to be used for the unpiloted obstacle-avoiding route planning of agricultural machinery and its control method, it is characterised in that agricultural machinery gets around automatically
Barrier is concretely comprised the following steps,
Step 1:Agricultural machinery environmental information is obtained by sensor and makes avoidance decision-making;
Step 2:Go out a theoretical avoidance path using improved most chopped collimation method off-line calculation;
Step 3:Kept away using the theoretical avoidance path in the method for optimizing route Optimization Steps 2 based on Bezier curve is actual
Barrier path, gets up to control the front wheel angle of agricultural machinery agricultural machinery is walked along actual avoidance path using taking aim in advance with PI controller combinations
Get around barrier.
2. according to claim 1 for the unpiloted obstacle-avoiding route planning of agricultural machinery and its control method, its feature exists
In, in step 2, calculate theoretical avoidance path and be in particular, calculate size, agricultural machinery and the barrier of the characteristic circle of agricultural machinery preceding object thing
Hinder the distance of thing, the size setting safe distance according to characteristic circle, plough tool width and agricultural machinery min. turning radius according to agricultural machinery,
The theoretical avoidance path of setting one.
3. according to claim 2 for the unpiloted obstacle-avoiding route planning of agricultural machinery and its control method, its feature exists
In in step 2, most chopped collimation method is specifically to do characteristic circle by the center of circle of the center of barrier, and the radius of characteristic circle is rmin+
W/2, theoretical avoidance path is made up of arc section one, straightway one, arc section two, straightway two and arc section three, arc section one
One end straight line path original with agricultural machinery it is tangent, the other end of arc section one is tangent with one end of straightway one, straightway one
The other end and straightway two one end it is tangent with arc section two respectively, the other end of straightway two is tangent with arc section three, circle
Segmental arc two be characterized circle on one section, the center line of arc section one and arc section three on arc section two is symmetrical arranged, agricultural machinery according to
It is secondary by arc section one, straightway one, arc section two, straightway two and the cut-through thing of arc section three, wherein, rminIt is agricultural machinery
Min. turning radius, w is the working width of agricultural machinery, and the circumradius of barrier is less than min. turning radius.
4. according to claim 3 for the unpiloted obstacle-avoiding route planning of agricultural machinery and its control method, its feature exists
In the radius of the arc section one is rmin, the radius of the arc section three is rmin, the starting point of arc section one is designated as H points, circular arc
The center of circle of section one is designated as O1Point, straightway one is designated as J, straightway one and arc section with the joining of the original straight line path of agricultural machinery
Two points of tangency is designated as D, and agricultural machinery original path is designated as K and K ', JK=w/2, the circle of arc section two respectively with the joining of characteristic circle
The heart is designated as O points, and the coordinate of O is set to(A, b), the central point of arc section two is designated as B points, and the coordinate of J points is designated as(X1, y1), JD's
Equation can be write as:
(1-1);
The equation of characteristic circle can be write as:
(1-2)
Pass through(1-1)With(1-2)K can be obtained, D points are the joining of JD and characteristic circle, and D point coordinates is solved with this;
Set up an office O1Coordinate be(x2,y2), then point O1Distance to straight line JD is:
According to formula(1-3)With(1-4)Obtain O1Coordinate;Then the coordinate of H points is(x2, y1), the coordinate of B points is(A, b+r).
5. according to claim 4 for the unpiloted obstacle-avoiding route planning of agricultural machinery and its control method, its feature exists
In in step 3, using the theoretical avoidance path in the method for optimizing route Optimization Steps 2 based on Bezier curve, specifically
For, Bezier equations are set up,
(1) n+1, the space position vector of point is given, then the interpolation formula of each point coordinates is on parameter curve:
(2-1)
WhereinThe characteristic point of the curve is constituted,It is n Bernstein basic function:
(2-2)
By above-mentioned formula, it can be deduced that the mathematic(al) representation of three times and quadratic bezier curve, as n=3, Q (t) is more than three times
Item formula, there is four control points, and its matrix form is expressed as:
(2-3)
Work as n=2, Q (t) is quadratic polynomial, there are three control points, and matrix expression is:
(2-4)
(2)The curvature expression formula of Bezier curve is:
(2-5)
Wherein, y=f(x)The equation of curve is represented, y ' is the first derivative of curve, y " it is second dervative;
Radius of curvature is:
(2-6).
6. according to claim 5 for the unpiloted obstacle-avoiding route planning of agricultural machinery and its control method, its feature exists
In selection three bezier curve, for three bezier curve:
(2-7)
(2-8)
Wherein, X0, X1, X2, X3 are respectively the lateral coordinates at P0 points, P1 points, P2 points and P3 points, and Y0, Y1, Y2 and Y3 are respectively
Longitudinal coordinate at P0 points, P1 points, P2 points and P3;
The starting point H of P0 points correspondence arc section one(x2, y1), the central point B of P3 points correspondence arc section two(A, b+r), P1 points((x2+
a)/ 2, y1), P2 points((x2+a)/ 2, b+r), then the curvature radius calculation formula of the corresponding curve in physical fault path be:
(2-9).
7. according to claim 6 for the unpiloted obstacle-avoiding route planning of agricultural machinery and its control method, its feature exists
In, in step 3, theoretical front wheel angle is calculated using preview control device, be specifically the forward sight for determining agricultural machinery apart from l, take road
On footpath is a little to take aim at a little in advance(x0, y0), R is radius of the forward sight apart from corresponding arc section, and the relational expression between l, R and x is:
(3-1)
Agricultural machinery is reduced to cart, the kinematics model of agricultural machinery is set up:
(3-2)
According to Ackermann steering geometrical relationship, the radius of turn and front wheel angle of agricultural machinery, the relational expression of wheelbase are:
(3-3)
Will(3-2)With(3-3)Combine and obtain the computing formula of theoretical corner and be:
(3-4)
Wherein, θ is the course deviation angle of agricultural machinery, and agricultural machinery rear shaft center is designated as point A, agricultural machinery rear shaft center A and pre- point P lines of taking aim at are remembered
It is AP, course deviation angle is the angle between agricultural machinery course and AP, and δ is the theoretical front wheel angle of agricultural machinery, and L is the wheelbase of agricultural machinery, v
It is the travel speed of agricultural machinery, the point nearest apart from agricultural machinery center is M on the curved path of setting.
8. according to claim 7 for the unpiloted obstacle-avoiding route planning of agricultural machinery and its control method, its feature exists
In, in step 3, compensation front wheel angle is calculated using PI control methods, specifically comprise the following steps:
(301)Position according to agricultural machinery and the course deviation angle θ of the agricultural machinery for a little obtaining is taken aim in advance be input into e as the error of PI(k);
(302)Calculate current score accumulation error;
(303)PI controlled outputs compensate front wheel angle, and the computing formula for compensating front wheel angle is:
(4)
Wherein, KpIt is proportional gain, KiIt is storage gain, e(i)Corresponding error input under i time points, k is total sampling time point
Number, u(k)It is the output of PI controls, is specifically current compensation front wheel angle;
Before the compensation front wheel angle that is exported with PI controllers of theoretical front wheel angle that preview control device is exported is reality after being added
Wheel corner, actual front wheel corner exports give agricultural machinery model in real time, controls the front wheel angle of agricultural machinery to realize agricultural machinery automatic obstacle-avoiding.
9. according to any one of claim 1~8 for the unpiloted obstacle-avoiding route planning of agricultural machinery and its control method,
Characterized in that, the sensor includes position sensor, angular transducer and machine vision camera, the angular transducer inspection
The steering angle of agricultural machinery is surveyed, the position sensor obtains the positional information of agricultural machinery;The visual machine camera is provided with 2 and difference
The front and rear side of agricultural machinery is arranged on, visual machine camera obtains the geography information of agricultural machinery local environment.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710046310 | 2017-01-22 | ||
CN2017100463100 | 2017-01-22 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106681335A true CN106681335A (en) | 2017-05-17 |
Family
ID=58828739
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710156019.9A Pending CN106681335A (en) | 2017-01-22 | 2017-03-16 | Obstacle-avoiding route planning and control method for unmanned agricultural machine driving |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106681335A (en) |
Cited By (31)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107422731A (en) * | 2017-06-19 | 2017-12-01 | 中国烟草总公司广东省公司 | The arable land control method and control system of agricultural intelligent Agricultural land system |
CN107703945A (en) * | 2017-10-30 | 2018-02-16 | 洛阳中科龙网创新科技有限公司 | A kind of intelligent farm machinery paths planning method of multiple targets fusion |
CN107702720A (en) * | 2017-10-11 | 2018-02-16 | 北京耘华科技有限公司 | A kind of agricultural machinery cultivation leading line modification method and system |
CN107817790A (en) * | 2017-09-05 | 2018-03-20 | 百度在线网络技术(北京)有限公司 | A kind of method and apparatus for the curvature for calculating track of vehicle |
CN107817798A (en) * | 2017-10-30 | 2018-03-20 | 洛阳中科龙网创新科技有限公司 | A kind of farm machinery barrier-avoiding method based on deep learning system |
CN108415413A (en) * | 2018-03-28 | 2018-08-17 | 华南农业大学 | A kind of intelligent forklift part obstacle-avoiding route planning method based on round region of interest |
CN108415435A (en) * | 2018-04-04 | 2018-08-17 | 上海华测导航技术股份有限公司 | A kind of agricultural machinery circular curve automatic Pilot control method |
CN108490943A (en) * | 2018-04-04 | 2018-09-04 | 上海华测导航技术股份有限公司 | A kind of adaptive curve automatic Pilot control method of agricultural machinery |
CN108549371A (en) * | 2018-03-28 | 2018-09-18 | 安徽农业大学 | A kind of high-clearance equipment for plant protection path following method and system |
CN108780320A (en) * | 2018-06-15 | 2018-11-09 | 深圳前海达闼云端智能科技有限公司 | Robot motion control method and device, storage medium and robot |
WO2019010659A1 (en) * | 2017-07-13 | 2019-01-17 | Beijing Didi Infinity Technology And Development Co., Ltd. | Systems and methods for trajectory determination |
CN109270933A (en) * | 2018-10-11 | 2019-01-25 | 中国科学院深圳先进技术研究院 | Unmanned barrier-avoiding method, device, equipment and medium based on conic section |
CN109283923A (en) * | 2018-07-02 | 2019-01-29 | 清博(昆山)智能科技有限公司 | A kind of modeling of tractor self-steering system |
CN109839930A (en) * | 2019-01-16 | 2019-06-04 | 江苏理工学院 | A kind of obstacle avoidance apparatus, system and method |
CN110109451A (en) * | 2019-04-10 | 2019-08-09 | 东南大学 | A kind of novel geometry path tracking algorithm considering path curvatures |
CN110320917A (en) * | 2019-07-24 | 2019-10-11 | 北京智行者科技有限公司 | Unmanned vehicle bend tracking control method |
CN110333740A (en) * | 2019-06-10 | 2019-10-15 | 中联重科股份有限公司 | The automatic installation method of engineering machinery, device, system and engineering machinery |
CN110398979A (en) * | 2019-06-25 | 2019-11-01 | 天津大学 | A kind of unmanned engineer operation equipment tracking method and device that view-based access control model is merged with posture |
CN110865642A (en) * | 2019-11-06 | 2020-03-06 | 天津大学 | Path planning method based on mobile robot |
CN111026114A (en) * | 2019-12-12 | 2020-04-17 | 南京苏美达智能技术有限公司 | Obstacle detouring method and self-walking equipment |
CN111077890A (en) * | 2019-12-27 | 2020-04-28 | 湘潭大学 | Implementation method of agricultural robot based on GPS positioning and automatic obstacle avoidance |
CN111256719A (en) * | 2020-02-18 | 2020-06-09 | 北京九曜智能科技有限公司 | Obstacle detouring method and device |
CN111513626A (en) * | 2020-06-30 | 2020-08-11 | 北京欣奕华数字科技有限公司 | Obstacle avoidance method of mobile equipment and mobile equipment |
CN112526988A (en) * | 2020-10-30 | 2021-03-19 | 西安交通大学 | Autonomous mobile robot and path navigation and path planning method and system thereof |
CN112758109A (en) * | 2021-04-09 | 2021-05-07 | 北京主线科技有限公司 | Transverse tracking steady state deviation compensation method and device |
CN113039501A (en) * | 2018-11-29 | 2021-06-25 | 株式会社久保田 | Automatic travel control system, automatic travel control program, recording medium containing automatic travel control program, automatic travel control method, control device, control program, recording medium containing control program, and control method |
CN113235682A (en) * | 2021-05-21 | 2021-08-10 | 潍柴动力股份有限公司 | Bulldozer control method, device, equipment, storage medium and product |
US11155264B2 (en) | 2018-12-18 | 2021-10-26 | Beijing Voyager Technology Co., Ltd. | Systems and methods for determining driving action in autonomous driving |
CN113844535A (en) * | 2021-09-29 | 2021-12-28 | 安徽江淮汽车集团股份有限公司 | Active steering control method based on steering wheel torque |
WO2022252869A1 (en) * | 2021-06-02 | 2022-12-08 | 北京迈格威科技有限公司 | Obstacle bypassing method for mobile device, and mobile device and storage medium |
WO2023024539A1 (en) * | 2021-08-24 | 2023-03-02 | 珠海格力电器股份有限公司 | Path navigation planning method and apparatus, storage medium, and electronic device |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1795986A2 (en) * | 2005-12-08 | 2007-06-13 | CLAAS Selbstfahrende Erntemaschinen GmbH | Route planning system for agricultural work machines |
US20080195270A1 (en) * | 2004-06-03 | 2008-08-14 | Norbert Diekhans | Route planning system and method for agricultural working machines |
CN102167038A (en) * | 2010-12-03 | 2011-08-31 | 北京农业信息技术研究中心 | Method and device for generating all-region-covering optimal working path for farmland plot |
CN102207736A (en) * | 2010-03-31 | 2011-10-05 | 中国科学院自动化研究所 | Robot path planning method and apparatus thereof based on Bezier curve |
KR20120098152A (en) * | 2011-02-28 | 2012-09-05 | 한국과학기술연구원 | Path planning system for mobile robot |
CN104516350A (en) * | 2013-09-26 | 2015-04-15 | 沈阳工业大学 | Mobile robot path planning method in complex environment |
CN105700533A (en) * | 2016-04-22 | 2016-06-22 | 扬州大学 | Agricultural machinery automatic driving control system based on Beidou navigation and method thereof |
CN106598070A (en) * | 2016-12-14 | 2017-04-26 | 东北农业大学 | Obstacle avoiding methods for agricultural plant protection unmanned aerial vehicles under multiple obstacles and small obstacles in spraying process and unmanned aerial vehicle |
-
2017
- 2017-03-16 CN CN201710156019.9A patent/CN106681335A/en active Pending
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080195270A1 (en) * | 2004-06-03 | 2008-08-14 | Norbert Diekhans | Route planning system and method for agricultural working machines |
EP1795986A2 (en) * | 2005-12-08 | 2007-06-13 | CLAAS Selbstfahrende Erntemaschinen GmbH | Route planning system for agricultural work machines |
CN102207736A (en) * | 2010-03-31 | 2011-10-05 | 中国科学院自动化研究所 | Robot path planning method and apparatus thereof based on Bezier curve |
CN102167038A (en) * | 2010-12-03 | 2011-08-31 | 北京农业信息技术研究中心 | Method and device for generating all-region-covering optimal working path for farmland plot |
KR20120098152A (en) * | 2011-02-28 | 2012-09-05 | 한국과학기술연구원 | Path planning system for mobile robot |
CN104516350A (en) * | 2013-09-26 | 2015-04-15 | 沈阳工业大学 | Mobile robot path planning method in complex environment |
CN105700533A (en) * | 2016-04-22 | 2016-06-22 | 扬州大学 | Agricultural machinery automatic driving control system based on Beidou navigation and method thereof |
CN106598070A (en) * | 2016-12-14 | 2017-04-26 | 东北农业大学 | Obstacle avoiding methods for agricultural plant protection unmanned aerial vehicles under multiple obstacles and small obstacles in spraying process and unmanned aerial vehicle |
Non-Patent Citations (4)
Title |
---|
刘向锋: "面向GPS导航拖拉机的最优全局覆盖路径规划研究", 《万方学位论文》 * |
昝杰等: "基于Bezier曲线的自主移动机器人最优路径规划", 《兰州大学学报(自然科学版)》 * |
温朋举: "改进纯追踪模型的农机地头转向控制方法", 《技术与市场》 * |
赵珊等: "农业机器人避障算法的研究", 《农机化研究》 * |
Cited By (41)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107422731A (en) * | 2017-06-19 | 2017-12-01 | 中国烟草总公司广东省公司 | The arable land control method and control system of agricultural intelligent Agricultural land system |
WO2019010659A1 (en) * | 2017-07-13 | 2019-01-17 | Beijing Didi Infinity Technology And Development Co., Ltd. | Systems and methods for trajectory determination |
US10809731B2 (en) | 2017-07-13 | 2020-10-20 | Beijing Voyager Technology Co., Ltd. | Systems and methods for trajectory determination |
CN107817790A (en) * | 2017-09-05 | 2018-03-20 | 百度在线网络技术(北京)有限公司 | A kind of method and apparatus for the curvature for calculating track of vehicle |
CN107702720A (en) * | 2017-10-11 | 2018-02-16 | 北京耘华科技有限公司 | A kind of agricultural machinery cultivation leading line modification method and system |
CN107702720B (en) * | 2017-10-11 | 2019-11-29 | 北京耘华科技有限公司 | A kind of agricultural machinery cultivation leading line modification method and system |
CN107703945A (en) * | 2017-10-30 | 2018-02-16 | 洛阳中科龙网创新科技有限公司 | A kind of intelligent farm machinery paths planning method of multiple targets fusion |
CN107817798A (en) * | 2017-10-30 | 2018-03-20 | 洛阳中科龙网创新科技有限公司 | A kind of farm machinery barrier-avoiding method based on deep learning system |
CN108415413A (en) * | 2018-03-28 | 2018-08-17 | 华南农业大学 | A kind of intelligent forklift part obstacle-avoiding route planning method based on round region of interest |
CN108549371A (en) * | 2018-03-28 | 2018-09-18 | 安徽农业大学 | A kind of high-clearance equipment for plant protection path following method and system |
CN108415413B (en) * | 2018-03-28 | 2021-03-30 | 华南农业大学 | Intelligent forklift local obstacle avoidance path planning method based on circular useful domain |
CN108490943B (en) * | 2018-04-04 | 2021-08-31 | 上海华测导航技术股份有限公司 | Agricultural machine adaptive curve automatic driving control method |
CN108415435B (en) * | 2018-04-04 | 2021-08-31 | 上海华测导航技术股份有限公司 | Automatic driving control method for circular curve of agricultural machine |
CN108490943A (en) * | 2018-04-04 | 2018-09-04 | 上海华测导航技术股份有限公司 | A kind of adaptive curve automatic Pilot control method of agricultural machinery |
CN108415435A (en) * | 2018-04-04 | 2018-08-17 | 上海华测导航技术股份有限公司 | A kind of agricultural machinery circular curve automatic Pilot control method |
CN108780320A (en) * | 2018-06-15 | 2018-11-09 | 深圳前海达闼云端智能科技有限公司 | Robot motion control method and device, storage medium and robot |
CN109283923A (en) * | 2018-07-02 | 2019-01-29 | 清博(昆山)智能科技有限公司 | A kind of modeling of tractor self-steering system |
CN109270933A (en) * | 2018-10-11 | 2019-01-25 | 中国科学院深圳先进技术研究院 | Unmanned barrier-avoiding method, device, equipment and medium based on conic section |
CN113039501A (en) * | 2018-11-29 | 2021-06-25 | 株式会社久保田 | Automatic travel control system, automatic travel control program, recording medium containing automatic travel control program, automatic travel control method, control device, control program, recording medium containing control program, and control method |
US11155264B2 (en) | 2018-12-18 | 2021-10-26 | Beijing Voyager Technology Co., Ltd. | Systems and methods for determining driving action in autonomous driving |
CN109839930A (en) * | 2019-01-16 | 2019-06-04 | 江苏理工学院 | A kind of obstacle avoidance apparatus, system and method |
CN110109451A (en) * | 2019-04-10 | 2019-08-09 | 东南大学 | A kind of novel geometry path tracking algorithm considering path curvatures |
CN110109451B (en) * | 2019-04-10 | 2022-07-12 | 东南大学 | Novel geometric path tracking algorithm considering path curvature |
CN110333740B (en) * | 2019-06-10 | 2020-10-27 | 中联重科股份有限公司 | Automatic positioning method, device and system for engineering machinery and engineering machinery |
CN110333740A (en) * | 2019-06-10 | 2019-10-15 | 中联重科股份有限公司 | The automatic installation method of engineering machinery, device, system and engineering machinery |
CN110398979B (en) * | 2019-06-25 | 2022-03-04 | 天津大学 | Unmanned engineering operation equipment tracking method and device based on vision and attitude fusion |
CN110398979A (en) * | 2019-06-25 | 2019-11-01 | 天津大学 | A kind of unmanned engineer operation equipment tracking method and device that view-based access control model is merged with posture |
CN110320917B (en) * | 2019-07-24 | 2022-09-02 | 北京智行者科技有限公司 | Unmanned vehicle curve tracking control method |
CN110320917A (en) * | 2019-07-24 | 2019-10-11 | 北京智行者科技有限公司 | Unmanned vehicle bend tracking control method |
CN110865642A (en) * | 2019-11-06 | 2020-03-06 | 天津大学 | Path planning method based on mobile robot |
CN111026114A (en) * | 2019-12-12 | 2020-04-17 | 南京苏美达智能技术有限公司 | Obstacle detouring method and self-walking equipment |
CN111077890A (en) * | 2019-12-27 | 2020-04-28 | 湘潭大学 | Implementation method of agricultural robot based on GPS positioning and automatic obstacle avoidance |
CN111256719A (en) * | 2020-02-18 | 2020-06-09 | 北京九曜智能科技有限公司 | Obstacle detouring method and device |
CN111513626A (en) * | 2020-06-30 | 2020-08-11 | 北京欣奕华数字科技有限公司 | Obstacle avoidance method of mobile equipment and mobile equipment |
CN112526988A (en) * | 2020-10-30 | 2021-03-19 | 西安交通大学 | Autonomous mobile robot and path navigation and path planning method and system thereof |
CN112758109B (en) * | 2021-04-09 | 2021-07-27 | 北京主线科技有限公司 | Transverse tracking steady state deviation compensation method and device |
CN112758109A (en) * | 2021-04-09 | 2021-05-07 | 北京主线科技有限公司 | Transverse tracking steady state deviation compensation method and device |
CN113235682A (en) * | 2021-05-21 | 2021-08-10 | 潍柴动力股份有限公司 | Bulldozer control method, device, equipment, storage medium and product |
WO2022252869A1 (en) * | 2021-06-02 | 2022-12-08 | 北京迈格威科技有限公司 | Obstacle bypassing method for mobile device, and mobile device and storage medium |
WO2023024539A1 (en) * | 2021-08-24 | 2023-03-02 | 珠海格力电器股份有限公司 | Path navigation planning method and apparatus, storage medium, and electronic device |
CN113844535A (en) * | 2021-09-29 | 2021-12-28 | 安徽江淮汽车集团股份有限公司 | Active steering control method based on steering wheel torque |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106681335A (en) | Obstacle-avoiding route planning and control method for unmanned agricultural machine driving | |
CN106909144A (en) | For the unpiloted field obstacle-avoiding route planning of agricultural machinery and its control method | |
Sabelhaus et al. | Using continuous-curvature paths to generate feasible headland turn manoeuvres | |
CN106909151A (en) | For the unpiloted path planning of agricultural machinery and its control method | |
CN106909150A (en) | For the unpiloted avoidance of agricultural machinery, turn around path planning and its control method | |
Noguchi et al. | Development of a master–slave robot system for farm operations | |
CN108955688B (en) | Method and system for positioning double-wheel differential mobile robot | |
CN105867377A (en) | Automatic navigation control method of agricultural machine | |
CN106647770A (en) | Field turning path planning and control method used for farm machinery driverless driving | |
CN109508007A (en) | A kind of agricultural machinery track following, obstacle avoidance system and method based on Multi-source Information Fusion | |
Jeon et al. | Design and validation testing of a complete paddy field-coverage path planner for a fully autonomous tillage tractor | |
CN108168560B (en) | Composite navigation control method for omnidirectional AGV | |
CN106020197B (en) | A kind of robot path track algorithm based on potential energy field | |
CN113341728A (en) | Anti-noise type return-to-zero neural network four-wheel mobile mechanical arm trajectory tracking control method | |
CN111610523A (en) | Parameter correction method for wheeled mobile robot | |
CN110320906A (en) | A kind of 4 wheel driven AGV trolley differential straight-line travelling attitude adjusting method based on Mecanum wheel | |
Wen et al. | Mecanum wheels with Astar algorithm and fuzzy PID algorithm based on genetic algorithm | |
Fu et al. | Collision-free and kinematically feasible path planning along a reference path for autonomous vehicle | |
CN112650217B (en) | Robot trajectory tracking strategy dynamic optimization method based on evaluation function | |
Bi et al. | CURE: A Hierarchical Framework for Multi-Robot Autonomous Exploration Inspired by Centroids of Unknown Regions | |
Amokrane et al. | Active disturbance rejection control for unmanned tracked vehicles in leader–follower scenarios: Discrete-time implementation and field test validation | |
CN116225004A (en) | Obstacle avoidance method for six-wheel independent driving independent steering robot | |
Zheng et al. | Vision-based autonomous vehicle control using the two-point visual driver control model | |
Mac et al. | A novel hedge algebra formation control for mobile robots | |
Fnadi et al. | Local obstacle-skirting path planning for a fast bi-steerable rover using bézier curves |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170517 |