Download as pdf or txt
Download as pdf or txt
You are on page 1of 7

2018 International Conference on Energy, Power and Materials Engineering (EPME 2018)

ISBN: 978-1-60595-102-7

Robot Trajectory Tracking Control Based on Look-up Table Method

Qiang YANG*, Jun ZHAO, Fu-cheng SONG and Guo HE


Control Engineering College, Chengdu University of Information Technology,
Chengdu 610225, China
*Corresponding author

Keywords: Robot, Trajectory tracking, Looking-up table, Optional control.

Abstract. This paper proposed a simple and applicable look-up table based trajectory tracking
control scheme for robot. Based on the robot’s kinematics model and the saturation constraint of the
control inputs, a control-trajectory table was established using the European numerical calculation
method. The optimal control values can be determined under the look-up table criteria. Finally, the
simulation results of trajectories with different characteristics of straight line, sine line and circle
show the effectiveness of the proposed scheme.

Introduction
With the development of science and technology, mobile robots are widely used in many fields,
such as agriculture and industry. Mobile robots are the attract research filed in recent years [1-5].
The control problem of wheeled mobile robots attracts a large number of researchers due to their
theoretical challenges and their wide range of practical applications. Among the reported results,
trajectory control of a mobile robot, especially a trajectory of a series of coordinate sequences
whose specified reference trajectories have strong nonlinearities or do not satisfy the single curve
description, is not effective in trajectory tracking.
The objective of mobile robot control can be expressed as: i. Move between two locations, ii.
track a given trajectory curve, iii. track a given geometry path. Based on adaptive control [6-9],
sliding mode control [10-13], back-stepping design [14-15], PID control, fuzzy control and high
gain control, many trajectory tracking controller were obtained for mobile robot [16-19]. A smooth
linear or non-linear function is often used to describe the desired trajectory when presenting and
analyzing problems. And with constraints, such as the first and the second derivative of the desired
trajectory are bounded.
In practical application, there are several deficiencies for the mentioned trajectory control
strategy:
A. In fact, it is difficult to give an exact function description model of the desired trajectory.
Users tend to focus only on where the robot expect to arrive, but they do not care about what
functions are used to describe these locations because it is a very difficult task, especially for the
desired trajectories described by discrete sequences of irregularities.
B. In view of the expected trajectory of different characteristics, the existing methods have poor
robustness and large trajectory tracking control errors. With the development of artificial
intelligence, the expected trajectory of mobile robot cannot be fixed, but tends to randomness and
variability. Due to different tasks at different times (task is temporary, random), yesterday, today
and tomorrow, the robot's expected trajectory is not exactly the same. Therefore, the appropriate
trajectory tracking control method should be selected, which is undoubtedly a difficult task for the
user.
C. The control algorithm has complex structure, high cost and poor real-time performance. In
many literatures, in order to improve the performance in control accuracy and robustness, a large
number of uncertainties are added into the model analysis, such as parameter uncertainty, load
uncertainty, modeling error, etc. The trajectory controller has a complicated structure and large
calculation. In some state feedback trajectory controllers, it is necessary to detect the attitude
information such as velocity, angular velocity and position of the mobile robot in real time. The
294
sensor needs to be installed and communicates with the main controller. There is a large amount of
data flow transmission and processing, which make the high cost, real-time poor of the robot.
For the situation that a series of coordinate sequences with strong nonlinearity or unsatisfied
single curve description, the reported literature does not provide a simple and effective method to
control the trajectory of wheeled mobile machines.
In this paper, a simple and applicable look-up table [20] based trajectory tracking method is
proposed for mobile robot. This scheme can be applied to not only the line or nonlinear trajectory
curve but also the trajectory that a series of coordinate sequences with strong nonlinearity or
unsatisfied single curve description. Based on the robot’s kinematics model and the saturation
constraint of the control inputs, a control-trajectory table was established using the European
numerical calculation method. The optimal control values can be determined under the look-up
table criteria. Because the matching table are calculated offline, the proposed scheme is robust, less
computationally intensive and real-time.

Problem Description
Consider the simplified model of the wheeled mobile robot shown in figure 1.

Figure 1. Simplified model of wheeled mobile robot.

Where,  x, y  is the robot's centroid coordinates in the moving plane,  is the robot's attitude
angle, v is the velocity of the robot,  is the angular velocity of the robot respectively. The
kinematics equation of a wheeled mobile robot can be described as

 x  v  cos  

 y  v  sin   (1)

  
where  v,   is the control input vector satisfying the saturation constraints

 v  t   vmax , t  0

   t   max , t  0
(2)

vmax and max are two positive constants.


Objective: Given any reference trajectory  xr , yr  , which is linear or nonlinear curve or a series of
trajectory coordinate sequences that do not satisfy the single curve description, we need to design

295
the control input  v,   to make the robot's trajectory  x, y  tracking the specified reference trajectory
 xr , yr  .

