Hostname: page-component-788cddb947-jbjwg Total loading time: 0 Render date: 2024-10-19T20:02:24.936Z Has data issue: false hasContentIssue false

Path tracking control method for automatic navigation rice transplanters based on VUFC and improved BAS algorithm

Published online by Cambridge University Press:  10 July 2023

Dequan Zhu*
Affiliation:
School of Engineering, Anhui Agricultural University, Hefei, P.R. China Anhui Province Engineering Laboratory of Intelligent Agricultural Machinery Equipment, Anhui Agricultural University, Hefei, China
Menghao Shi
Affiliation:
School of Engineering, Anhui Agricultural University, Hefei, P.R. China
Yang Wang
Affiliation:
School of Engineering, Anhui Agricultural University, Hefei, P.R. China
Kang Xue
Affiliation:
School of Engineering, Anhui Agricultural University, Hefei, P.R. China
Juan Liao
Affiliation:
School of Engineering, Anhui Agricultural University, Hefei, P.R. China
Wei Xiong
Affiliation:
School of Engineering, Anhui Agricultural University, Hefei, P.R. China
Fuming Kuang
Affiliation:
School of Engineering, Anhui Agricultural University, Hefei, P.R. China
Shun Zhang
Affiliation:
School of Engineering, Anhui Agricultural University, Hefei, P.R. China
*
Corresponding author: Dequan Zhu; Email: zhudequan@ahau.edu.cn
Rights & Permissions [Opens in a new window]

Abstract

During the operation of automatic navigation rice transplanter, the accuracy of path tracking is influenced by whether the transplanter can enter the stable state of linear path tracking quickly, thus affecting the operation quality and efficiency. To reduce the time to enter the path tracking stable state and improve the tracking accuracy and stability for the rice transplanter, path tracking control method based on variable universe fuzzy control (VUFC) and improved beetle antenna search (BAS) is proposed in this paper. VUFC is applied to achieve adaptive adjustment of the fuzzy universe by dynamically adjusting the quantization and scaling factors according to the variations of errors by the contraction–expansion factor. To solve the problem of setting the contraction–expansion factor in VUFC and real-time performance, an offline parameter optimization method is presented to calculate the optimal contraction–expansion factor by an iterative optimization algorithm in a path tracking simulation model, where the iterative optimization algorithm is the BAS algorithm improved by the isolated niching technique and adaptive step size strategy in this paper. To verify the effectiveness of the proposed path tracking control method, simulation and field linear path tracking experiments were carried out. Experimental results indicate that the proposed method reduces the time of entering the stable state of linear path tracking and improves the accuracy and stability of path tracking compared with the pure pursuit control method.

Type
Research Article
Copyright
© The Author(s), 2023. Published by Cambridge University Press

1. Introduction

With the development of precision agriculture, automatic navigation of agricultural machinery has been widely used in arming, sowing, fertilization, spraying, harvesting, and other agricultural production processes [Reference Hu, Gao and Bai1, Reference Ji and Zhou2]. Accurate acquisition of position information and lateral control method directly affect the performance of agricultural machinery automatic navigation [Reference Wang, Wang and Luo3]. Due to the complex paddy field environment and uneven pavement, the operation of automatically driving rice transplanter into the straight tracking state is frequent and difficult [Reference Zhang, Gai, Zhang, Tang, Liao and Ding4]. Therefore, to improve the operation quality and efficiency of the automatic navigation rice transplanter, it is necessary to optimize the rise time and overshoot of linear path in the path tracking control process of rice transplanter, as to meet the requirements of short time to enter the stable state of linear path tracking, high accuracy of path tracking, and strong resistance to interference in the complex paddy field environment.

Thus far, lots of studies on path tracking control methods for agricultural machinery navigation have been introduced. Most of them constructed corresponding path tracking control methods based on PID control, optimal control, pure tracking control, model predictive control (MPC) or fuzzy control, etc. [Reference De, Tabile, Inamasu and Porto5Reference Yin, Du, Geng and Jin8]. The PID control method can eliminate the navigation path tracking deviation, but the PID parameters are difficult to adjust; it requires a certain amount of experience and a large number of parameter tuning tests [Reference Luo, Zhang and Zhao9]. The optimal control method simplifies the controlled object as a linear time-invariant system, which can obtain high accuracy and stability with an accurate control model and no disturbance. However, the working environment of the transplanter is complex and changeable, and the performance of the optimal control method is greatly affected by external interference [Reference Chen, Niao and Zhu10]. The pure pursuit control (PPC) method realizes the path tracking control by simulating the geometric model of human driving behavior and combining the simplified two-wheel vehicle model. It is easy to realize and has fewer control parameters, but it is difficult to adjust the optimal look-ahead distance adaptively [Reference Huang, Zhang, Luo and Huang11, Reference Mehmet, Ehsan and Hasan12]. The MPC method achieves highly accurate control operations with moderate complexity and allows rolling optimization in a finite time domain to improve accuracy, but the method is difficult to reduce the algorithm computation time without compromising performance, resulting in poor real-time performance [Reference Ding, Wang, Li and Li13].

Most of the above path tracking control methods need to establish mathematical models, and the accuracy of mathematical models directly affects the accuracy of path tracking. However, due to the complex and changeable paddy environment, it is difficult to obtain an accurate mathematical model. Fuzzy control is to simulate human driving behavior by expert experience without a precise mathematical model, which is suitable for rice transplanter tracking control of rice transplanter operation in complex and changeable paddy field environment. But with the decrease of input deviation, the control precision of fuzzy control decreases [Reference Hamid and Subhash14Reference Meng, Qiu, He, Zhang, Ma and Liu16]. Therefore, variable universe fuzzy control (VUFC) is used to overcome the disadvantages of fuzzy control. In VUFC systems, the control accuracy is influenced by the suitability of the contraction–expansion factor.

To obtain the high control accuracy and improve the path tracking accuracy, a path tracking algorithm for rice transplanter based on VUFC and improved beetle antenna search (BAS) algorithm is proposed in this paper, in which VUFC can achieve adaptive adjustment of the fuzzy universe by dynamically adjusting the contraction–expansion factor, and thus improving the tracking accuracy and stability for the rice transplanter. In the optimal VUFC method, the offline database of contraction–expansion factor is output by an offline iterative optimization method. It calculates the optimal value of the parameter by iterative optimization in an offline simulation model which is a BAS algorithm improved by the isolated niching technique and adaptive step size strategy. The offline parameter optimization method based on BAS can avoid the low precision of path tracking due to the poor real-time performance of the algorithm.

