Advances in Mathematical Physics

Volume 2014 (2014), Article ID 741351, 8 pages

http://dx.doi.org/10.1155/2014/741351

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

^{1}Key Lab of Industrial Computer Control Engineering of Hebei Province, Yanshan University, Qinhuangdao 066004, China^{2}Machanical Engineering, Yanshan University, Qinhuangdao 066004, China^{3}School of Engineering Sciences, Simon Fraser University, 250-13450, 102 Avenue, Surrey, BC, Canada V3T 0A3

Received 26 September 2013; Revised 15 November 2013; Accepted 17 November 2013; Published 28 January 2014

Academic Editor: Ming Li

Copyright © 2014 Shuhuan Wen et al. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

#### 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 () 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.

#### 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 (, , 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 Section 2, 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 order was proposed as a generalization of the PID controller [20]. A general fundamental operator is denoted as follows: where and 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 where is the binomial coefficient, is the integer part, is the calculation of step length, and is gamma function.

###### 2.1.2. Riemann-Liouville Definition

Consider

###### 2.1.3. Caputo Definition

Consider

For zero initial conditions and lower limit , the Laplace transform of fractional derivatives is

##### 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 typical -term linear fractional order differential equation as is follows: where and are arbitrary real numbers. Assuming , 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: For the discrete fractional order control system, the equation transform is available: where is the transform function from domain to domain.

In general, the discretization of continuous fractional order differentiator/integrator () can be expressed as . 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, , the following formula can be used in general: where and denote the gain and phase tuning parameters, respectively, and is the sampling period. For example, when and , 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

The discretization formal for GL formula (2) is given after performing the PSE (Power Series Expansion) of . By using the short memory principle [24], the discrete equivalent of the fractional order integrodifferential operator is given by where is the sampling period, is the memory length, and are binomial coefficients (), , and .

We use the FOPI controller, and its transfer function can be expressed as

With the Al-Alaoui operation, we can obtain

The third order expansion by using PSE method is where Equation (14) can be given by And it can be expressed as So we can get

#### 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 where is robot state vector and landmark states, is the observation function, and is the measurement noise.

The covariance matrix is where is Jacobian matrix and is the Gaussian noise.

The EKF correction step is written as where is the innovation’s mean, is the observation position of the robot, is Jacobian matrix, and is the covariance matrix of the measurement noise.

Kalman gain is .

The update position of the robot is

The correction covariance matrix is

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 Figure 1.

##### 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 in steps, the definition is expressed by where is the error of and and is the number of steps.

If the number of landmarks is and is the error of the real landmarks and estimated landmarks, the average error index of landmarks is defined as follows:

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: 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

Figures 2 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.

In this paper, if not specified, abscissa represents steps, and ordinate represents the error. Figure 4 shows the error of the different with PI controller in EKF-SLAM. When , the PI controller cannot effectively adjust the control variable according to the error. And when , the control variable generated from PI controller can basically make the estimated position trace to the real position. But when is too large, the PI control variable cannot keep stable, so we cannot follow the estimated position of robot.

Figure 5 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 (, , and ) to be tuned.

From Figure 6, we can know that the scope of is 0.7–0.9, 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 and integral coefficient , the FOPI error influenced by the changing of or will not be a linear increasing trend, and its curve will move up or down with the increasing or . 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.

Based on the analysis of the parameters, this paper selects the optimal parameters (, , and ) 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 8 is the comparison between the optimal parameters of FOPI controller (, , and ) and PI controller (, ). 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 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.

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.

#### Conflict of Interests

The authors declare that there is no conflict of interests regarding the publication of this paper.

#### Acknowledgments

The work was partly supported by the National Natural Science Foundation of China (NSFC) under the Project Grant no. 51275439 and the 973 Plan under the Project no. 2013CB733003, and the Natural Science Foundation of Hebei Province of China under the project no. F2014203095.

#### References