Trajectory Control Based on Look-up Table


In this paper, a fast looking-up table control algorithm is proposed. First, we establish the
relationship table between the control input  v,   and the robot's trajectory  x, y  . Second, determine
the control input based on table look-up criteria. Finally, the determined control input acts on the
robot to make the robot's moving trajectory tracking the desired trajectory.
Astablish the Relationship Table between the Control Input and the Trajectory
According to the saturation constraints, we discrete  v,   into  m, n  different equal parts respectively
e.g.

v :  v1 , v2 , v3 , , vm 

 : 1 , 2 , 3 , , n  (3)

Satisfying

v1  vmax , vm  vmax


 (4)
1  max , m  max
And there is a component vi  0 , i   2,3, m  1 and a component  j  0 , j   2,3, n  1 .
According to the results of discrete division, we can obtain m  n different kinds of control input.
It is assumed that the initial position of the robot is the coordinate origin. Under different input
control input  v,   , the trajectory of the robot is different. In a certain sampling time, the robot
arrives at different position coordinates. The Euler scheme is used to solve the robot's motion
model. The calculation process is as follows

 xk 1  xk t  v  cos  k 

 yk 1  yk t  v  sin  k  (5)
   t  
 k 1 k

Where is the sample time.
t
Starting from the coordinate origin, under different input of control variables, different positions
reached by the robot can be obtained based on the iterative numerical calculation formula (5), as
shown in table 1.
Table 1. Control input-position correspondence table.
Control input Robot’s position
C1  v1 , 1  M1  x1 , y1 
C2  v1 , 2  M 2  x2 , y2 
 
Cmn  vm , n  M mn  xmn , ymn 

Look-up Criteria
The starting position of the robot is the origin of the coordinate. According to the designated
reference trajectory  xr , yr  and combined with the control input-position correspondence established
in table 1, the shortest Euclidean distance between the position of the robot under certain control
input and the desired trajectory tracking position is taken as the Look-up criterion. We can
determine the optimal control values at each moment.
296
In the current moment, the position coordinate of the robot is M 0i  x0i , y0i  , and the robot expects
to reach the position M ri  xri , yri  at the next moment, the look-up table criterion is as follows:

 2 
x  x j  xri    yi 0  y j  yri    Copt _ i
2
min  i0 (6)
 
Where j  1, 2,3, , m  n .
For the ith step, the optimal control input value Copt _ i is one of the Table 1,
C1  v1 , 1  , C2  v1 , 2  , , Cmn  vm , n   . The combination of optimal control strategies at different
moments forms the optimal control strategy Copt . The robot effectively track the desired trajectory
with constantly looking up Table I under the criteria (6).

Simulation Results
In the simulation, we chose vmax  2m / s , and max   / 4 . The discrete interval of velocity is 0.5m / s and
the discrete interval of angular velocity is  / 8 . We obtained the tracking simulation results for
straight line, sinusoidal and circle with the proposed scheme.
Tracking Straight Line
The equation of the given straight line is y  x , and the sampling time t  4s . The simulation result
was shown in figure 2.

Figure 2. Straight linear trajectory tracking.

Tracking Sinusoidal
The equation of the given sinusoidal is y  sin  x   2 , and the sampling time t  1s . The simulation
result was shown in Figure 3.

297
Figure 3. Sinusoidal trajectory tracking.

Tracking Round
The equation of the given circle is x  8sin  t  , y  8cos  t  . The sampling time t  2s . The simulation
result was shown in Figure 4.

Figure 4. Circle trajectory tracking.


From the simulation results shown in figure 2 to figure 4, we can see that the trajectory of the
robot effectively tracked the different desired trajectories (straight line, sinusoidal and circle) with
the proposed control scheme.

Conclusion
This paper presents a robot look-up table control scheme. Firstly, using the Eulerian numerical
solution to the robot kinematics model, the control-trajectory relation table under saturated
constraint condition is established. Secondly, the control table is determined according to the
proposed look-up criterion with the shortest distance. Finally, the optional control values act on the
robot to achieve trajectory tracking. Based on Matlab, the tracking simulation results of trajectories
with different characteristics of straight line, sine line and circle show the effectiveness of the
proposed algorithm.

298
Acknowledgment
This research was financially supported by the Fund of Sichuan Provincial Science & Technology
Department under Grant (No.2017FZ0010) and the Scientific Research Foundation of CUIT
(No.KYTZ201625).