2. Materials and methods

2.1. Automatic navigation rice transplanter platform

The Kubota SPU-68C rice transplanter is used as a test platform for navigation path tracking control, which is composed of a Beidou high-precision differential positioning system, a navigation controller, a steering control device, a vehicle attitude sensor, and a speed control device. The modified rice transplanter is shown in Fig. 1. The main parameters of the platform equipment are shown in Table I. The navigation control software is installed in the laptop. The data of the Beidou differential positioning system and inertial guidance system are obtained through the RS232 serial port. The data sampling frequency of the software is set to 5 Hz. The sensor signals are taken as input, and the desired front-wheel turning angle is output as a control signal which is sent to the steering control device to achieve automatic navigation path tracking.

Figure 1. Test platform for automatic navigation control of rice transplanter. 1. Host computer PC; 2. lower computer STM32; 3. base station; 4. steering control device; 5. speed control device; 6. mobile station antenna; 7. vehicle-angle measurement sensor.

Table I. Navigation hardware parameters of test platform.

2.2. Kinematic model of rice transplanter

The accuracy of lateral control during navigation path tracking is closely related to the dynamics of the machinery being studied [Reference Korayem, Nekoo and Kazemi17]. And factors such as the complexity of the actual environment and unpredictable external disturbances can have an impact on the actual results of path tracking [Reference Keymasi Khalaji18]. Hence, the dynamic analysis of automatic navigation machinery is often studied. Mirzaeinejad and Shafei [Reference Mirzaeinejad and Shafei19] showed in the research that modeling the dynamics of complex working environments is challenging due to the effect of dynamic coupling between the non-holonomic constraint system of the machine and the working environment. Rice is a semi-aquatic plant which is usually cultivated in shallowly flooded conditions. Because of water, the soil surface of a paddy field is uneven, wet, and muddy, which greatly aggravates the difficulty of dynamic analysis for rice transplanters. In view of the difficulty of dynamic analysis and estimation of non-holonomic constraints in complex environments, Shojaei et al. [Reference Shojaei, Shahri and Tarakameh20] used adaptive robust controllers to estimate the non-holonomic constraints of the upper uncertainty function caused by friction, disturbances, and unmolded dynamics. Considering the incomplete structure of the robot, Azizi and Keighobadi [Reference Azizi and Keighobadi21] build a discrete kinematic model of the machine. Therefore, the kinematic model of rice transplanter is built for the non-holonomic constraints. The rice transplanter is characterized by low speed and small-angle steering to adjust the driving path during operation. Assuming that the tires are rigid wheels and no lateral forces are generated with the ground, the simplified two-wheeled vehicle kinematic model proposed by Keely is used to build a path tracking simulation model, as shown in Fig. 2 ref. [Reference Keely22].

Figure 2. Schematic diagram of kinematic model of rice transplanter.

In Fig. 2, point A(x,y) is the rear wheel axis coordinates; L is the wheel distance between the front and rear axles; R is the turning radius; τ is the heading angle; v is the driving speed; and δ is the turning angle of the front wheels. The kinematic model is given by:

(1) $$\begin{equation}\dot{x}\!\left(t\right)=v\!\left(t\right)\cos \tau(t)\end{equation}$$
(2) $$\begin{equation}\dot{y}\!\left(t\right)=v\!\left(t\right)\sin \tau(t)\end{equation}$$
(3) \begin{equation}\dot{\tau }\!\left(t\right)=\frac{v\!\left(t\right)\tan \delta(t)}{L}\end{equation}

2.3. Basic principles of VUFC algorithm

The performance of fuzzy controller is positively related to the number of fuzzy control rules sets. In traditional fuzzy controllers, the more fuzzy rules there are, the more complex the fuzzy controller becomes, which is difficult to implement. However, fewer fuzzy rules lead to lower control accuracy. In the application of fuzzy controllers, the deviation becomes smaller over time and the number of fuzzy rules applied to becomes less, which leads to a decrease in control accuracy. In the VUFC method, without changing the fuzzy control rules, the universe of the input and output variables is extended and reduced accordingly with the change of the deviation by using the contraction–expansion factor, which is equivalent to adding the fuzzy control rules [Reference Liu, Li and Zang23, Reference Zheng, Chen and Quan24].

Assume that $X_{i}=[{-E_{i}},{+E_{i}}]_{(i=1,2,\ldots,n)}$ and $Y=[-U,+U]$ represent the fundamental universe of input variable x i (i = 1,2,…,n) and output variable y, respectively. $A=\{A_{ij}\} _{(1\leq j\leq m)}$ and $B=\{B_{j}\}_{(1\leq j\leq m)}$ represent the fuzzy partition on the fuzzy linguistic variables X i and Y, respectively. Fuzzy inference rules can be formed as follows:

If x 1 is $A_{1j}$ , and x 2 is $A_{2j}$ and… and x n is A nj then y is $B_{j}$

The variable universe means that the universes of X i and Y are varied with the variables x i and y. The relationships are as follows:

(4) \begin{equation}X_{i}\!\left(x_{i}\right)=\left[-\alpha _{i}\left(x_{i}\right)E_{i},+\alpha _{i}\!\left(x_{i}\right)E_{i}\right]\end{equation}
(5) \begin{equation}Y\!\left(y\right)=\left[-\beta \!\left(y\right)U,+\beta \!\left(y\right)U\right]\end{equation}

Figure 3. The variation of variable universes.

where $\alpha _{i}(x_{i})$ and $\beta (y)$ are the contraction–expansion factors of input universe and output universe, respectively. The variation of variable universes is shown in Fig. 3.

As all we known, in the variable domain fuzzy control method, the contraction–expansion factor is a parameter used to promote the domain of the input and output variables to expand accordingly with the change of error, which is equivalent to increasing the fuzzy control rule, thereby improving the accuracy of fuzzy control. Generally, the value range of contraction–expansion factor is set to from 0 to 1 to ensure that the value range of the fuzzy set is within a reasonable range and can be conveniently adjusted with other fuzzy control parameters. In order to ensure that the value range of the fuzzy set is within a reasonable range, the contraction–expansion factors $\alpha _{i}(x_{i})$ and $\beta (y)$ in this work are required to be even functions with the value range [0,1], satisfy the monotonic increasing when x > 0.

