# The Study of Fractional Order Controller with SLAM in the Humanoid Robot

Authors: Shuhuan Wen; Xiao Chen; Yongsheng Zhao; Ahmad B. Rad; Kamal Mohammed Othman; Ethan Zhang
Journal: Advances in Mathematical Physics
 (2014)

---

## Abstract

We present a fractional order PI controller (FOPI) with SLAM method, and the proposed method is used in the simulation of navigation of NAO humanoid robot from Aldebaran. We can discretize the transfer function by the Al-Alaoui generating function and then get the FOPI controller by Power Series Expansion (PSE). FOPI can be used as a correction part to reduce the accumulated error of SLAM. In the FOPI controller, the parameters (Kp,Ki,andα) need to be tuned to obtain the best performance. Finally, we compare the results of position without controller and with PI controller, FOPI controller. The simulations show that the FOPI controller can reduce the error between the real position and estimated position. The proposed method is efficient and reliable for NAO navigation.


---

## Body

## 1. Introduction

More than 95% of the control loops are of PI/PID type in process control, but only a few of control loops work well [1]. There are some problems in PI/PID control, such as bad tuning, incorrect implementation techniques, some restrictions and limitations, and actuator and sensor problems.Using the notion of fractional order, it may be a step closer to the real world life, because many real physical systems are well characterized by fractional order differential equations [2]. So a considerable amount of research in fractional order dynamic systems and controllers was published in scientific and engineering literature in the last few years. Modern examples of applications are bioengineering [3], physics [4], chaos theory [5], viscoelasticity [6], and many others (see, e.g., [7]). Fractional order controllers can be expressed by fractional order differential equations. Fractional order controllers have been used in industrial applications [8] and various fields such as power electronics [9], system identification [10], robotic manipulators, irrigation canal control [11], mechatronics systems [12], and heat diffusion systems [13]. In addition, the stability is an essential property of systems, for example, for the stability of conventional systems of integer order and for fractional systems. So the stability issues for fractional order have been solved [2, 14–19].In this paper, we will study fractional order PI (FOPI) controller combined with SLAM in the navigation of humanoid robot because of the limitation of PI controller. In the FOPI controller, the parameters (Kp, Ki, and α) need to be tuned based on some design specifications. The results will be compared without controller and with PI controller, fractional order PI controller.The rest of this paper is organized as follows: the FOPI controller used in the NAO robot navigation control is presented in Section2, the background knowledge of SLAM and the NAO robot are described in Section 3, and the simulation results and conclusion are given in Sections 4 and 5, respectively.


## 2. Fractional Order PI Controller

### 2.1. Fractional Calculus