References
[1] J. Kang, J. Yoo, and K. Yi, “Driving control algorithm for maneuverability, lateral stability, and
rollover prevention of 4WD electric vehicles with independently driven front and rear wheels,”
IEEE Trans. Veh. Technol., vol. 60, no. 7, pp. 2987–3001, Sep. 2011.
[2] J. Yi, H. Wang, J. Zhang, and D. Song, “Kinematic modeling and analysis of skid-steered
mobile robots with applications to low-cost inertialmeasurement-unit-based motion estimation,”
IEEE Trans. Robot., vol. 25, no. 5, pp. 1087–1097, Oct. 2009.
[3] H. Rezaee and F. Abdollahi, “A decentralized cooperative control scheme with obstacle
avoidance for a team of mobile robots,” IEEE Trans. Ind. Electron., vol. 61, no. 1, pp. 347–354,
Jan. 2014.
[4] C.H. Chiu and W.R. Tsai, “Design and implementation of an omnidirectional spherical mobile
platform,” IEEE Trans. Ind. Electron., vol. 62,no. 3, pp. 1619–1628, Mar. 2015.
[5] S. Blazic, “On periodic control laws for mobile robots,” IEEE Trans. Ind. Electron., vol. 61, no.
7, pp. 3660–3670, Jul. 2014.
[6] T. Fukao, H. Nakagawa, and N. Adachi, “Adaptive tracking control of a nonholonomic mobile
robot,” IEEE Trans. Robot. Automat., vol. 16, no. 6, pp. 609–615, Oct. 2000.
[7] W. Dixon, M. Queiroz, D. Dawson, and T. Flynn, “Adaptive tracking and regulation of a
wheeled mobile robot with controller/update law modularity,” IEEE Trans. Control Syst. Technol.,
vol. 12, no. 1, pp. 138–147, Jan. 2004.
[8] H. Yang, X. Fan, P. Shi, and C. Hua, “Nonlinear control for tracking and obstacle avoidance of
a wheeled mobile robot with nonholonomic constraint,” IEEE Trans. Control Syst. Technol., vol.
24, no. 2, pp. 741–746, Mar. 2016.
[9] A. Zhang, S. Ma, B. Li, M. Wang, X. Guo and Y. Wang, “Adaptive controller design for
underwater snake robot with unmatched uncertainties”, Sci. China Inform. Sci., vol. 59, no. 5, pp.
1-15, May, 2016.
[10] T. Yu, H. Sun, Q. Jia, H. Zhang, and W. Zhao, “Stabilization and control of a spherical robot
on an inclined plane,” Research Journal of Applied Sciences, Engineering and Technology, vol. 5,
no. 6, pp. 2289–2296, Feb 2013.
[11] L.M. Capisani and A. Ferrara, “Trajectory planning and second-order sliding mode
motion/interaction control for robot manipulators in unknown environments,” IEEE Trans. Ind.
Electron., vol. 59, no. 8, pp. 3189–3198, Aug. 2012.
[12] M.R. Soltanpour, P. Otadolajam, and M.H. Khooban, “Robust control strategy for electrically
driven robot manipulators: adaptive fuzzy sliding mode,” IET Sci. Meas. Technol., vol. 9, no. 3, pp.
322–334, May 2015.
[13] M.R. Soltanpour, M.H. Khooban, and M. Soltani, “Robust fuzzy sliding mode control for
tracking the robot manipulator in joint space and in presence of uncertainties,” Robotica, vol. 32,
no. 3, pp. 433–446, May 2014.

299
[14] T. Urg D. Dawson J. Hu and M. de Queiroz “An adaptive partial state-feedback controller for
RLED robot manipulators ” IEEE Transactions on Automatic Control, vol. 47, no. 7, pp. 1024-
1030, Jul. 1996.
[15] M.R. Soltanpour and S.E. Shafiei “Robust backstepping control of robot manipulator in task
space with uncertainties in kinematics and dynamics ” Electronics and Electrical Engineering
Journal, Automation and Robotics, vol. 96, no. 8, pp. 75-80, 2009.
[16] D. Chwa, “Fuzzy adaptive tracking control of wheeled mobile robots with state-dependent
kinematic and dynamic disturbances,” IEEE Trans. Fuzzy Syst., vol. 20, no. 3, pp. 587–593, Jun.
2012.
[17] R.J. Wai and Y.W. Lin, “Adaptive moving-target tracking control of a vision-based mobile
robot via a dynamic petri recurrent fuzzy neural network,” IEEE Trans. Fuzzy Syst., vol. 21, no. 4,
pp. 688–701, Aug. 2013.
[18] S. Dale, C. Rusu, A. Bara, and E. Szoke, “Fuzzy based reactive controller for a small mobile
robot platform,” J. Comp. Sci. Control Syst., vol. 5, no. 1, pp. 89–94, May 2012.
[19] J. Yuan, F. Sun, and Y. Huang, “Trajectory generation and tracking control for double-steering
tractor-trailer mobile robots with on-axle hitching,” IEEE Trans. Ind. Electron., vol. 62, no. 12, pp.
7665–7677, Dec. 2015.
[20] G. Brando, A. Dannier, A. D. Pizzo, R. Rizzo and I. Spina,"Generalised look-up table concept
for direct torque control in induction drives with multilevel inverters," IET Electr. Power Appl.,
Vol. 9, no. 8, pp. 556–567, 2015.

300

You might also like