3. Path tracking control method based on VUFC + improved BAS algorithm

3.1. VUFC design

3.1.1. Fuzzification of input and output variables

The lateral deviation d and heading deviation θ of the transplanter are used as the input variables, and the desired front-wheel turning angle λ of the transplanter is used as the output variable. Specifying lateral deviation d is position when the transplanter is on the right side of the desired path and a negative one on the left side. The heading deviation θ is the angular deviation between the current heading of the transplanter and the desired path of the target point. The direction of the desired path is considered as the starting direction, and the heading deviation θ is defined as counterclockwise positive and clockwise negative.

  1. 1. Lateral deviation d. The basic universe is [−0.5 m, +0.5 m], the proportion level is {−6, −4, −2, 0, 2, 4, 6} = {NL, NM, NS, Z, PS, PM, PL}, and the quantization factor is set to12.

  2. 2. Heading deviation θ. The basic universe is: [−50°, +50°], the proportion level is {−6, −4, −2, 0, 2, 4, 6} = {NL, NM, NS, Z, PS, PM, PL}, and the quantization factor is set to 0.12.

  3. 3. The desired front-wheel turning angle λ. Universe domain is: [−40°, +40°]. The proportion level is {−6, −4, −2, 0, 2, 4, 6} = {NL, NM, NS, Z, PS, PM, PL}, and the scaling factor is set to 6.67.

where {NB, NM, NS, ZE, PS, PM, PB} denote {negative large, negative medium, negative small, zero, positive small, positive medium, positive large}, respectively. The Gaussian curve affiliation function is selected as the affiliation function curve of the above input and output variables, as shown in Fig. 4.

Figure 4. Gaussian curve affiliation function.

3.1.2. Establishment of fuzzy rules

The position relationship between the rice transplanter and the desired path is shown in Fig. 5. The fuzzy rule table is shown in Table II. The fuzzy rule surface is shown in Fig. 6.

Table II. Fuzzy control rules.

Figure 5. Position of rice transplanter about desired path.

Figure 6. Fuzzy regular surfaces.

The rules of fuzzy controller for the desired front-wheel turning angle of rice transplanters are as follows:

  1. 1. At conditions (a), (d), and (g), the transplanter is on the left side of the desired path, and the lateral deviation is negatively large (NL). Under conditions (a) and (d), the heading deviations are zero (Z) and positive large (PL), respectively, and the driving direction may be away from the desired path. Therefore, the wheels should turn to the right with a large amplitude, so the desired front-wheel turning angle is negative large (NL). Under condition (g), the heading deviation of the rice transplanter is NL, and the driving direction may be close to the desired path. Therefore, the wheels should turn to the left with a small range, so the desired front-wheel turning angle is positive small (PS).

  2. 2. At conditions (b), (e), and (h), the rice transplanter is on the desired path with zero (Z) lateral deviation. In condition (b), the transplanter heading deviation is zero (Z), and the driving direction of the transplanter does not need to be adjusted, so the desired front-wheel turning angle is zero (Z). Under conditions (e) and (h), the heading deviations of the rice transplanter are PL and NL, respectively, and the driving direction of the rice transplanter may tend to be away from the desired path. Under condition (e), the wheels should turn to the right with a larger range, so the desired front-wheel turning angle is NL. Under condition (h), the wheels should turn to the left with a larger range, so the desired front-wheel turning angle is PL.

  3. 3. At conditions (c), (i), and (f), the transplanter is on the right side of the desired path, and lateral deviation is PL. Under conditions (c) and (i), the heading deviation of the transplanter is zero (Z) and NL, respectively, and the direction of driving of the transplanter may tend to be away from the desired path, so the wheels should turn to the left with a large range, so the desired front-wheel turning angle is PL. Under the condition (f), the heading deviation of the rice transplanter is PL, and the driving direction tends to be close to the desired path, so the wheels should turn to the right with a small range and the desired front-wheel turning angle is negative small (NS).

3.2. The contraction–expansion factor determination method

Two forms of the contraction–expansion factor function are as follows [Reference Pang, Liu and Xu25]:

(6) \begin{equation}\alpha \!\left(x\right)=\left(|x| /E\right)^{\tau }+\varepsilon, \tau \gt 0,\end{equation}
(7) \begin{equation}\alpha \!\left(x\right)=1-{\unicode[Arial]{x03C9}} \exp \!\left(-kx^{2}\right), \omega \gt 0, k\gt 0.\end{equation}

where $\varepsilon$ is a sufficiently small positive number.

The contraction–expansion factor in VUFC is usually calculated by a function as in Eqs. (6) and (7). The performance of the VUFC system is influenced by the parameter setting in the functional form, and this parameter setting is not calculated by the formula. This parameter is usually used to derive suitable values using the matching method, but the optimal parameter values are not always derived [Reference Wang, Wei, Hu, Jang and Zhang26]. The contraction–expansion factor is also usually derived by the second-level fuzzy controller calculation, where the designed fuzzy rule base relies on expert experience [Reference Ma, Yu, Cao, Zhang and Zheng27, Reference Yao, Lu and Zheng28]. In this study, to solve the above problem of contraction–expansion factor calculation, the BAS algorithm is improved and used to output the optimal contraction–expansion factor.

Algorithm 1 IABAS algorithm

3.2.1. Principle of BAS algorithm

The BAS algorithm has the advantages of a simple optimization mechanism, convenient implementation, and a small amount of computation, in which a single individual can complete the optimization [Reference Jiang and Li29]. But the BAS has the problem that a single individual is easy to fall into local optimization, and the accuracy is also dependent on the parameter settings [Reference Fan, Shao, Sun and Shao30]. Therefore, we improve the performance of this algorithm from the following aspects:

  1. 1. The isolated niching technique is used to avoid getting trapped in a local optimum. The phenomenon of racial segregation resulting from the geographical isolation of nature is referenced as the isolated niche technique. Isolated niche technology is a technology that divides the initial population into multiple subpopulations, and each subpopulation evolves independently. The evolution speed and size of each subpopulation depend on the average adaptation level of each subpopulation [Reference Lin, Hao and Ji31].

  2. 2. The parameter setting problem of the BAS algorithm is solved by using an adaptive step size strategy. When updating, the strategy uses the optimal solution information in the subpopulation to induce the beetle to move to any position between them and the corresponding elite individuals, further improving the search accuracy.