The fractional orderPIλDu was proposed as a generalization of the PID controller [20]. A general fundamental operator is denoted as follows:
(1)Dtαa={dαdtαRe(α)>01Re(α)=0∫at(dτ)-α,Re(α)<0,
where a and t are the limit of the operation, α is the fractional order, which can be any complex number, and τ is the variable of integration.Commonly, there are three methods to define the fractional calculus [21].


#### 2.1.1. Grünwald-Letnikov Definition

Consider(2)Dtαaf(t)=lim⁡h→01hα∑j=0[(t-a)/h](-1)j(αj)f(t-jh),
where (αj)=Γ(α+1)/Γ(j+1)Γ(α-j+1)=α!/j!(α-j)! is the binomial coefficient, [·] is the integer part, h is the calculation of step length, and Γ(∙) is gamma function.


#### 2.1.2. Riemann-Liouville Definition

Consider(3)Dtαaf(t)=1Γ(n-α)dndtn∫atf(τ)(t-τ)α-n+1dτ,hhhhhhhhhhhhhhhhhhhh(n-1<α<n).


#### 2.1.3. Caputo Definition

Consider(4)Dtαaf(t)=1Γ(n-α)∫atf(n)(τ)(t-τ)α-n+1dτ,(n-1<α<n).For zero initial conditions and lower limita=0, the Laplace transform of fractional derivatives is
(5)L{Dtα0f(t)}=sαF(s).


### 2.2. Fractional Order Controller

From the definition, it is shown that the fractional order differential is different from the integer order differential. It is not to obtain the limit values at the point, but it is related to the function values from the initial time to this point time. So the fractional order PI has memory.The typicaln-term linear fractional order differential equation as is follows:
(6)anDβny(t)+an-1Dβn-1y(t)+⋯a1Dβ1y(t)+a0Dβ0y(t)=bnDαnu(t)+bn-1Dαn-1u(t)+⋯b1Dα1u(t)+b0Dα0u(t),
where αk and βk are arbitrary real numbers. Assuming αk>αk-1>⋯α0>0, βk>βk-1>⋯β0>0 because of no loss of generality.Assume (6) meets the zero initial condition; we can get the continuous fractional order transfer function by using Laplace transform technique:
(7)G(s)=Y(s)U(s)=bmsβm+bm-1sβm-1+⋯+b0sβ0ansαn+an-1sαn-1+⋯+a0sα0.
For the discrete fractional order control system, the equation z transform is available:
(8)G(z)=Y(z)U(z)=(bm(w(z-1))βm+bm-1(w(z-1))βm-1+⋯d+b0(w(z-1))β0)×(an(w(z-1))αn+an-1(w(z-1))αn-1+⋯dd+a0(w(z-1))α0)-1,
where w(z-1) is the transform function from s domain to z domain.In general, the discretization of continuous fractional order differentiator/integrators±γ (γ∈R) can be expressed as s±γ≈(w(z-1))±γ. So the generating function and its expansion determine both the form of the approximation and the coefficients [22]. We can get different generating function because of different calculation method. As a generating function, w(z-1), the following formula can be used in general:
(9)w(z-1)=(1μT1-z-1γ+(1-γ)z-1),
where μ and γ denote the gain and phase tuning parameters, respectively, and T is the sampling period. For example, when μ=1 and γ={0,1/2,7/8,1,3/2}, the generating function (9) becomes the forward Euler, the Tustin, the Al-Alaoui, the backward Euler, and the implicit Adams rules, respectively [23]. We will consider the Al-Alaoui generating function of the form
(10)(w(z-1))±γ=(87T1-z-11+(z-1/7))±γ.The discretization formal for GL formula (2) is given after performing the PSE (Power Series Expansion) of (1-z-1)±γ. By using the short memory principle [24], the discrete equivalent of the fractional order integrodifferential operator (w(z-1))±γ is given by
(11)(w(z-1))±γ=T∓γz-[L/T]∑j=0[L/T](-1)j(±γj)z[L/T]-j,
where T is the sampling period, L is the memory length, and (-1)j(±γj) are binomial coefficients cj(r) (j=0,1,…), c0(r)=1, and cj(r)=(1-(1+(±γ))/j)cj-1(γ).We use the FOPI controller, and its transfer function can be expressed as(12)G(s)=U(s)E(s)=Kp+Kisα=Kpsα+Kisα.With the Al-Alaoui operation, we can obtain(13)G(s)=U(s)E(s)=Kp(8/7T)α(Pp/Qq)+Ki(8/7T)α(Pp/Qq)=Kp(8/7T)αPp+KiQq(8/7T)αPp.The third order expansion by using PSE method is(14)G(s)=U(s)E(s)=(KpKα(p3z-3+p2z-2+p1z-1+1)cd+Ki(q3z-3+q2z-2+q1z-1+1))×(Kα(p3z-3+p2z-2+p1z-1+1))-1,
where
(15)p1=-α,p2=α2-α2,p3=-α3+3α2-2α6,q1=α7,q2=α2-α98,q3=α3-3α2+2α2058,Kα=(87T)α.
Equation (14) can be given by
(16)G(s)=((KpKαp3+Kiq3)z-3+(KpKαp2+Kiq2)z-2c+(KpKαp1+Kiq1)z-1+(Ki+KpKα))×(Kα(p3z-3+p2z-2+p1z-1+1))-1.
And it can be expressed as
(17)U(z)Kα(p3z-3+p2z-2+p1z-1+1)=E(z)[(KpKαp3+Kiq3)z-3+(KpKαp2+Kiq2)z-2ddddd.dd+(KpKαp1+Kiq1)z-1+(Ki+KpKα)].
So we can get
(18)u(t)=(Kpp3+Kiq3Kα)e(t-3)+(Kpp2+Kiq2Kα)e(t-2)+(Kpp1+Kiq1Kα)e(t-1)+(Kp+KiKα)e(t)-p1u(t-1)-p2u(t-2)-p3u(t-3).


## 2.1. Fractional Calculus

The fractional orderPIλDu was proposed as a generalization of the PID controller [20]. A general fundamental operator is denoted as follows:
(1)Dtαa={dαdtαRe(α)>01Re(α)=0∫at(dτ)-α,Re(α)<0,
where a and t are the limit of the operation, α is the fractional order, which can be any complex number, and τ is the variable of integration.Commonly, there are three methods to define the fractional calculus [21].


### 2.1.1. Grünwald-Letnikov Definition

Consider(2)Dtαaf(t)=lim⁡h→01hα∑j=0[(t-a)/h](-1)j(αj)f(t-jh),
where (αj)=Γ(α+1)/Γ(j+1)Γ(α-j+1)=α!/j!(α-j)! is the binomial coefficient, [·] is the integer part, h is the calculation of step length, and Γ(∙) is gamma function.


### 2.1.2. Riemann-Liouville Definition

Consider(3)Dtαaf(t)=1Γ(n-α)dndtn∫atf(τ)(t-τ)α-n+1dτ,hhhhhhhhhhhhhhhhhhhh(n-1<α<n).


### 2.1.3. Caputo Definition

Consider(4)Dtαaf(t)=1Γ(n-α)∫atf(n)(τ)(t-τ)α-n+1dτ,(n-1<α<n).For zero initial conditions and lower limita=0, the Laplace transform of fractional derivatives is
(5)L{Dtα0f(t)}=sαF(s).


## 2.1.1. Grünwald-Letnikov Definition

Consider(2)Dtαaf(t)=lim⁡h→01hα∑j=0[(t-a)/h](-1)j(αj)f(t-jh),
where (αj)=Γ(α+1)/Γ(j+1)Γ(α-j+1)=α!/j!(α-j)! is the binomial coefficient, [·] is the integer part, h is the calculation of step length, and Γ(∙) is gamma function.


## 2.1.2. Riemann-Liouville Definition

Consider(3)Dtαaf(t)=1Γ(n-α)dndtn∫atf(τ)(t-τ)α-n+1dτ,hhhhhhhhhhhhhhhhhhhh(n-1<α<n).


## 2.1.3. Caputo Definition

Consider(4)Dtαaf(t)=1Γ(n-α)∫atf(n)(τ)(t-τ)α-n+1dτ,(n-1<α<n).For zero initial conditions and lower limita=0, the Laplace transform of fractional derivatives is
(5)L{Dtα0f(t)}=sαF(s).


## 2.2. Fractional Order Controller

From the definition, it is shown that the fractional order differential is different from the integer order differential. It is not to obtain the limit values at the point, but it is related to the function values from the initial time to this point time. So the fractional order PI has memory.The typicaln-term linear fractional order differential equation as is follows:
(6)anDβny(t)+an-1Dβn-1y(t)+⋯a1Dβ1y(t)+a0Dβ0y(t)=bnDαnu(t)+bn-1Dαn-1u(t)+⋯b1Dα1u(t)+b0Dα0u(t),
where αk and βk are arbitrary real numbers. Assuming αk>αk-1>⋯α0>0, βk>βk-1>⋯β0>0 because of no loss of generality.Assume (6) meets the zero initial condition; we can get the continuous fractional order transfer function by using Laplace transform technique:
(7)G(s)=Y(s)U(s)=bmsβm+bm-1sβm-1+⋯+b0sβ0ansαn+an-1sαn-1+⋯+a0sα0.
For the discrete fractional order control system, the equation z transform is available:
(8)G(z)=Y(z)U(z)=(bm(w(z-1))βm+bm-1(w(z-1))βm-1+⋯d+b0(w(z-1))β0)×(an(w(z-1))αn+an-1(w(z-1))αn-1+⋯dd+a0(w(z-1))α0)-1,
where w(z-1) is the transform function from s domain to z domain.In general, the discretization of continuous fractional order differentiator/integrators±γ (γ∈R) can be expressed as s±γ≈(w(z-1))±γ. So the generating function and its expansion determine both the form of the approximation and the coefficients [22]. We can get different generating function because of different calculation method. As a generating function, w(z-1), the following formula can be used in general:
(9)w(z-1)=(1μT1-z-1γ+(1-γ)z-1),
where μ and γ denote the gain and phase tuning parameters, respectively, and T is the sampling period. For example, when μ=1 and γ={0,1/2,7/8,1,3/2}, the generating function (9) becomes the forward Euler, the Tustin, the Al-Alaoui, the backward Euler, and the implicit Adams rules, respectively [23]. We will consider the Al-Alaoui generating function of the form
(10)(w(z-1))±γ=(87T1-z-11+(z-1/7))±γ.The discretization formal for GL formula (2) is given after performing the PSE (Power Series Expansion) of (1-z-1)±γ. By using the short memory principle [24], the discrete equivalent of the fractional order integrodifferential operator (w(z-1))±γ is given by
(11)(w(z-1))±γ=T∓γz-[L/T]∑j=0[L/T](-1)j(±γj)z[L/T]-j,
where T is the sampling period, L is the memory length, and (-1)j(±γj) are binomial coefficients cj(r) (j=0,1,…), c0(r)=1, and cj(r)=(1-(1+(±γ))/j)cj-1(γ).We use the FOPI controller, and its transfer function can be expressed as(12)G(s)=U(s)E(s)=Kp+Kisα=Kpsα+Kisα.With the Al-Alaoui operation, we can obtain(13)G(s)=U(s)E(s)=Kp(8/7T)α(Pp/Qq)+Ki(8/7T)α(Pp/Qq)=Kp(8/7T)αPp+KiQq(8/7T)αPp.The third order expansion by using PSE method is(14)G(s)=U(s)E(s)=(KpKα(p3z-3+p2z-2+p1z-1+1)cd+Ki(q3z-3+q2z-2+q1z-1+1))×(Kα(p3z-3+p2z-2+p1z-1+1))-1,
where
(15)p1=-α,p2=α2-α2,p3=-α3+3α2-2α6,q1=α7,q2=α2-α98,q3=α3-3α2+2α2058,Kα=(87T)α.
Equation (14) can be given by
(16)G(s)=((KpKαp3+Kiq3)z-3+(KpKαp2+Kiq2)z-2c+(KpKαp1+Kiq1)z-1+(Ki+KpKα))×(Kα(p3z-3+p2z-2+p1z-1+1))-1.
And it can be expressed as
(17)U(z)Kα(p3z-3+p2z-2+p1z-1+1)=E(z)[(KpKαp3+Kiq3)z-3+(KpKαp2+Kiq2)z-2ddddd.dd+(KpKαp1+Kiq1)z-1+(Ki+KpKα)].
So we can get
(18)u(t)=(Kpp3+Kiq3Kα)e(t-3)+(Kpp2+Kiq2Kα)e(t-2)+(Kpp1+Kiq1Kα)e(t-1)+(Kp+KiKα)e(t)-p1u(t-1)-p2u(t-2)-p3u(t-3).


## 3. Background of SLAM and NAO Humanoid Robot

The simultaneous localization and mapping (SLAM) is a process by which a robot can build a map of an environment and at the same time use this map to deduce its location. In SLAM, both the trajectory of the platform and the location of all landmarks are estimated online without the need for any a priori knowledge of location [25, 26]. EKF-SLAM is very well known to navigation problems. The main steps of SLAM include robot motion prediction, new landmarks initialization, and known landmarks correction.The observation model is(19)y=h(x)+v,
where x is robot state vector and landmark states, h(x) is the observation function, and v is the measurement noise.The covariance matrix is(20)P=FPF′+Q,
where F is Jacobian matrix and Q is the Gaussian noise.The EKF correction step is written as(21)z=y-h(x′),Z=HPxT+R,
where z is the innovation’s mean, x′ is the observation position of the robot, H is Jacobian matrix, and R is the covariance matrix of the measurement noise.Kalman gainK is K=PHTZ.The update position of the robot is(22)x′=x′+Kz.The correction covariance matrix is(23)P=P-KZKT.NAO is a new biped robot recently developed by French company Aldebaran-Robotics. This humanoid robot had been designed purposely to look approachable. With a height of 0.57 meters and weight of about 4.5 kilogram, NAO has the appealing appearance of a human toddler [27]. Based on NAO robot, the FOPI controller as the correction part is used in the SLAM simulation of NAO navigation in this paper.


## 4. Simulation Result

### 4.1. Control System Model

When NAO robot moves in 2D space, the motion is mainly influenced by three variables, namely, the robot current position, the control variable, and the disturbance variable. Therefore, it is very important to reduce the accumulated error for robot and effectively overcome the negative influence of disturbance variable.NAO will deviate from a set target because there is no correction part to compensate noise of the sensors. When the control U is a fixed value, the real position and estimated position of the NAO will be largely different. So we use controller as the correction part to reduce the error. The correction part is based on the return error of the real position and estimated position of NAO. The outline of this correction part is presented in Figure1.Figure 1
The correction part, wherexR is the real position and xes is the EKF-estimated position.


### 4.2. Algorithm Performance Index

Because the NAO in SLAM mainly produces two kinds of errors, so the average error index of robot position, the average error index of landmarks, and the average variance index of robot position are proposed to test the performance of the controller. The average error index of robot position is the average different value between the real position and the estimated position. When NAO moves ins steps, the definition e¯ is expressed by
(24)e¯=∑i=1ses,
where e is the error of xR and xes and s is the number of steps.If the number of landmarks isn and le is the error of the real landmarks and estimated landmarks, the average error index of landmarks le¯ is defined as follows:
(25)le¯=∑i=1nlen.According to (24) and (25), we can see that the smaller the average error, the better the control effect. But it could not judge the stability of the control system from the single average error index. So we define the average variance that shows the distribution degree of error. The average variance σ is defined as follows:
(26)σ=∑i=1s(e-e¯)2s.
The smaller the average variance, that is, every step error of NAO is close to the average error, the better the stability of the control.


### 4.3. Control Algorithm Comparison

Figures2 and 3 show the simulation result of SLAM with the fixed U and PI controller, respectively. The three stars are the landmarks. The red points and green points are the real position and the estimated position, respectively. The circles on the green points are the covariance of the robot. The circles become smaller when the robot is near the landmark. The green circles are the estimated landmarks.Figure 2
The simulation motion result of NAO in SLAM with the fixed U.Figure 3
The simulation motion result of NAO in SLAM with PI controller.In this paper, if not specified, abscissa represents steps, and ordinate represents the error. Figure4 shows the error of the different Kp with PI controller in EKF-SLAM. When Kp<0.7, the PI controller cannot effectively adjust the control variable according to the error. And when 0.7<Kp<1, the control variable generated from PI controller can basically make the estimated position trace to the real position. But when Kp is too large, the PI control variable cannot keep stable, so we cannot follow the estimated position of robot.Figure 4
The error of the differentKp with PI controller.Figure5 shows the comparison of the errors with fixed U and PI controller. It can be seen that the error with PI controller is far less than the one with the fixed U. However, when the steps of the robot motion increase, the error generated from PI controller also gradually increases. So PI controller cannot efficiently reduce the accumulated error of the robot with the increasing steps. Therefore, we use FOPI controller to decrease the error in the motion process. There are three parameters (Kp, Ki, and α) to be tuned.Figure 5
The comparison of the error with fixed U and PI controller.From Figure6, we can know that the scope of Kp is 0.7–0.9, Ki is about 0.2, and α is the value of about 0.1. In Figure 6(c), if the parameter α increases, the result of controller will become bad. But when α is too small, the effect of integral is not obvious, so the value of α is about 0.1. In the permitted range of proportional coefficient Kp and integral coefficient Ki, the FOPI error influenced by the changing of Kp or Ki will not be a linear increasing trend, and its curve will move up or down with the increasing Kp or Ki. There is a fundamental difference between FOPI controller and PI controller. The error in FOPI controller has oscillation trend, which reflects that FOPI has a better control performance.The effect of three parameters (Kp, Ki, and α) of FOPI controller.
(a)
The error of differentKp
(b)
The error of differentKi
(c)
The error of differentαBased on the analysis of the parameters, this paper selects the optimal parameters (Kp=0.7, Ki=0.2, and α=0.1) of FOPI controller. The simulation of motion result of EKF-SLAM with FOPI controller is given in Figure 7. We can conclude that FOPI control can keep stable and get a better dynamics performance. The NAO robot’s estimated position has almost completely been close to the real position.Figure 7
The simulation motion result of SLAM with FOPI controller.Figure8 is the comparison between the optimal parameters of FOPI controller (Kp=0.7, Ki=0.2, and α=0.1) and PI controller (Kp=0.9, Ki=0.02). We compare them with the fixed U. The results verify the validity of FOPI controller. The average error and average variance are listed in Table 1. When NAO moves 0.5 each step, we can get that the error rate has got to 14% with PI controller and the error rate to approximately 3% with FOPI controller from Table 1. According to the index, it is shown that FOPI controller has better stability and higher accuracy. In addition, the average errors of the real landmarks and estimated landmarks with PI and FOPI controller are given in Table 2. We get the errors between the real landmarks and estimated landmarks based on the coordinates [1, 2, 5, 8, 11, 14]. In order to ensure the accuracy of simulation, we do the simulation 30 times, respectively, and get the le¯ in Table 2. We can see that the errors between the real landmarks and estimated landmarks based on FOPI controller with EKF-SLAM are much smaller than PI controller.Table 1
The average error index and variance index of robot position with PI/FOPI controller.
Controller
PI
FOPI
e
¯
0.074
0.015
σ
0.014
0.00005Table 2
The average error of the real landmarks and estimated landmarks with PI/FOPI controller.
Controller
PI
FOPI
le
¯
0.167
0.083Figure 8
The comparison of the error with fixed U/PI/FOPI controller.From the above figures and tables we can see that the pros and cons of three control methods are very obvious. FOPI controller is superior to PI controller, and PI controller is better than the fixed U control. The error of the robot movement with FOPI controller gradually tends to zero with the increasing steps. Moreover, the error of FOPI controller will not gradually increase and remain oscillation trend within a certain number of steps. It is shown that FOPI has a better performance than PI.


## 4.1. Control System Model

When NAO robot moves in 2D space, the motion is mainly influenced by three variables, namely, the robot current position, the control variable, and the disturbance variable. Therefore, it is very important to reduce the accumulated error for robot and effectively overcome the negative influence of disturbance variable.NAO will deviate from a set target because there is no correction part to compensate noise of the sensors. When the control U is a fixed value, the real position and estimated position of the NAO will be largely different. So we use controller as the correction part to reduce the error. The correction part is based on the return error of the real position and estimated position of NAO. The outline of this correction part is presented in Figure1.Figure 1
The correction part, wherexR is the real position and xes is the EKF-estimated position.


## 4.2. Algorithm Performance Index

Because the NAO in SLAM mainly produces two kinds of errors, so the average error index of robot position, the average error index of landmarks, and the average variance index of robot position are proposed to test the performance of the controller. The average error index of robot position is the average different value between the real position and the estimated position. When NAO moves ins steps, the definition e¯ is expressed by
(24)e¯=∑i=1ses,
where e is the error of xR and xes and s is the number of steps.If the number of landmarks isn and le is the error of the real landmarks and estimated landmarks, the average error index of landmarks le¯ is defined as follows:
(25)le¯=∑i=1nlen.According to (24) and (25), we can see that the smaller the average error, the better the control effect. But it could not judge the stability of the control system from the single average error index. So we define the average variance that shows the distribution degree of error. The average variance σ is defined as follows:
(26)σ=∑i=1s(e-e¯)2s.
The smaller the average variance, that is, every step error of NAO is close to the average error, the better the stability of the control.


## 4.3. Control Algorithm Comparison

Figures2 and 3 show the simulation result of SLAM with the fixed U and PI controller, respectively. The three stars are the landmarks. The red points and green points are the real position and the estimated position, respectively. The circles on the green points are the covariance of the robot. The circles become smaller when the robot is near the landmark. The green circles are the estimated landmarks.Figure 2
The simulation motion result of NAO in SLAM with the fixed U.Figure 3
The simulation motion result of NAO in SLAM with PI controller.In this paper, if not specified, abscissa represents steps, and ordinate represents the error. Figure4 shows the error of the different Kp with PI controller in EKF-SLAM. When Kp<0.7, the PI controller cannot effectively adjust the control variable according to the error. And when 0.7<Kp<1, the control variable generated from PI controller can basically make the estimated position trace to the real position. But when Kp is too large, the PI control variable cannot keep stable, so we cannot follow the estimated position of robot.Figure 4
The error of the differentKp with PI controller.Figure5 shows the comparison of the errors with fixed U and PI controller. It can be seen that the error with PI controller is far less than the one with the fixed U. However, when the steps of the robot motion increase, the error generated from PI controller also gradually increases. So PI controller cannot efficiently reduce the accumulated error of the robot with the increasing steps. Therefore, we use FOPI controller to decrease the error in the motion process. There are three parameters (Kp, Ki, and α) to be tuned.Figure 5
The comparison of the error with fixed U and PI controller.From Figure6, we can know that the scope of Kp is 0.7–0.9, Ki is about 0.2, and α is the value of about 0.1. In Figure 6(c), if the parameter α increases, the result of controller will become bad. But when α is too small, the effect of integral is not obvious, so the value of α is about 0.1. In the permitted range of proportional coefficient Kp and integral coefficient Ki, the FOPI error influenced by the changing of Kp or Ki will not be a linear increasing trend, and its curve will move up or down with the increasing Kp or Ki. There is a fundamental difference between FOPI controller and PI controller. The error in FOPI controller has oscillation trend, which reflects that FOPI has a better control performance.The effect of three parameters (Kp, Ki, and α) of FOPI controller.
(a)
The error of differentKp
(b)
The error of differentKi
(c)
The error of differentαBased on the analysis of the parameters, this paper selects the optimal parameters (Kp=0.7, Ki=0.2, and α=0.1) of FOPI controller. The simulation of motion result of EKF-SLAM with FOPI controller is given in Figure 7. We can conclude that FOPI control can keep stable and get a better dynamics performance. The NAO robot’s estimated position has almost completely been close to the real position.Figure 7
The simulation motion result of SLAM with FOPI controller.Figure8 is the comparison between the optimal parameters of FOPI controller (Kp=0.7, Ki=0.2, and α=0.1) and PI controller (Kp=0.9, Ki=0.02). We compare them with the fixed U. The results verify the validity of FOPI controller. The average error and average variance are listed in Table 1. When NAO moves 0.5 each step, we can get that the error rate has got to 14% with PI controller and the error rate to approximately 3% with FOPI controller from Table 1. According to the index, it is shown that FOPI controller has better stability and higher accuracy. In addition, the average errors of the real landmarks and estimated landmarks with PI and FOPI controller are given in Table 2. We get the errors between the real landmarks and estimated landmarks based on the coordinates [1, 2, 5, 8, 11, 14]. In order to ensure the accuracy of simulation, we do the simulation 30 times, respectively, and get the le¯ in Table 2. We can see that the errors between the real landmarks and estimated landmarks based on FOPI controller with EKF-SLAM are much smaller than PI controller.Table 1
The average error index and variance index of robot position with PI/FOPI controller.
Controller
PI
FOPI
e
¯
0.074
0.015
σ
0.014
0.00005Table 2
The average error of the real landmarks and estimated landmarks with PI/FOPI controller.
Controller
PI
FOPI
le
¯
0.167
0.083Figure 8
The comparison of the error with fixed U/PI/FOPI controller.From the above figures and tables we can see that the pros and cons of three control methods are very obvious. FOPI controller is superior to PI controller, and PI controller is better than the fixed U control. The error of the robot movement with FOPI controller gradually tends to zero with the increasing steps. Moreover, the error of FOPI controller will not gradually increase and remain oscillation trend within a certain number of steps. It is shown that FOPI has a better performance than PI.


## 5. Conclusion

In this paper, FOPI controller with EKF-SLAM is proposed. FOPI can be applied as a correction part. FOPI controller with EKF-SLAM can effectively reduce the accumulated error. The simulation shows that the FOPI controller is better than PI controller in NAO robot. The feasibility of FOPI is valid for the error of robot position and the error of landmarks. The feasibility of the proposed algorithm is validated by simulation results. In the future work, we can apply FOPI controller with SLAM to NAO platform and do the experiment in order to finish the navigation indoors environment. In addition, it is worth studying how to generalize the two-dimensional EKF-SLAM problem to the multidimensional EKF-SLAM problem.



---

*Source: 741351-2014-01-28.xml*