Professional Documents
Culture Documents
Applsci 09 02666 PDF
Applsci 09 02666 PDF
Applsci 09 02666 PDF
sciences
Article
Automatic Steering Control Algorithm Based on
Compound Fuzzy PID for Rice Transplanter
Junnan Yin, Dequan Zhu *, Juan Liao * , Guangyue Zhu, Yao Wang and Shun Zhang
College of Engineering, Anhui Agricultural University, Hefei 230036, China
* Correspondence: zhudequan@ahau.edu.cn (D.Z.); liaojuan@ahau.edu.cn (J.L.); Tel.: +86-139-5609-4571 (D.Z.);
+86-177-5510-8602 (J.L.)
Received: 24 May 2019; Accepted: 27 June 2019; Published: 30 June 2019
Abstract: In order to realize automatic steering controls of rice transplanters in paddy fields, an
automatic steering control algorithm is essential. In this study, combining the fuzzy control with the
proportional-integral-derivative (PID) control and the kinematics model, a compound fuzzy PID
controller was proposed to adjust the real time data of the PID parameters for the automatic steering
control. The Kubota SPU-68C rice transplanter was then modified with the new controller. Next,
an automatic steering control experimental with the modified transplanter was carried out under
two conditions of linear tracking and headland turning in verifying the automatic steering effect of
the transplanter in different steering angle situations. The results showed that the deviation with
the new controller and the modified transplanter was acceptable, with maximum deviation in linear
tracking of 7.5 cm, the maximum headland turning a deviation of 11.5 cm, and the average a deviation
of less than 5 cm. In conclusion, within the allowable deviation range of the field operation of the
rice transplanter, the proposed algorithm successfully realized automatic steering controls of the
transplanter under different steering angles.
Keywords: rice transplanter; automatic steering; pure pursuit model; compound fuzzy PID
1. Introduction
With the development of computers, automatic control, intelligent agricultural equipment
technologies, and automatic navigation technology has received increased attention in the field of
intelligent agricultural machinery [1,2]. The automatic steering control system in navigation is a key
step in providing support for subsequent navigation control [3,4]. Many different control methods
have been developed for the automatic control system, including the pure pursuit model [5–8],
the proportional-integral-derivative (PID) control [9,10], the fuzzy control [11–13], and the neural
network [14–17]. Among these, the pure pursuit model is the most commonly used approach for the
automatic control. The main aim of the pure pursuit model was to establish a dynamic model which
considers the steering angle as the control variable [18,19]. When accurate mathematical models are
not available, another option is to design a controller based on the PID control, the fuzzy control, and
the neural network to realize automatic steering controls for agricultural machines.
In order to improve the automatic operation level and realize automatic steering controls for rice
transplanters, much research has been done. Nagasaka et al. [20] developed an automatic steering
method for a rice transplanter, which includes path tracking and steering with a fixed front wheel
angle. This method occupies small headland space; however, it needs to be reversed when headland
turning. However, the steering control was complicated and the work efficiency was low. To simplify
the steering control structure, a new ground steering control algorithm, based on the Kubota SPU-60
rice transplanter, was proposed [21]. This algorithm applies a two-wheeler model to dynamically
plan a steering path and adjust the reverse stance, which is without position feedback and reverse
Figure
Figure 1.1. Automatic
Automatic steering
steering control
control experimental
experimental platform. (1) Navigation
platform. (1) controller; (2)
Navigation controller; (2) reference
reference
station; (3) base station antenna; (4) automatic steering system; (5) steering servo motor;
station; (3) base station antenna; (4) automatic steering system; (5) steering servo motor; (6) (6) antenna of
antenna
the movable
of the movable station; (7) (7)
station; steering angle
steering sensor
angle of the
sensor front
of the wheel.
front wheel.
The Beidou high-precision differential positioning system consists of a base station and a mobile
station. The base station includes one receiver, one measurement antenna, and one radio
Appl. Sci. 2019, 9, 2666 3 of 14
The Beidou high-precision differential positioning system consists of a base station and a
Appl. Sci. 2019,
mobile 9, x FOR
station. ThePEER REVIEW
base station includes one receiver, one measurement antenna, and one 3radio
of 14
communication module. The mobile station contains one receiver, two measurement antennas, and
communication module. The mobile station contains one receiver, two measurement antennas, and
one radio communication module. The base station provides a reference coordinate signal to the
one radio communication module. The base station provides a reference coordinate signal to the
mobile station through the radio communication module. The navigation controller was composed of a
mobile station through the radio communication module. The navigation controller was composed
host computer PC (personal computer) and a lower computer STM32 (Stmicroelectronics 32-bit series)
of a host computer PC (personal computer) and a lower computer STM32 (Stmicroelectronics 32-bit
single chip development board. The compound fuzzy PID automatic steering algorithm was stored in
series) single chip development board. The compound fuzzy PID automatic steering algorithm was
the host computer, and the lower computer was connected with the automatic steering system and a
stored in the host computer, and the lower computer was connected with the automatic steering
wheel angle measuring sensor. The navigation controller makes processing decisions according to the
system and a wheel angle measuring sensor. The navigation controller makes processing decisions
position and angle information outputted by the Beidou positioning system and the front wheel angle
according to the position and angle information outputted by the Beidou positioning system and the
sensor. The compound fuzzy PID controller sent a control signal to the automatic steering system in
front wheel angle sensor. The compound fuzzy PID controller sent a control signal to the automatic
realizing the automatic steering of the rice transplanter. The automatic steering system was a modified
steering system in realizing the automatic steering of the rice transplanter. The automatic steering
automatic steering actuator, as shown in Figure 2. The servo motor and the gear pair are mounted on
system was a modified automatic steering actuator, as shown in Figure 2. The servo motor and the
the modified automatic steering actuator on the rice transplanter to drive the original steering wheel
gear pair are mounted on the modified automatic steering actuator on the rice transplanter to drive
shaft. The perform structure can realize the coexistence of a manual and automatic operation and has
the original steering wheel shaft. The perform structure can realize the coexistence of a manual and
the characteristics of a compact structure, high transmission efficiency, low installation cost, and fast
automatic operation and has the characteristics of a compact structure, high transmission efficiency,
response speed. The main parameters of the navigation hardware for the experimental platform are
low installation cost, and fast response speed. The main parameters of the navigation hardware for
shown in Table 1.
the experimental platform are shown in Table 1.
Figure Actuator of
2. Actuator
Figure 2. of the
the automatic
automatic steering
steering system.
system. (1)
(1) Steering
Steering wheel
wheel of
of the
the transplanter;
transplanter; (2)
(2) steering
steering
axle
axle gear;
gear; (3)
(3) output
output axle
axle gear;
gear; (4)
(4) reducer;
reducer; (5)
(5) servo
servo motor;
motor; (6)
(6) motor
motor bracket;
bracket; (7)
(7) absolute
absolute encoder.
encoder.
Table 1. Parameters of the navigation hardware for the experimental platform.
Table 1. Parameters of the navigation hardware for the experimental platform.
Name Component Type Number Parameter
Name Component Type Number Parameter
Positioning receiver C201 2
Beidou high-precision ±2 cm, ±0.5◦
Beidoupositioning
differential high- system Positioning receiver
Measuring antenna C201 2 3
(precision)
Radio communication module 2 ±2cm, ±0.5°
precision differential Measuring antenna 3
Navigation controller
Host computer PC 1 (precision)
positioning system Radio communication module
Lower computer STM32 2 1
microcontroller
Host computer PC 1
Servo motor RE50 1 30 Nm (Torque)
Navigation controller Lower Reducer
computer STM32 GP52C 1 i = 1/91
Automatic steering system Driver EPOS2 70/10 1 1 (transmission ratio)
microcontroller i = 1/2
Gear pair 1
Servo motor RE50 1 30(transmission
Nm (Torque) ratio)
Front wheel angle Rongwei ◦
0 ~360 ◦
Reducer
Absolute encoder GP52C 1 1 i = 1/91 (transmission
Automatic steering
measuring sensor Technology (working range)
Driver EPOS2 70/10 1 ratio)
system
i = 1/2 (transmission
Gear pair 1
ratio)
Front wheel angle Rongwei 0°~360° (working
Absolute encoder 1
measuring sensor Technology range)
Appl. Sci. 2019, 9, 2666 4 of 14
Figure
Figure 3.
3. The
The pure
pure pursuit
pursuit model
model of
of the
the transplanter.
transplanter.
In Figure 3, X–O–Y is
In is the
the geodetic
geodetic coordinate
coordinate system,system, and andYYVV–O–OVV–XVV is is the
the rice
rice transplanter
transplanter
coordinate system. XVVand andYYVVcorrespond
correspondtotothe theabscissa
abscissaaxis axisandandordinate
ordinateaxis,
axis,respectively.
respectively. The The red
red
line indicates the kinematic
kinematic model
model of oftwo-wheeler
two-wheelerofofthe therice
ricetransplanter,
transplanter,and and point
pointGG is is
thethecenter
centerof
gravity
of gravityof of
thethe
two-wheeler
two-wheeler model.
model.The Thedotted
dottedlinelineisisthethepredefined
predefined driving
driving path,path, and the starting
point is
point is at
atpoint
pointG. G.ρρisisthe
theturning
turningcurvature
curvature ofofthethericerice transplanter;
transplanter; ρ >ρ0 > is 0the
is curvature
the curvature of the ofrice
the
rice transplanter
transplanter whenwhen turningturning counterclockwise,
counterclockwise, and ρand < 0 isρ<the0 is the curvature
curvature of the of ricethe rice transplanter
transplanter when
when turning
turning clockwise.
clockwise. R is theR isinstantaneous
the instantaneous turningturning radius
radius of the
of the rice
rice transplanter.ddisisthe
transplanter. the lateral
lateral
deviation of
deviation of the
the actual position of the rice transplanter from the desired path; d <
actual position < 00 means
means that the
actual position is is on
on the
the left
leftof
ofthe
thedesired path,d d>>00denotes
desiredpath, denotesthat thatthe
theactual
actualposition
position is is
onon thetheright of
right
the desired path. L is the look-ahead distance of the rice transplanter in the
of the desired path.d Ld is the look-ahead distance of the rice transplanter in the pure pursuit model, pure pursuit model, in
which
in whichthethe
distance
distancecan can
be regarded
be regardedas theasempirical
the empirical value obtained by imitating
value obtained the manual
by imitating driving
the manual
driving θ is the θ
method.method. heading deviation
is the heading betweenbetween
deviation the current the position of the rice
current position of transplanter and the path
the rice transplanter and
to the
the pathtarget
to theposition. M is the M
target position. center
is theofcenter
the riceof transplanter moving moving
the rice transplanter along the curve
along theofcurve
the turning
of the
arc. Φ isarc.
turning theΦ heading change angle
is the heading changeofangle
the rice transplanter
of the when rotating
rice transplanter around around
when rotating the center, the M, and
center,
M, and reaching
reaching the target the target position
position along thealong thearc.
turning L is the
turning arc. L is the wheelbase
wheelbase between the between
wheels the beforewheels
and
before
after ofand
the after of the rice transplanter.
rice transplanter.
In accordance with the geometric relationship relationship shown shown in in Figure
Figure3,3,thethecoordinates
coordinates(X (XVQ VQ,, Y
YVQ
VQ)) of
1 1
YVQY= = sin ΦΦ
sin (2)
(2)
VQ ρ
ρ
In the right triangle ΔPOVQ, the look-ahead distance and the coordinate value of the target point
Q (XVQ, YVQ) satisfy the following relation:
Appl. Sci. 2019, 9, 2666 5 of 14
In the right triangle ∆POV Q, the look-ahead distance and the coordinate value of the target point
Q (XVQ , YVQ ) satisfy the following relation:
2 2
XVQ + YVQ = L2d (3)
According to Equations (1)–(3), the curvature ρ of the rice transplanter was calculated as follows:
XVQ
ρ = −2 (4)
Ld
Automatic steering is aimed at obtaining the desired rotation angle of the front wheel because
of the rice transplanter with front wheel steering. Based on the pure pursuit model in Figure 3, the
desired rotation angle and turning radius of the front wheel of the rice transplanter satisfy the following
relationship:
δ = arctan(Lρ) (5)
where L denotes the front and rear wheelbase of the rice transplanter and δ indicates the desired angle
of the front wheel.
According to the geometric relationship shown in Figure 3, Equation (1) could be rewritten as:
q
XVQ = −d cos θ + L2d − d2 sin θ (6)
Combining with Equations (5) and (7), the desired rotation angle of the front wheel of the rice
transplanter in the pure pursuit model could be calculated as follows:
q
2L d cos θ − L2d − d2 sin θ
δ = arctan (8)
Ld
e > 10◦ , the fuzzy controller was used to quickly adjust the deviation; when e ≤ 10◦ , the compound
Appl.
fuzzy Sci.PID
2019,controller
9, x FOR PEER
wasREVIEW
used to precisely adjust the front wheel angle [27]. 6 of 14
de ec Control
Pose dt signal 1
information Pure Fuzzy controller
δ e
pursuit
model e >10°
Look-ahead Automatic
distance Servo
ΔKp ΔKi ΔKd steering
motor
actuator
Control
e ≤10° signal 2
PID controller
Feedback
Principlediagram
Figure4.4.Principle
Figure diagramofofcompound
compoundfuzzy
fuzzyproportional-integral-derivative
proportional-integral-derivative(PID)
(PID)controller.
controller.
As shown in Figure 4, the front wheel angle deviation e and the deviation change rate ec were
As shown in Figure 4, the front wheel angle deviation e and the deviation change rate ec were
taken as inputs of the compound fuzzy PID controller. The PID parameters ∆Kp , ∆K , and ∆K are
taken as inputs of the compound fuzzy PID controller. The PID parameters ΔKp, ΔKii, and ΔKdd are
outputs of the controller. The PID parameters were adaptively adjusted online by the fuzzy inference
outputs of the controller. The PID parameters were adaptively adjusted online by the fuzzy inference
method, which can meet different requirements of the different deviation e and the deviation change
method, which can meet different requirements of the different deviation e and the deviation change
rate ec, so that the controlled object achieves the quantitative dynamic and static performance.
rate ec, so that the controlled object achieves the quantitative dynamic and static performance.
According to the compound fuzzy PID control principle, the compound fuzzy PID controller
According to the compound fuzzy PID control principle, the compound fuzzy PID controller
could be defined as follows:
could be defined as follows:
k
ek (k) + Kd0 (k) + ∆Kd (k) × [e(k) − e(k − 1)]
P
u(k) = Kp0 (k) + ∆Kp (k) × e(k) + Ki0 (k) + ∆Ki (k) ×
( ) ( ) (
u(k) = Kp0 (k) +ΔKp (k) ×e(k) + Ki0 (k) +ΔKi (k)n=×0e(k) + Kd0 (k) +ΔKd (k) ×[ e(k) −e(k −1)]
n=0
) (9)
(9)
where Kp0 , K , and Kd0 are the initial set values of the PID parameters and ∆Kp , ∆Ki , and ∆Kd are the
where Kp0, Ki0i0
, and Kd0 are the initial set values of the PID parameters and ΔKp, ΔKi, and ΔKd are the
three outputs of the compound fuzzy PID controller.
three outputs of the compound fuzzy PID controller.
3.2. Control Variable Fuzzification and Membership Function
3.2. Control Variable Fuzzification and Membership Function
As mentioned above, the front wheel angle deviation e and the deviation change rate ec are inputs,
As mentioned ∆K above, the front wheel angle deviation e and the deviation change rate ec are
and the parameters p , ∆Ki , and ∆Kd are outputs. In this study, the conventional PID parameters were
inputs, and by
determined theanparameters
experimental ΔKtrial
p, ΔKi, and ΔKd are outputs. In this study, the conventional PID
and error method. Through closed-loop operation or simulation,
parameters were determined
the response curve of the system was by an observed,
experimental trialparameters
and the and errorweremethod. Through
repeatedly closed-loop
tested, according
operation or simulation, the response curve of the system was observed,
to the influence of each parameter on the system. The PID control parameters were determined and the parameters were
repeatedly tested, according to the influence of each parameter on the system.
until a satisfactory response occurred, which were set as the initial parameters, Kp0 , Ki0 , and Kd0 , The PID control
parameters
of the compound were determined until a satisfactory
fuzzy PID controller. response
The appropriate occurred,
fuzzy domain which wereselected,
was then set as the initial
based on
parameters, K p0, Ki0, and Kd0, of the compound fuzzy PID controller. The appropriate fuzzy domain
the parameters, and the parameters ∆Kp , ∆Ki , and ∆Kd of the compound fuzzy PID control were
was then selected,
determined by thebasedfuzzyoncontroller
the parameters, and the
in real time. parameters
Based on the ΔK p, ΔKi, and ΔKd of the compound
fuzzy control theory, the input and
fuzzy PID control were determined
output variables were fuzzified as follows [27]:by the fuzzy controller in real time. Based on the fuzzy control
theory, the input and output variables were fuzzified as follows [27]:
• Front wheel angle deviation e. The basic domain is: [−30◦ , 30◦ ], the quantification domain is: {−6,
•−4, −2,
Front0, 2,wheel
4, 6} =angle
{NB,deviation
NM, NS, ZO, e. The
PS,basic
PM, domain
PB}, andis:
the[−30°, 30°], the factor
quantization quantification
is: 6/30 =domain
0.2;
is: {−6, −4, −2, 0, 2, 4, 6} = {NB, NM, NS, ZO, PS, PM, PB}, and the quantization factor is: 6/30
• Steering angle deviation change rate ec. The basic domain is: [−6, 6], the quantification domain is:
= 0.2;
{−6, −4, −2, 0, 2, 4, 6} = {NB, NM, NS, ZO, PS, PM, PB}, and the quantization factor is: 6/6 = 1;
• Steering angle deviation change rate ec. The basic domain is: [−6, 6], the quantification
• Proportional parameter ∆Kp . The basic domain is: [−10, 10], the quantification domain is: {−3, −2,
domain is: {−6, −4, −2, 0, 2, 4, 6} = {NB, NM, NS, ZO, PS, PM, PB}, and the quantization factor
−1, 0, 1, 2, 3} = {NB, NM, NS, ZO, PS, PM, PB}, and the quantization factor is: 3/10 = 0.3;
is: 6/6 = 1;
• Integration parameter ∆Ki . The basic domain is: [−8, 8], the quantification domain is: {−3, −2, −1,
• Proportional parameter ΔKp. The basic domain is: [−10, 10], the quantification domain is:
0, 1, 2, 3} = {NB, NM, NS, ZO, PS, PM, PB}, and the quantization factor is: 3/8 = 0.375;
{−3, −2, −1, 0, 1, 2, 3} = {NB, NM, NS, ZO, PS, PM, PB}, and the quantization factor is: 3/10 =
0.3;
• Integration parameter ΔKi. The basic domain is: [−8, 8], the quantification domain is: {−3, −2,
−1, 0, 1, 2, 3} = {NB, NM, NS, ZO, PS, PM, PB}, and the quantization factor is: 3/8 = 0.375;
Appl. Sci. 2019, 9, 2666 7 of 14
Appl. Sci. 2019, 9, x FOR PEER REVIEW 7 of 14
• Differential parameter ∆Kd . The basic domain is: [−6, 6], the quantification domain is: {−3, −2, −1,
• Differential parameter ΔKd. The basic domain is: [−6, 6], the quantification domain is: {−3,
0, 1, 2, 3} = {NB, NM, NS, ZO, PS, PM, PB}, and the quantization factor is: 3/6 = 0.5;
−2, −1, 0, 1, 2, 3} = {NB, NM, NS, ZO, PS, PM, PB}, and the quantization factor is: 3/6 = 0.5;
With
With thethehigh
high sensitivity
sensitivity of triangular
of triangular membership
membership function,function,
they werethey wereas selected
selected as the
the membership
membership
function function
of the of the input
input variables, variables,
including including
e and ec andethe
andoutput
ec and variables
the output∆Kvariables ΔKp,∆K
p , ∆Ki , and ΔKd .i, The
and
ΔKd. Themembership
triangle triangle membership functions corresponding
functions corresponding toand
to the input the output
input and outputare
variables variables
shown inareFigure
shown 5.
in Figure 5.
(a) (b)
Figure 5.
Figure 5. Input
Input and output variable
and output variable membership
membership function:
function: (a)
(a) Membership
Membership function
function of
of the input
the input
variables e, ec; (b)
variables (b) membership
membership function
function of
of the
the output variables ∆K
output variables ∆Kii,, and
ΔKpp,, ΔK ∆Kd.d .
and ΔK
ec
∆Ki
NB NM NS ZO PS PM PB
NB NB NB NM NM NS ZO ZO
NM NB NB NM NS NS ZO ZO
NS NB NM NS NS ZO PS PS
e ZO NM NM NS ZO PS PM PM
PS NM NS ZO PS PS PM PB
PM ZO ZO PS PS PM PB PB
PB ZO ZO PS PM PM PB PB
ec
∆Kd
NB NM NS ZO PS PM PB
NB PS NS NB NB NB NM PS
NM PS NS NB NM NM NS ZO
NS ZO NS NM NM NS NS ZO
e ZO ZO NS NS NS NS NS ZO
PS ZO ZO ZO ZO ZO ZO ZO
PM PB NS PS PS PS PS PB
PB PB PM PM PM PS PS PB
According to the compound fuzzy PID control rule established above in Tables 2–4, the dynamic
tunings of ∆Kp , ∆Ki , and ∆Kd were obtained. The proportional, integral, and differential parameters of
the PID controller, Kp , Ki , and Kd , could then be calculated by the following Equation (10):
Kp = Kp0 + ∆Kp
Ki = Ki0 + ∆Ki (10)
Kd = Kd0 + ∆Kd
where Kp0 , Ki0 , and Kd0 are the initial set values of the PID parameters.
4. Simulation Analysis
To verify the feasibility of the compound fuzzy PID automatic steering control algorithm, the
simulation model of automatic steering control for the rice transplanter was established in MATLAB.
The simulation model is shown in the Figure 6. In the simulation process, the front wheel rotation
angle deviation e = 10◦ was set as the demarcation point, and the simulation analysis was performed
when e = 8◦ and e = 25◦ [27], so that the compound fuzzy PID controller could adjust the parameters
∆Kp , ∆Ki , and ∆Kd in real-time. The step signal response curves of the front wheel rotation angle
deviation of 8◦ and 25◦ are as shown in Figure 7, respectively.
Appl. Sci. 2019, 9, 2666 9 of 14
Appl. Sci. 2019, 9, x FOR PEER REVIEW 9 of 14
Appl. Sci. 2019, 9, x FOR PEER REVIEW 9 of 14
Figure 6.
6. Compound fuzzy
fuzzy PID control
control simulation diagram.
diagram.
Figure 6. Compound
Figure Compound fuzzy PID
PID control simulation
simulation diagram.
(a)
(a) (b)
(b)
Figure 7.
7. Step signal
signal response curve:
curve: (a) Simulation
Simulation curve at
at 8°;
◦ (b) simulation
simulation curve at
at 25°.
◦
Figure 7. Step
Figure Step signalresponse
response curve: (a)
(a) Simulation curve
curve at88°;; (b)
(b) simulation curve
curve at 25
25°..
The simulation
The simulation analysiswhen when thefrontfront wheelrotation
rotation angle deviation ◦ 8°
e isee 8is 25◦25°
and is shown
The simulationanalysis
analysis whenthe the frontwheel wheel rotation angle
angle deviation
deviation and
is 8° and is shown
25° in
is shown
in Table
Table 5.
5. When
in Table
When
5. When
the
thethe front
front wheel
wheel
front wheel
rotation
rotation
rotation
angle
angle
angle
deviation
deviation
deviatione=e = ◦
25°,
e =2525°,
the
, the response
theresponse
responsetime
time
timeof
of the
ofthe
compound
thecompound
compound
fuzzy PID
fuzzy PID control
control was
was reduced
reduced by by 0.23
0.23 s compared
compared with with the traditional
traditional PID control,
control, and and the overshoot
overshoot
fuzzy PID control was reduced by 0.23 s compared with the traditional PID control, and the overshoot
was reduced
was reducedfromfrom3.5 ◦ to
3.5° to1.6
1.6°. When ee = 8°,
◦ . When 8 ◦ , the
the response
response time
time was reduced by 0.14 s and the maximum maximum
was reduced from 3.5° to 1.6°. When e = 8°, the response time was reduced by 0.14 s and the maximum
overshootwas
overshoot was reducedfrom from 0.4° ◦ to 0.2 ◦ It is noted that the compound fuzzy PID controller can speed
0.2°. speed
overshoot wasreducedreduced from0.4 0.4°to
to 0.2°.. It is noted that the compound fuzzy PID controller controller can speed
up the
up the response
response speedspeed ofof the
the system,
system, reduce
reduce the the overshoot,
overshoot, and
and quickly
quickly reach
reach aa steady
steady state,
state, and
and the
the
up the response speed of the system, reduce the overshoot, and quickly reach a steady state, and the
control
control effect is better.
controleffect
effectisisbetter.
better.
Table 5. Performance
Table 5. Performance comparison
comparison of
of control
control algorithms.
algorithms.
Table 5. Performance comparison of control algorithms.
e e Controller
Controller Response Process
Response ProcessOvershoot
OvershootResponse
Response Time Stable Time
Time Stable Time
e Controller Response Process Overshoot Response Time Stable Time
Compound
Compound fuzzyfuzzy
PID PID StrictStrict monotony
monotony 0.2 ◦ 0.2° 0.34
0.34 s s 0.52
0.52 s
8◦ 8° Compound fuzzy PID Strict monotony ◦
0.2° 0.34 s 0.52ss
8° Traditional PID
Traditional PID Attenuation oscillation
Attenuation oscillation 0.4 0.4° 0.48 s
0.48 s 1.05 s
1.05 s
Traditional PID Attenuation oscillation 0.4° 0.48 s 1.05 s
Compound
Compound fuzzyfuzzy
PID PID SlightSlight
shock shock 1.6 ◦ 1.6° 0.45
0.45 s s 0.94
0.94 ss
◦
25 25° Compound fuzzy PID Slight shock ◦ 1.6° 0.45 s 0.94 s
25° Traditional PID PID Attenuation
Traditional oscillation
Attenuation oscillation3.5 3.5° 0.68 s s
0.68 1.85
1.85ss
Traditional PID Attenuation oscillation 3.5° 0.68 s 1.85 s
(a)
(b)
(c)
Figure 10.
Figure 10. Straight tracking
Straight results:
tracking (a) Straight
results: track;track;
(a) Straight (b) lateral
(b) deviation curve; (c)curve;
lateral deviation heading
(c)deviation
heading
curve.
deviation curve.
In the
In the field
fieldheadland
headlandturning
turningexperiment,
experiment,the theturning
turningradius
radius ofof
thethe transplanter
transplanter waswassetset to 1.20
to 1.20 m.
m. Figure
Figure 11 shows
11 shows the headland
the headland turningturning curve.
curve. The The transplanter
transplanter automatically
automatically turned inturned in the
the headland
headland
of the paddy of the paddy
field when field whentoit the
it drove drove endtopoints,
the endsuchpoints,
as Bsuch
1 , A2as B1, A
, and B23,,and B3, ofpredefined
of three three predefined
paths.
paths.
As shownAs shown
in Figurein Figure
11, the 11, the tracking
tracking curve fluctuated
curve fluctuated greatlygreatly when turning
when turning and tendedand tended to be
to be stable
stableheadland
after after headland
turning.turning.
During During
headland headland
turning, turning,
the lateral thedeviation
lateral deviation and thedeviation
and the heading heading
deviation fluctuated
fluctuated around 0 at around 0 at the maximum
the maximum of 11.5 cm ofand 5◦ ,cm
11.5 and 5°, respectively.
respectively. The average The average
lateral lateral
deviation
deviation
was 4 cm andwasthe4 cm and the
average average
heading headingwas
deviation ◦
deviation
2 . Most was 2°. Most
of the of thewere
deviations deviations
causedwere by thecaused
large
by the large
slippage of theslippage of the rice
rice transplanter transplanter
when turning atwhen turning at
the headland of the paddy
headland of According
field. the paddytofield. the
According
field to the field
experimental experimental
results, results,
the automatic the automatic
steering steeringwith
control system control system with
the proposed the proposed
algorithm has a
algorithm
high trackinghasaccuracy
a high tracking accuracy
and sufficient and sufficient
robustness to meet robustness to meet therequirements
the field performance field performance
of the
requirements
rice transplanter.of the rice transplanter.
Appl. Sci. 2019, 9, 2666 12 of 14
Appl. Sci. 2019, 9, x FOR PEER REVIEW 12 of 14
Figure11.
Figure 11. Tracking
Trackingcurve
curveof
ofthe
theheadland
headlandturning.
turning.
6.
6. Conclusions
Conclusion
In
Inthe
themanuscript,
manuscript, an anautomatic
automatic steering
steering control
control algorithm,
algorithm, based
based on on the
thecompound
compound fuzzy fuzzy PID
PID
control,
control,combining
combiningthe thefuzzy
fuzzy control,
control,thethe PID
PID control
control and
and the
the kinematics
kinematics model
model of a rice transplanter,
transplanter,
was
was proposed,
proposed, and a compound
compound fuzzy fuzzyPID PIDcontroller
controllerwas
wasdeveloped.
developed.This This controller
controller cancan adjust
adjust the
the
PIDPID control
control parameters
parameters in real-time
in real-time in the
in the fuzzyfuzzy domain,
domain, whichwhich
can can
make make the compound
the compound fuzzyfuzzy
PID
PID controller
controller output
output thethe bestbest controlvariables.
control variables.The
Theautomatic
automaticsteering
steering experimental
experimental platform was was
modified according to the compound fuzzy PID controller. Simulations and
modified according to the compound fuzzy PID controller. Simulations and field experiments were field experiments were
performed
performedtotoverify
verifythetheeffectiveness
effectiveness of the
of automatic steering
the automatic control
steering system.system.
control The experimental results
The experimental
showed that the that
results showed maximum lateral deviations
the maximum of the linear
lateral deviations of thetracking and headland
linear tracking turningturning
and headland were 7.5were
cm
and 11.5 cm, and the average lateral deviation was less than 5 cm; the maximum
7.5 cm and 11.5 cm, and the average lateral deviation was less than 5 cm; the maximum heading heading deviation
was 3◦ andwas
deviation 5◦ and the5°
3° and average
and theheading
averagedeviation was within
heading deviation was2◦ .within
Both the2°. lateral
Both the deviation and the
lateral deviation
heading deviation were within the allowable deviation range of field operation for
and the heading deviation were within the allowable deviation range of field operation for the rice the rice transplanter.
In conclusion,In
transplanter. theconclusion,
compoundthe fuzzy PID control-based
compound fuzzy PID automatic
control-basedsteering algorithm
automatic developed
steering algorithmin
this study can
developed realize
in this the can
study automatic
realizesteering controlsteering
the automatic of the transplanter
control of the at different
transplantersteering angles,
at different
effectively reduce
steering angles, the lateral
effectively deviation
reduce and deviation
the lateral heading deviation
and heading of the rice transplanter
deviation during the
of the rice transplanter
automatic
during thenavigation
automatic process,
navigation which is beneficial
process, which istobeneficial
improve to theimprove
control the
precision
controlofprecision
the automatic
of the
navigation, and can satisfy
automatic navigation, and thecanagronomic
satisfy therequirements of the field operation
agronomic requirements of the fieldof the rice transplanter.
operation of the rice
transplanter.
Author Contributions: Methodology, J.Y.; Data Curation J.Y., J.L. and Y.W.; Validation, J.Y., J.L. and Y.W.; Resources,
G.Z. and Contributions:
Author S.Z.; Writing—Original Draft Preparation,
Methodology, J.Y.; Data J.Y.; Writing—Review
Curation J.Y, J.L. andand Editing,
Y.W.; J.Y., J.L. J.Y,
Validation, and J.L.
D.Z.;and
Funding
Y.W.;
Acquisition, D.Z. and S.Z.; Writing–Original Draft Preparation, J.Y.; Writing–Review and Editing, J.Y, J.L. and
Resources, G.Z.
D.Z.; Funding
Funding: This Acquisition, D.Z.
work was supported by the National Key Research and Development Program of China (No.
2018YFD0700304), the Natural Science Fund of Anhui Province (No. 1708085QF148) and the Science Foundation
Funding:
of This work was
Anhui Agricultural supported
University (No.by the National Key Research and Development Program of China (No.
2016ZR008).
2018YFD0700304), the Natural Science Fund of Anhui Province (No. 1708085QF148) and the Science Foundation
Acknowledgments: This work was supported by the National Project on Transformation of Agricultural Scientific
of Anhui Agricultural University (No. 2016ZR008).
and Technological Achievements No. 2014C30000162.
Acknowledgments:
Conflicts Thisauthors
of Interest: The work was supported
declare by ofthe
no conflict National Project on Transformation of Agricultural
interest.
Scientific and Technological Achievements No. 2014C30000162.
References
Conflicts of Interest: The authors declare no conflict of interest.
1. Zhang, M.N.; Lu, X.L.; Tao, J.P.; Yin, W.Q.; Feng, X.B. Design and experiment of automatic guidance control
References
system in agricultural vehicle. Trans. Chin. Soc. Agric. Mach. 2016, 47, 42–47.
2.1. Ma, J.F.;M.N.;
Zhang, Wang,Lu,
D.C.; Tang,
X.L.; Tao, Y.W.; Zhao,
J.P.; Yin, J.B.Feng,
W.Q.; Automatic control
X.B. Design system
and of agricultural
experiment machinery
of automatic guidancebased on
control
Beidou navigation. In Proceedings of the IEEE 3rd Information Technology
system in agricultural vehicle. Trans. Chin. Soc. Agric. Mach. 2016, 47, 42–47. and Mechatronics Engineering
2. Conference (ITOEC),
Ma, J.F.; Wang, D.C.;Chongqing,
Tang, Y.W.;China, 3–5 October
Zhao, J.B.. Automatic2017; IEEE:system
control Piscataway, NJ, USA, machinery
of agricultural 2017; pp. 318–323.
based on
Beidou navigation. In Proceedings of the IEEE 3rd Information Technology and Mechatronics Engineering
Conference (ITOEC), Chongqing, China, 3–5 October 2017; IEEE: Piscataway, NJ, USA, 2017; pp. 318–323.
Appl. Sci. 2019, 9, 2666 13 of 14
3. Reid, J.F.; Zhang, Q.; Noguchi, N.; Dickson, M. Agricultural automatic guidance research in North America.
Comput. Electron. Agric. 2000, 25, 155–167. [CrossRef]
4. Torii, T. Research in autonomous agriculture vehicles in Japan. Comput. Electron. Agric. 2000, 25, 133–153.
[CrossRef]
5. Wang, X.C.; Lu, W.; Chen, M.; Wang, T.; Zhang, Y.; Boukangou, M.P. Automatic following system for
greenhouse harvesting transportation based on adaptive pure pursuit model. Trans. Chin. Soc. Agric. Mach.
2016, 47, 8–13.
6. Tang, X.T.; Tao, J.F.; Li, Z.T.; Li, Y.; Liu, C. Fuzzy control optimization method for stability of path tracking
system of automatic transplanter. Trans. Chin. Soc. Agric. Mach. 2018, 49, 29–34.
7. Elbanhawi, M.; Simic, M.; Jazar, R. Receding horizon lateral vehicle control for pure pursuit path tracking. J.
Vib. Control 2018, 24, 619–642. [CrossRef]
8. Quan, M.M.; Zhai, Y.; Jiang, Y.; Sun, Y.J.; Xu, D.L.; Gong, J.W. An Improved pure pursuit algorithm for
four-wheel-steering autonomous driving vehicle. Appl. Mech. Mater. 2014, 3006, 958–962. [CrossRef]
9. David, S.A.; de Sousa, R.V.; Valentim, C.A., Jr.; Tabile, R.A.; Machado, J.A.T. Fractional PID controller in an
active image stabilization system for mitigating vibration effects in agricultural tractors. Comput. Electron.
Agric. 2016, 131, 1–9. [CrossRef]
10. Wen, S.; Zhang, Q.Y.; Deng, J.Z.; Lan, Y.B.; Yin, X.C.; Shan, J. Design and experiment of a variable spray
system for unmanned aerial vehicles based on PID and PWM control. Appl. Sci. 2018, 8, 2482. [CrossRef]
11. Sujaritha, M.; Annadurai, S.; Satheeshkumar, J.; Sharan, S.K.; Mahesh, L. Weed detecting robot in sugarcane
fields using fuzzy real time classifier. Comput. Electron. Agric. 2017, 134, 160–171. [CrossRef]
12. Bonadies, S.; Smith, N.; Niewoehner, N.; Lee, A.S.; Lefcourt, A.M.; Gadsden, S.A. Development of
proportional–integral–derivative and fuzzy control strategies for navigation in agricultural environments. J.
Dyn. Syst. Meas. Control 2018, 140, 061007. [CrossRef]
13. Soares, F.T.; Cappelli, N.L.; Garcia, A.P.; Umezu, C.K. Fuzzy control applied to an electrical power generation
system mounted on tractors for driving of agricultural implements. Eng. Agric. 2016, 36, 846–857. [CrossRef]
14. Camci, E.; Kripalani, D.R.; Ma, L.; Kayacan, E.; Khanesar, M.A. An aerial robot for rice farm quality inspection
with type-2 fuzzy neural networks tuned by particle swarm optimization-sliding mode control hybrid
algorithm. Swarm Evol. Comput. 2018, 41, 1–8. [CrossRef]
15. Csillik, O.; Cherbini, J.; Johnson, R.; Lyons, A.; Kelly, M. Identification of citrus trees from unmanned aerial
vehicle imagery using convolutional neural networks. Drones 2018, 2, 39. [CrossRef]
16. Eski, İ.; Kuş, Z.A. Control of unmanned agricultural vehicles using neural network-based control system.
Neural Comput. Appl. 2019, 31, 583–595. [CrossRef]
17. Duau, J.; Zhang, L.; Zhang, Z.; Zhao, J.; Jiang, Y. Research on Automatic Steering System of Agricultural
Machinery Based on Fuzzy Neural Network. In Proceedings of the 2018 2nd IEEE Advanced Information
Management, Communicates, Electronic and Automation Control Conference (IMCEC), Xi’an, China, 25–27
May 2018; IEEE: Piscataway, NJ, USA, 2018; pp. 1602–1605.
18. García-Pérez, L.; García-Alegre, M.C.; Ribeiro, A.; Guinea, D. An agent of behavior architecture for unmanned
control of a farming vehicle. Comput. Electron. Agric. 2008, 60, 39–48. [CrossRef]
19. Remarka, M.; Griepentrog, H.W.; Nielsen, J.; Søgaard, H.T. The development and assessment of the accuracy
of an autonomous GPS-based system for intra-row mechanical weed control in row crops. Biosyst. Eng. 2008,
101, 396–410.
20. Nagasaka, Y.; Umeda, N.; Kanetai, Y.; Taniwaki, K.; Sasaki, Y. Autonomous guidance for rice transplanting
using global positioning and gyroscopes. Comput. Electron. Agric. 2004, 43, 223–234. [CrossRef]
21. Luo, X.W.; Zhang, Z.G.; Zhao, Z.X. The Method of Headland Turning in the Navigation Control for Wheeled
Agricultural Machinery Compilation of the 2007 Annual Conference of the Chinese Society of Agricultural Engineering;
South China Agricultural University: Guangzhou, China, 2007.
22. Xu, L.L. Development of Tractor Automatic Navigation System Controller. Master’s Thesis, China
Agricultural University, Beijing, China, 2011.
23. Wang, F.X. Automatic steering control system for wheeled agricultural machinery. Agric. Eng. 2018, 8, 36–38.
24. Qi, Z.J.; Yang, Z.G.; Huang, Y. Lane change track control for intelligent 4WS vehicle based on fuzzy adaptive
PID. Chin. J. Autom. Eng. 2012, 2, 379–384.
25. Xie, M.S.; Li, Y.N.; Zheng, L.; Pei, J.H. Synthesized feedback control of the ESP system based on fuzzy
technology. J. Chongqing Univ. (Nat. Sci. Ed.) 2007, 30, 1–5.
Appl. Sci. 2019, 9, 2666 14 of 14
26. Li, G.; Wang, Y.; Guo, L.F.; Tong, J.; He, Y. Improved pure pursuit algorithm for rice transplanter path tracking.
Trans. Chin. Soc. Agric. Mach. 2018, 49, 21–26.
27. Zhu, G.Y. Study on Automatic Steering Control System of High-Speed Rice Transplanter. Master’s Thesis,
Anhui Agricultural University, Hefei, China, 2018.
© 2019 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access
article distributed under the terms and conditions of the Creative Commons Attribution
(CC BY) license (http://creativecommons.org/licenses/by/4.0/).