The BAS algorithm based on isolated niche technique and adaptive step size strategy (IABAS) is presented in Algorithm 1. The basic steps are as follows:

Step 1: Set the search space [lb,ub], the number of beetle individuals n, the number of subpopulations k, and the number of iterations T, the dimensions of the variables d. p Individual beetle locations in the search space are generated by uniform distribution and the beetle population location matrix $\mathrm{X}=\left[\begin{smallmatrix} x_{11} & \cdots & x_{1d}\\ \vdots & \ddots & \vdots \\ x_{n1} & \cdots & x_{nd} \end{smallmatrix}\right]$ is recorded. The search space is divided into a fixed number of subspaces of k, and a subpopulation size matrix $Y=[\begin{array}{ccc} y_{1} & \cdots & y_{k} \end{array}]$ is generated. The matrix $F_{x}=[\begin{array}{ccc} f_{{x_{1}}} & \cdots & f_{{x_{n}}} \end{array}]^{T}$ of fitness values corresponding to each individual beetle position, the matrix $F_{s}=[\begin{array}{ccc} f_{{y_{1}}} & \cdots & f_{{y_{k}}} \end{array}]^{T}$ of average fitness in the subspace, the matrix $E=\left[\begin{smallmatrix} e_{11} & e_{12} & \cdots & e_{1d}\\ \vdots && \ddots & \vdots \\ e_{k1} & e_{k2} & \cdots & e_{kd} \end{smallmatrix}\right]$ of positions of the elite beetle with the highest fitness value in the subspace, and the fitness value $F_{E}=[\begin{array}{ccc} f_{{e_{1}}} & \cdots & f_{{e_{k}}} \end{array}]^{T}$ of the elite beetle are calculated.

Step 2: Save or update the location and corresponding fitness value of the elite beetle individuals with the highest fitness value in the subspace.

Step 3: When updating the position of each beetle, the distance to the elite beetle individuals in its subpopulation is first calculated. The distance equation for each dimension is as follows:

(8) \begin{equation}d_{o,p,u}^{t}=\left| e_{o,u}^{t}-x_{o,p,u}^{t}\right|\end{equation}

where $d_{o,p,u}^{t}$ is the uth dimensional position distance between the pth beetle individual and the elite beetle individual in the oth subspace at the tth iteration number. $e_{o,u}^{t}$ is the uth dimensional position of the elite beetle in the oth subspace at the tth number of iterations. $x_{o,p,u}^{t}$ is the uth dimensional position of the pth aspen beetle individual in the oth subspace at the tth number of iterations.

Step 4: The step adjustment factor is calculated using a nonlinear function M based on the number of iterations. The function is as follows:

(9) \begin{equation}\mathrm{M}=\left(1/t_{\max }\right)*\exp \!\left(-\left(\frac{t}{t_{\max }}\right)\right)\end{equation}

where $t_{\max }$ is the maximum number of iterations, and t is the current number of iterations. The formula for each dimensional step is as follows:

(10) \begin{equation}\text{step}_{o,p,u}^{t}=\left(1/t_{\max }\right)*\exp \!\left(-\left(\frac{\mathrm{t}}{t_{\max }}\right)\right)*d_{o,p,u}^{t}*\vec {b}\end{equation}

where $\text{step}_{o,p,u}^{t}$ is the uth dimensional step size of the pth beetle individual in the oth subspace at the tth number of iterations, and $\vec {b}$ is the direction of the randomly generated step. $\vec {b}$ is as follows:

(11) \begin{equation}\vec {b}=\frac{rnd\!\left(d,1\right)}{\left\| rnd\!\left(d,1\right)\right\| }\end{equation}

where $rnd(\cdot )$ is a random function and the resulting number is within [−1,+1], and d is the dimension of the variable.

Step 5: The coordinates of the spatial positions of the left and right antennae of the individual beetle are calculated. The spatial position coordinates are defined as:

(12) \begin{equation} \begin{cases} \boldsymbol{x}_{opl}^{t}=\boldsymbol{x}_{op}^{t}+\text{step}_{op}^{t}\\ \boldsymbol{x}_{opr}^{t}=\boldsymbol{x}_{op}^{t}-\text{step}_{op}^{t} \end{cases}\end{equation}

where $\boldsymbol{x}_{op}^{t}$ is the position of the pth beetle in the oth subspace under the tth iteration; $\text{step}_{op}^{t}$ is the antenna length of the pth beetle in the oth subspace under the condition of the tth iteration; and $\boldsymbol{x}_{opl}^{t}$ and $\boldsymbol{x}_{opr}^{t}$ are the left and right antenna positions of the pth beetle in the oth subspace under the tth iteration, respectively.

If the update position of the left and right antennas of the beetle antenna is outside the position range of the subspace where it is located, the out-of-range update position is cleared.

Step 6: Update the location of the next beetle movement. The formula is defined as:

(13) \begin{equation} \begin{cases} f_{x_{o,p}}^{t+1}=\min \!\left(f\!\left(x_{opl}^{t}\right),f\!\left(x_{opr}^{t}\right)\right)\\ x_{o,p}^{t+1}=\underset{x_{o,p}}{\arg \min }f_{x_{o,p}}^{t+1} \end{cases}\end{equation}

where $f(x_{opl}^{t})$ and $f(x_{opr}^{t})$ are the fitness values at the position of the pth antenna on the left and right side of the antenna in the oth subspace under the tth iteration, respectively. The above equation indicates that the antenna location with the better fitness value is directly selected as the new beetle location.

Step 7: After all beetle positions are updated, the average fitness value $F_{s}$ is calculated for each subspace. Its calculation formula is as follows:

(14) \begin{equation}f_{y_{o}}^{t}=\frac{\sum _{o=1}^{y_{k}^{t}}\,f_{x_{o}}^{t}}{y_{o}^{t}}\end{equation}

The size Y of each subspace at the next iteration is calculated based on the average fitness value $F_{s}$ . Its calculation formula is as follows:

(15) \begin{equation}y_{o}^{t+1}=n\cdot \frac{f_{y_{o}}^{t}}{\sum _{o=1}^{K}\,f_{y_{o}}^{t}}\end{equation}

where $y_{o}^{t+1}$ is the size of the oth subspace at the t + 1th number of iterations, and $f_{y_{o}}^{t}$ is the average fitness value of the other subspace at the tth number of iterations.

Step 8: The number of iterations is updated, and after all the iterations are completed or the termination loop condition is reached, the location information of the optimal fitness value is found in the subspace elite individuals and returned.

3.2.2. Design of fitness function

The search accuracy and convergence speed of the algorithm are directly affected by the selection of the fitness function. In the field of control, time multiplied by integral time absolute error (ITAE) or root mean square error is often used as an indicator to evaluate the performance of control systems. The sum of the ITAE of the obtained lateral deviations and heading deviations is used as a performance index function, which is defined in Eq. (16).

(16) \begin{equation}f=\varphi \int _{0}^{\infty }t| x(t)| dt+(1-\varphi )\int _{0}^{\infty }t| y(t)|dt\end{equation}

where x(t) is the lateral deviation at time t; y(t) is the heading deviation at time t; and $\varphi$ is the weight of the ITAE index of lateral deviation in the fitness function.

To improve the reliability of the algorithm, Eq. (16) is simplified as follows:

(17) \begin{equation}f=\varphi T\sum _{j=0}^{k}t\!\left| x(j)\right| +(1-\varphi )T\sum _{j=0}^{k}t\!\left| y(j)\right|\end{equation}
\begin{equation*} t=kT,k=0,1,2,3\ldots \end{equation*}

where T is the system operation period; and k is the number of system calculations.

In the BAS algorithm, the smaller the fitness value, the better the system performance [Reference Li, Serra, Olivier and Fei32]. Hence, the inverse of the performance index function is used as the fitness function as shown in Eq. (18).

(18) \begin{equation}F=\frac{1}{f}\end{equation}

3.2.3. Performance comparison test of IABAS algorithm

To validate the optimization-seeking accuracy of the IABAS algorithm, three benchmark test functions of CEC were selected to test the performance of the IABAS algorithm compared with the BAS algorithm. The expressions formula, dimensions, search ranges, and theoretical optimal value of the used benchmark test functions are shown in Table III.

Table III. The benchmark test function.

The IABAS algorithm sets the number of individual beetles to 30, the number of subpopulations to 3, and the number of iterations is set to 500. The BAS algorithm parameters are the same as the above settings. The results are shown in Table IV. The results show that the solution accuracy of the IABAS algorithm is higher than that of the BAS algorithm, and it has good stability and robustness.

Table IV. Results of performance comparison tests.

3.2.4. Offline optimization of the contraction–expansion factor

Offline parameter optimization methods usually do not require real-time processing of data streams and only use the offline method to search parameters comprehensively to find the best parameter combination, which can reduce the running time of path tracking algorithm, so as to avoid the low precision of path tracking due to the poor real-time performance of the algorithm. Hence, to improve the real-time performance of the path tracking control method, an offline parameter optimization method is used to reduce the running time of the algorithm. The problem of low path tracking accuracy caused by the poor real-time performance of the algorithm can be avoided by the offline parameter optimization method. In the initialization of the IABAS algorithm, the search space [lb, ub] is set to [0, 1], the search dimension d is 2, the number of aspen individuals n is 30, the number of subspaces k is 3, and the number of iterations is 200. The contraction–expansion factor is required to satisfy the property of parity. Therefore, the condition combination of lateral deviation [−0.5 m, +0.5 m] and heading deviation [−50°, +50°] is limited to lateral deviation [0, +0.5 m] and heading deviation [0, 50°]. Multiple combinations of conditions are set under the range of lateral deviation and heading deviation. Offline optimization of parameters is performed afterwards. The basic process of the method for offline optimization of parameters is shown in Fig. 7. Finally, according to the principle of parity, the obtained contraction–expansion factors $\alpha$ and $\beta$ are extended to the whole lateral deviation and heading deviation, and a base of offline contraction–expansion factors is established. The results of the contraction–expansion factors $\alpha$ and $\beta$ are shown in Figs. 8 and 9. From Figs. 8 to 9, it can be found that the contraction–expansion factors $\alpha$ and $\beta$ are real values ranging from 0 to 1, which meet the definition of contraction–expansion factor in variable domain fuzzy control and satisfy the requirements of zero avoidance, monotonicity, coordination, and regularity. The combination of contraction–expansion factors increases gradually when the lateral deviation and heading deviation conditions gradually increase, which ensures the fuzzy domain of the fuzzy control system increases with the increase of contraction–expansion factors, and thus improving the control performance.

Figure 7. The basic process of the method for offline optimization of parameters.

Figure 8. The optimal contraction–expansion factor $\alpha$ .

Figure 9. The optimal contraction–expansion factor $\beta$ .

3.3. Structure of the proposed path tracking control method

In summary, a block diagram of path tracking control is shown in Fig. 10. The current position information of the transplanter is obtained by Beidou high-precision differential positioning system. The relative position information is calculated by comparing the current path information with the desired position in the path planning. The optimal contraction–expansion factor parameter combinations are matched by the navigation controller based on relative position information in an offline optimized contraction–expansion factor base. The desired front-wheel turning angle is calculated by the navigation controller based on the obtained contraction–expansion factor with the designed fuzzy rules. The actual front-wheel turning angle is obtained by an absolute encoder in the steering control device. The relative steering angle is obtained by comparing the desired front-wheel steering angle with the actual front-wheel steering angle. The steering control device is used to control the front wheel turning of the rice transplanter according to the obtained relative front-wheel turning angle. Finally, automatic navigation path tracking for rice transplanters is implemented.

Figure 10. Block diagram of path tracking control.

3.4. Simulation experiment