- K. J. Astrom and T. Hagglund,
*Advanced PID Control*, ISA, USA, 2006. - Z. Jiao and Y. Q. Chen, “Stability of fractional-order linear time-invariant systems with multiple noncommensurate orders,”
*Computers & Mathematics with Applications*, vol. 64, no. 10, pp. 3053–3058, 2012. View at Publisher · View at Google Scholar · View at Zentralblatt MATH · View at MathSciNet - R. L. Magin,
*Fractional Calculus in Bioengineering*, Begell House, 2006. - R. Hilfer,
*Applications of Fractional Calculus in Physics*, World Scientific, Singapore, 2000. View at Publisher · View at Google Scholar · View at MathSciNet - I. Petráš,
*Fractional-Order Nonlinear Systems: Modeling, Analysis and Simulation*, Springer, New York, NY, USA, 2011. - F. Mainardi,
*Fractional Calculus and Waves in Linear Viscoelasticity: An Introduction to Mathematical Models*, Imperial College Press, London, UK, 2010. View at Publisher · View at Google Scholar · View at MathSciNet - J. Sabatier, O. P. Agrawal, and J. A. TenreiroMachado, Eds.,
*Advances in Fractional Calculus: Theoretical Developments and Applications in Physics and Engineering*, Springer, 2007. - B. M. Vinagre, C. A. Monje, A. J. Caldern, and J. I. Surez, “Fractional PID controllers for industry application: a brief introduction,”
*Journal of Vibration and Control*, vol. 13, no. 9-10, pp. 1419–1429, 2007. View at Publisher · View at Google Scholar · View at Zentralblatt MATH · View at Scopus - A. J. Calderón, B. M. Vinagre, and V. Feliu, “Fractional order control strategies for power electronic buck converters,”
*Signal Processing*, vol. 86, no. 10, pp. 2803–2819, 2006. View at Publisher · View at Google Scholar · View at Zentralblatt MATH · View at Scopus - M. Schlegel and M. Cech, “Fractal system identification for robust control-the moment approach,” in
*Proceedings of the 5th International Carpathian Control Conference*, pp. 1–6, AGH-UST, Krakَw, Poland, May 2004. View at Publisher · View at Google Scholar - V. Feliu-Batlle, R. R. Pérez, and L. S. Rodríguez, “Fractional robust control of main irrigation canals with variable dynamic parameters,”
*Control Engineering Practice*, vol. 15, no. 6, pp. 673–686, 2007. View at Publisher · View at Google Scholar · View at Scopus - F. Hongmei, S. Yu, and Z. Xiaobin, “Research on fractional order controller in servo press control system,” in
*Proceedings of the IEEE International Conference on Mechatronics and Automation (ICMA '07)*, pp. 2934–2938, August 2007. View at Publisher · View at Google Scholar · View at Scopus - I. S. Jesus and J. A. Tenreiro Machado, “Fractional control of heat diffusion systems,”
*Nonlinear Dynamics*, vol. 54, no. 3, pp. 263–282, 2008. View at Publisher · View at Google Scholar · View at Zentralblatt MATH · View at MathSciNet - M. Li, S. C. Lim, C. Cattani, and M. Scalia, “Characteristic roots of a class of fractional oscillators,”
*Advances in High Energy Physics*, vol. 2013, Article ID 853925, 7 pages, 2013. View at Publisher · View at Google Scholar - M. Li, “Approximating ideal filters by systems of fractional order,”
*Computational and Mathematical Methods in Medicine*, vol. 2012, Article ID 365054, 6 pages, 2012. View at Publisher · View at Google Scholar · View at Zentralblatt MATH · View at MathSciNet - M. Li, S. C. Lim, and S. Chen, “Exact solution of impulse response to a class of fractional oscillators and its stability,”
*Mathematical Problems in Engineering*, vol. 2011, Article ID 657839, 9 pages, 2011. View at Publisher · View at Google Scholar · View at Zentralblatt MATH · View at MathSciNet · View at Scopus - H. Hejazi, T. Moroney, and F. Liu, “Stability and convergence of a finite volume method for the space fractional advection-dispersion equation,”
*Journal of Computational and Applied Mathematics*, vol. 255, pp. 684–697, 2014. View at Publisher · View at Google Scholar · View at MathSciNet - J. Sabatier and C. Farges, “On stability of commensurate fractional order systems,”
*International Journal of Bifurcation and Chaos*, vol. 22, no. 4, Article ID 1250084, 8 pages, 2012. View at Google Scholar · View at Zentralblatt MATH - J.-G. Lu, Y. Chen, and W. Chen, “Robust asymptotical stability of fractional-order linear systems with structured perturbations,”
*Computers & Mathematics with Applications*, vol. 66, no. 5, pp. 873–882, 2013. View at Publisher · View at Google Scholar · View at MathSciNet - I. Podlubny, “Fractional-order systems and $P{I}^{\lambda}{D}^{\mu}$-controllers,”
*IEEE Transactions on Automatic Control*, vol. 44, no. 1, pp. 208–214, 1999. View at Publisher · View at Google Scholar · View at MathSciNet - I. Podlubny,
*Fractional Differential Equations*, Academic Press, San Diego, Calif, USA, 1999. View at MathSciNet - Ch. Lubich, “Discretized fractional calculus,”
*SIAM Journal on Mathematical Analysis*, vol. 17, no. 3, pp. 704–719, 1986. View at Publisher · View at Google Scholar · View at Zentralblatt MATH · View at MathSciNet - I. Petras, “An adaptive fractional-order controller,” in
*Proceedings of the 14th IEEE International Carpathian Control Conference (ICCC '13)*, pp. 297–2301, Rytro, Poland, May 2013. View at Publisher · View at Google Scholar - I. Podlubny, “Fractional-order systems and fractional order controllers,”
*Technical Report*UEF-03-94, Slovak Academy of Sciences. Institute of Experimental Physics, Department of Control Engineering. Faculty of Mining, University of Technology, Kosice, Slovak Republic, 1994. View at Google Scholar - H. Durrant-Whyte and T. Bailey, “Simultaneous localization and mapping. Part I: the essential algorithms,”
*IEEE Robotics and Automation Magazine*, vol. 13, no. 2, pp. 99–108, 2006. View at Publisher · View at Google Scholar · View at Scopus - T. Bailey and H. Durrant-Whyte, “Simultaneous localization and mapping (SLAM). Part II: state of the art,”
*IEEE Robotics and Automation Magazine*, vol. 13, no. 3, pp. 108–117, 2006. View at Publisher · View at Google Scholar · View at Scopus - S. Shamsuddin, L. I. Ismail, H. Yussof et al., “Humanoid robot NAO: review of control and motion exploration,” in
*Proceedings of the IEEE International Conference on Control System, Computing and Engineering (ICCSCE '11)*, pp. 511–5516, Penang, Malaysia, November 2011. View at Publisher · View at Google Scholar