To verify the path tracking performance of optimal VUFC, a simulation model in MATLAB/Simulink is built. The performance of the algorithm is first verified using S-shaped paths and compared with the traditional variable domain fuzzy control algorithm for path tracking performance, where the S-shaped paths contain two straight-line paths and one curved path, and the curved path uses a semicircular turn. In addition, in the simulation, three different initial values of lateral deviation (0.2, 0.4, and 0.6 m) are chosen, while setting the heading deviation to 0, and three driving speeds (0.4, 0.8, and 1.2 m/s) are tested. The simulations were conducted in a total of 3 × 3 sets of experiments. The lateral deviation is used as an important indicator of the operational accuracy of the rice transplanter, so a specific analysis of the lateral deviation is performed. The lateral deviation during path tracking is generally within ±5 cm as the entering steady state of path tracking. The time of entering steady state of path tracking is used as the adjustment time t s (s). The overshoot Mp (m) is used as an indicator to assess the relative stability of the system. Adjustment time t s (s) and rise time t r (s) are used as indicators to assess the rapidity of the system.

The simulation results are shown in Figs. 11 and 12. Compared with the variable domain fuzzy control before optimization, the optimized variable domain fuzzy control can make the simulated trajectory of the vehicle closer to the planned path. The lateral deviation in the ground head turn is also lower, and the maximum lateral deviation is 0.164 m. When the transplanter passes through the ground head turn, the transplanter can enter the linear path tracking state well. After entering the linear path working area, the path tracing performance of the optimized variable domain fuzzy control is better than that of the variable domain fuzzy control before optimization. Besides, overshoot and time to stabilize are used as quantitative comparison indicators as shown in Table V. In the case of constant initial lateral deviation, the initial lateral deviation is within 0.60 m, the optimal VUFC path tracking overshoot Mp is 0, the average time to enter the path tracking steady state is less than 8.53 s, and the rise time t s is less than 6.40 s. The results show that the proposed algorithm has a small amount of overshoot and the time to enter the steady state of path tracking.

Table V. Results of the simulation experiment.

Figure 11. Simulation trajectory comparison.

Figure 12. Lateral deviation comparison.

4. Field experiment and discussion

4.1. Field experiment

To verify the performance of the proposed path tracking control method, a linear path tracking comparison experiment in the paddy field is performed by comparing it with the PPC method. The field experiment is conducted at the Guohe Experimental Base of the Anhui Agricultural University. The depth of the paddy soil is approximately 20 cm. The field experiment for the automatic navigation of the rice transplanter is shown in Fig. 13. In the field experiment, a marked path is planned in advance with two ends set at points A and B, which was used as the linear desired path for the rice transplanter path tracking. Driving the rice transplanter artificially is slowly along the marked path. During this process, the positioning information of the transplanter is recorded by the GPS, and the navigation coordinate points are fit into a path in the host computer, which is used as the linear desired path for the rice transplanter path tracking. Then, the initial heading deviation of the transplanter is adjusted to 0°, and the transplanter moves to the starting position of the linear desired path and begins to move the path until the end in the automatic navigation model. The information of parameters including position and attitude of the transplanter is recorded in real-time when it moves automatically, where the system sampling frequency is set to 5 Hz and the sampling time is set to 50 s. In the pure pursuit algorithm, the look-ahead distance is set to 1.2 m.

Figure 13. The field experiment of automatic operation of rice transplanter.

4.2. Analysis of field experiment results

The experimental results are analyzed using the overshoot Mp (m), the rise time t r (s), the adjustment time t s (s), and absolute mean steady-state error |e s | (m), and the comparison results are shown in Tables VIVIII. It can be found that, with constant initial lateral deviation, the values of overshoot Mp and absolute mean steady-state error |e s | are increased, while the values of rise time t r (s) and adjustment time t s are decreased as the driving speed of the transplanter increases. In addition, compared with the pure pursuit algorithm, the optimized variable domain fuzzy control algorithm can reduce the overshoot by 0.039, 0.031, and 0.039 m, the rise time t r by 5.2, 2, and 0.3 s, the adjustment time t s (s) by 5.2, 2.9, and 1.4 s, and the absolute mean error |e s | by 0.003, 0.003, and 0.004 m, respectively. As shown in Tables VIVIII, the optimal variable domain fuzzy control algorithm proposed in this work can reduce the overshoot and stabilization time.

Table VI. Comparison results of path tracking performance at a driving speed of 0.4 m/s.

Table VII. Comparison results of path tracking performance at a driving speed of 0.8 m/s.

Table VIII. Comparison results of path tracking performance at a driving speed of 1.2 m/s.

In addition, the curves of the algorithm performance comparison are given in Fig. 14. From Fig. 14, it can be seen that under different initial lateral deviation condition, the proposed algorithm has smaller path tracking response time and can quickly eliminate lateral deviations compared with the PPC method. Figure 15 shows box plots of the algorithm performance comparison. As shown in Fig. 15, the overshoot, rise time, adjustment time, and absolute average steady-state error of the proposed time are smaller than those of the PPC method. And the distance between the upper quartile and the lower quartile is also smaller than that of pure tracking, indicating that the data of the proposed method are more concentrated and the proposed method has better straight-line path tracking performance. In general, the comparative test shows that fast and stable entry of the linear tracking state performance can be obtained by adjusting the fuzzy universe with VUFC and selecting the combination of contraction–expansion factors in the offline database of contraction–expansion factor by looking up the table according to the lateral deviation and heading deviation.

Figure 14. Curves of algorithm performance comparison. (a) The initial deviation is 0.2 m. (b) The initial deviation is 0.4 m. (c) The initial deviation is 0.6.

Figure 15. Box plot of algorithm performance comparison. (a) Overshoot Mp (m). (b) Rise time t r (s). (c) Adjustment time t s (s). (d) Absolute average steady-state error |e s | (m).

4.3. Comparative analysis with the results of existing studies

Comparing with existing studies, Yin et al. [Reference Yin, Zhu, Liao, Liu, Wang and Chu33] proposed a path tracking algorithm based on speed-adaptive fuzzy control for rice transplanter. The comparison results are shown in Table IX. The distance of entering steady state of path tracking of this paper is calculated by the product of the time of entering steady state of path tracking (t s ) and the speed (v). The results of this paper under average speed conditions are obtained by calculating the average values of Mp and t s at three different driving speeds of 0.4, 0.8, and 1.2 m/s.

Table IX. The results of the proposed method compared with Yin et al.

In Table IX, the results are compared with approximately the same initial conditions. Under low speed conditions, the Mp of the proposed method in this paper is 83% lower than that of Yin et al., and the distance of entering steady state of path tracking of this paper is at least 87% lower than that of Yin et al. Under high speed conditions, the Mp of the proposed method in this paper is 45% lower than that of Yin et al. and the distance of entering steady state of path tracking of this paper is at least 88% lower than that of Yin et al. Comparing the average speed results of this paper with the variable speed results of Yin et al., the Mp of the proposed method in this manuscript is 54% lower than that of Yin et al., and the distance of entering steady state of path-tracking of this paper is 80% lower than that of Yin et al. Part of the reason for the poorer comparison results of Yin et al is that the tracking paths include curved paths. Overall, the effect of path tracking can be influenced by driving speed during linear path tracking, but the proposed method can effectively reduce the time of entering steady state of path tracking. Under the same deviation condition, the proposed method can achieve better path tracking accuracy at different driving speeds.

5. Conclusion

This study provides a path tracking control method based on VUFC and improved BAS algorithm for rice transplanter in which VUFC is used for path tracking control and BAS is applied to obtain the contraction–expansion factor in VUFC.

In the method, VUFC can achieve adaptive adjustment of the fuzzy universe by dynamically adjusting the contraction–expansion factor in the complex paddy field environments, and an offline parameter optimization method based on BAS is used to build the offline database of contraction–expansion factor. In the paddy field application, an automated rice transplanter has low traction and is prone to sideslip and bump when it moves across an uneven and muddy paddy field, which can cause large fluctuation of the attitude of the transplanter. However, the combination of contraction–expansion factors can be obtained in the offline database of contraction–expansion factor by looking up the table according to the lateral deviation and heading deviation. Setting the contraction–expansion factor of VUFC in variable environments can effectively reduce the time of entering steady state of path tracking and improve the path tracking accuracy and efficiency of rice transplanter.

The automatic steering experimental platform is modified and used to perform simulations and experiments to verify the effectiveness of the proposed method. Experimental results demonstrate that the proposed method can reduce the time of entering the stable state of linear path tracking and achieve the accuracy and stability of path tracking compared with the PPC method. The method in this study still has limitations. The accuracy of the path tracking simulation model can affect the performance of the offline parameter optimization method. In the future research work, a path tracking simulation model will be further optimized to be more consistent with the actual paddy field environment through modeling the tire-soil pavement interaction force.

Author’s contribution

Dequan Zhu: Conceptualization, methodology, and software. Menghao Shi: Data curation and writing – original draft preparation. Yang Wang and Kang Xue: Visualization, investigation, and validation. Juan Liao and Wei Xiong: Supervision. Fuming Kuang and Shun Zhang: Writing – reviewing and editing.

Financial support

This work was funded by the Natural Science Foundation of Anhui Province (Grant No. 2208085ME131), the National Natural Science Foundation of China (Grant No.32201665), the Nature Science Research Project of Anhui province (Grant Nos. 2108085MC96), and Key Common Technology Research and Development Projects in Hefei (Grant No. 2021GJ078).

Competing interests

The authors declare none.

Ethical approval

Not applicable.

References

Hu, J., Gao, L. and Bai, X., “Review of research on automatic guidance of agricultural vehicles,” Trans. CSAE 31(10), 110 (2015).Google Scholar
Ji, C. and Zhou, J., “Current situation of navigation technologies for agricultural machinery,” Trans. CSAM 45(9), 4454 (2014).Google Scholar
Wang, H., Wang, G. and Luo, X., “Path tracking control method of agricultural machine navigation based on aiming pursuit model,” Trans. CSAE 35(4), 1119 (2019).Google Scholar
Zhang, W., Gai, J., Zhang, Z., Tang, L., Liao, Q. and Ding, Y., “Double-DQN based path smoothing and tracking control method for robotic vehicle navigation,” Comput. Electron. Agric. 166, 104985 (2019).CrossRefGoogle Scholar
De, S., Tabile, R., Inamasu, R. and Porto, A., “A row crop following behavior based on primitive fuzzy behaviors for navigation system of agricultural robots,” IFAC-Proc. 46(18), 9196 (2013).Google Scholar
He, Z., Nie, L., Yin, Z. and Huang, S., “A two-layer controller for lateral path tracking control of autonomous vehicles,” Sensors (Basel) 20(13), 3689 (2020).CrossRefGoogle ScholarPubMed
Moveh, S., Mohamed, H. and Binti, M., “A review of some pure-pursuit based path tracking techniques for control of autonomous vehicle,” Int. J. Comput. Appl. 135(1), 3538 (2016).Google Scholar
Yin, X., Du, J., Geng, D. and Jin, C., “Development of an automatically guided rice transplanter using RTK-GNSS and IMU,” IFAC-PapersOnLine 51(17), 374378 (2018).CrossRefGoogle Scholar
Luo, X., Zhang, Z. and Zhao, Z., “Design of DGPS navigation control system for Dongfanghong X-804 tractor,” Trans. CSAE 25(11), 139145 (2009).Google Scholar
Chen, J., Niao, C. and Zhu, Z., “Study on automatic guidance for tractor on grassland,” Trans CSAM 36(7), 104107 (2015).Google Scholar
Huang, P., Zhang, Z., Luo, X. and Huang, P., “Path tracking control of a differential-drive tracked robot based on look-ahead distance,” IFAC-PapersOnLine 51(17), 112117 (2018).CrossRefGoogle Scholar
Mehmet, B., Ehsan, K. and Hasan, H., “Double look-ahead reference point control for autonomous agricultural vehicles,” Biosyst. Eng. 113(2), 173186 (2012).Google Scholar
Ding, Y., Wang, L., Li, Y. and Li, D., “Model predictive control and its application in agriculture: A review,” Comput. Electron. Agric. 151, 104117 (2018).CrossRefGoogle Scholar
Hamid, T. and Subhash, R., “Path-tracking of autonomous vehicles using a novel adaptive robust exponential-like-sliding-mode fuzzy type-2 neural network controller,” Mech. Syst. Signal Process. 130, 4155 (2019).Google Scholar
Li, S., Xu, H., Ji, Y., Cao, R., Zhang, M. and Li, H., “Development of a following agricultural machinery automatic navigation system,” Comput. Electron. Agric. 158, 335344 (2019).CrossRefGoogle Scholar
Meng, Q., Qiu, R., He, J., Zhang, M., Ma, X. and Liu, G., “Development of agricultural implement system based on machine vision and fuzzy control,” Comput. Electron. Agric. 112, 128138 (2015).CrossRefGoogle Scholar
Korayem, M. H., Nekoo, S. R. and Kazemi, S., “Finite-time feedback linearization (FTFL) controller considering optimal gains on mobile mechanical manipulators,” J. Intell. Robotic Syst. 94(3–4), 118 (2019).Google Scholar
Keymasi Khalaji, S. A. A. M., “Adaptive sliding mode control of a wheeled mobile robot towing a trailer,” Proc. Inst. Mech. Eng., Part I: J. Syst. Control Eng. 229(2), 169183 (2015).Google Scholar
Mirzaeinejad, H. and Shafei, A. M., “A novel recursive formulation for dynamic modeling and trajectory tracking control of multi-rigid-link robotic manipulators mounted on a mobile platform,” Proc. Inst. Mech. Eng., Part I: J. Syst. Control Eng. 235 (7), 12041217 (2021).Google Scholar
Shojaei, K., Shahri, A. R. M. and Tarakameh, A. R., “Adaptive feedback linearizing control of nonholonomic wheeled mobile robots in presence of parametric and nonparametric uncertainties,” Robot. Comput. Integr. Manuf. 27(1), 149204 (2011).CrossRefGoogle Scholar
Azizi, M. R. and Keighobadi, J., “Point stabilization of nonholonomic spherical mobile robot using nonlinear model predictive control,” Robot. Auton. Syst. 98, 347359 (2017).CrossRefGoogle Scholar
Keely, A., A Feedforward Control Approach to the Local Navigation Problem for Autonomous Vehicles (Carnegie Mellon University, USA, 1994).CrossRefGoogle Scholar
Liu, J., Li, X. and Zang, Y., “Modelling and experimental study on active energy-regenerative suspension structure with variable universe fuzzy PD control,” Shock Vib. 2016, 111 (2016).Google Scholar
Zheng, J., Chen, J. and Quan, O., “Variable universe fuzzy control for battery equalization,” J. Syst. Sci. Complex. 31(1), 325342 (2018).CrossRefGoogle Scholar
Pang, H., Liu, F. and Xu, Z., “Variable universe fuzzy control for vehicle semi-active suspension system with MR damper combining fuzzy neural network and particle swarm optimization,” Neurocomputing 306, 130140 (2018).CrossRefGoogle Scholar
Wang, Y., Wei, M., Hu, X., Jang, M. and Zhang, L., “Research on variable universe fuzzy PID control strategy of pipe lining induction heating system,” Model. Simul. Eng. 2020, 19 (2020).CrossRefGoogle Scholar
Ma, G., Yu, Z., Cao, G., Zhang, R. and Zheng, Y., “The motion path study of measuring robot based on variable universe fuzzy control,” MATEC Web Conf. 95, 8011 (2017).CrossRefGoogle Scholar
Yao, J., Lu, J. and Zheng, Y., “DC motor speed control of annual-ring measuring instrument based on variable universe fuzzy control algorithm,” Trans. CSAE 35(14), 5763 (2019).Google Scholar
Jiang, X. and Li, S., “BAS: Beetle antennae search algorithm for optimization problems,” Int. J. Robot. Control 1(1), 15 (2018).CrossRefGoogle Scholar
Fan, Y., Shao, J., Sun, G. and Shao, X., “Improved beetle antennae search algorithm-based Lévy flight for tuning of PID controller in force control system,” Math. Probl. Eng. 2020, 122 (2020).Google Scholar
Lin, Y., Hao, J. and Ji, Z., “A study of genetic algorithm based on isolation niche technique,” J. Syst. Eng. 15(1), 8691 (2000).Google Scholar
Li, X.-L., Serra, R., Olivier, J. and Fei, C., “Performance of fitness functions based on natural frequencies in defect detection using the standard PSO-FEM approach,” Shock Vib. 2021(1), 19 (2021).Google Scholar
Yin, J., Zhu, D., Liao, J., Liu, L., Wang, Y. and Chu, T., “Path tracking algorithm based on speed-adaptive fuzzy control for rice transplanter,” Int. Agric. Eng. J. 28(4), 19 (2019).Google Scholar
Figure 0

Figure 1. Test platform for automatic navigation control of rice transplanter. 1. Host computer PC; 2. lower computer STM32; 3. base station; 4. steering control device; 5. speed control device; 6. mobile station antenna; 7. vehicle-angle measurement sensor.

Figure 1

Table I. Navigation hardware parameters of test platform.

Figure 2

Figure 2. Schematic diagram of kinematic model of rice transplanter.

Figure 3

Figure 3. The variation of variable universes.

Figure 4

Figure 4. Gaussian curve affiliation function.

Figure 5

Table II. Fuzzy control rules.

Figure 6

Figure 5. Position of rice transplanter about desired path.

Figure 7

Figure 6. Fuzzy regular surfaces.

Figure 8

Algorithm 1 IABAS algorithm

Figure 9

Table III. The benchmark test function.

Figure 10

Table IV. Results of performance comparison tests.

Figure 11

Figure 7. The basic process of the method for offline optimization of parameters.

Figure 12

Figure 8. The optimal contraction–expansion factor $\alpha$.

Figure 13

Figure 9. The optimal contraction–expansion factor $\beta$.

Figure 14

Figure 10. Block diagram of path tracking control.

Figure 15

Table V. Results of the simulation experiment.

Figure 16

Figure 11. Simulation trajectory comparison.

Figure 17

Figure 12. Lateral deviation comparison.

Figure 18

Figure 13. The field experiment of automatic operation of rice transplanter.

Figure 19

Table VI. Comparison results of path tracking performance at a driving speed of 0.4 m/s.

Figure 20

Table VII. Comparison results of path tracking performance at a driving speed of 0.8 m/s.

Figure 21

Table VIII. Comparison results of path tracking performance at a driving speed of 1.2 m/s.

Figure 22

Figure 14. Curves of algorithm performance comparison. (a) The initial deviation is 0.2 m. (b) The initial deviation is 0.4 m. (c) The initial deviation is 0.6.

Figure 23

Figure 15. Box plot of algorithm performance comparison. (a) Overshoot Mp (m). (b) Rise time tr (s). (c) Adjustment time ts (s). (d) Absolute average steady-state error |es| (m).

Figure 24

Table IX. The results of the proposed method compared with Yin et al.