You are on page 1of 5

26th Iranian Conference on Electrical Engineering (ICEE2018)

Self-Tuning Fuzzy PID Control of a Four-Mecanum


Wheel Omni-directional Mobile Platform
Ehsan Malayjerdi Hadi Kalani Mohsen Malayjerdi
Master of Science in Artificial Intelligence Assistant Professor Master of Science in Mechanical
Islamic Azad University, Mashhad Branch Department of Mechanical Engineering Engineering
Mashhad, Iran Sadjad University of Technology Ferdowsi University of Mashhad
Email: malayjerdi@gmail.com Mashhad, Iran Mashhad, Iran
Email: kalani@sadjad.ac.ir Email: mohsen.ciw@gmail.com

Abstract— In this paper we restrict our attention to self-tuning proposed a trajectory tracking and heading adjustment systems
control of a four-Mecanum mobile robot and present detailed of a Mecanum wheel robot using fuzzy logic controller (FLC)
kinematics and controller architecture of a robot. Since the and inertia measurement unit (IMU) sensor. They showed that
Mecanum wheels worked based on slipping, therefore, its wheels the FLC system and the IMU sensor provide a robust navigation
may slip due to various floor conditions. During such a slip
scheme for Mecanum wheel robot. Tsai et al. [14] suggested a
condition, Mecanum wheeled robot moves in unexpected path. In
order to reduce this error, four incremental encoders are utilized. nonsingular terminal sliding mode control using fuzzy wavelet
Then the fuzzy PID controller is described. This proposed networks for trajectory tracking of a Mecanum wheel robot.
controller can be implemented in microcontroller easily. Finally, Viboonchaicheep et al. [15] used a novel methodology of
the merit of the controller is investigated experimentally. Results position rectification for Mecanum-wheeled omni-directional
show that the Self-Tuning Fuzzy PID Control and encoder sensors vehicles. They used the formulation of unique kinematics
provide a reasonable structure for Mecanum wheel robot. equation, dynamics equation and state equation. Chang et al.
[16] derived nonlinear stable adaptive control law based on
Keywords- Fuzzy Logic Controller, self-tuning controller, complete dynamics model of a four-Mecanum-wheeled robot
Mecanum Wheeled Robot.
using the back stepping method via Lyapunov stability theory.
I. INTRODUCTION The rest of the manuscript is organized as follows. In
Section II, the SADJAD robot I is introduced and the kinematic
Nowadays, Omni-directional mobile robots have been
model of it is determined. Then the self-tuning control is
developed for research purposes and played main role in both
described in Section III. Section IV presents several
academia and industry [1 and 2]. In comparison with many
experimental results which show the effectiveness and merit of
kinds of omnidirectional wheels, Mecanum wheels have been
the proposed methods. Section V concludes the paper with
shown more to be effective in driving vehicles to achieve Omni-
remarks and suggestions for future works.
directional capability. These wheels are utilized in service robot
such as intelligent wheelchairs, nursing-care robots and mobile
manipulator [3-6]. In spite of the advantage such as the II. FOUR-MECANUM WHEEL OMNI-DIRECTIONAL MOBILE
omnidirectional motion property, the Mecanum wheel has the PLATFORM
unavoidable vibration due to its structural shape [7-9]. These
vibrations can reduce the positioning accuracy. However, new A. SADJAD Mobile Robot I
applications in Mecanum wheels cause they are demanding SADJAD mobile robot I, shown in Fig. 1a, is the first
more due to its additional maneuverability and efficiency. generation Omni-directional mobile platform designed in the
Generally the Mecanum wheel is constructed from several SADJAD Robotics Research Center. It is made of four
passive rollers, forks, and a hub or disk. The hub is connected Mecanum Wheel. Each Mecanum wheel is operated by BLDC
to the actuating motor. It supports the forks and rollers. The motor. The robot in its fully flat configuration has width 300
passive rollers generate the driving force by the contact with the mm, height 60 mm and length 500 mm. The overall weight of
ground. These features are gained at the expense of increased the robot, including all motors and all other components is 4.6
mechanical complexity (kinematics and dynamics analysis) and kg. The locomotion algorithms are implemented in a micro-
increased complexity in control. The issues of kinematics and controller, STM32F4 discovery. The mentioned components
dynamics of Mecanum wheel are studied in [10-11]. These are shown in Fig. 1b, schematically.
mathematical models will be utilized to achieve optimum
control of the mobile robot as a service robot [12]. When the
robot moves, the wheels often slip. During such slips, the real
position and orientation deviate from the planned. To overcome
this problem, many researches attempt to detect the slippage
and control the robot position [13-16]. Fahmizal et al. [13]

978-1-5386-4916-9/18/$31.00 ©2018 IEEE

816
26th Iranian Conference on Electrical Engineering (ICEE2018)

(a)

Fig. 2. Kinematics of mobile robot

Rw    
vx 3
4 
g1 ! g 2 ! g 3 ! g 4 
R
4 
v y 3 w #g1 ! g2 ! g3 # g4 
Rw
mz 3
4(L !W ) 
#g1 ! g2 # g3 ! g4 
(1)
or

¾ Î ¾1 1 #(L !W ) Î
¿g1 Ï ¿ Ï ¾v x Î
¿g Ï 1 ¿1 # 1 ( L !W ) Ï ¿ Ï
¿ 2Ï 3 ¿ Ï ¿v y Ï
¿g Ï Rw ¿1 #1 #(L !W ) Ï ¿ Ï
¿ 3Ï ¿ Ï ¿m z Ï
¿g4 Ï ¿1 1 ( L !W ) Ï À Ð
(b) À Ð À Ð
Fig. 1. Mecanum wheel Robot. (a) The overall view of the constructed
robot and (b) The detail view of key components of the mobile robot
Where Rw is radius of Mecanum wheel and gi (i 3 1, 2,..., 4)
B. Vehicle Kinematics is the angular velocity of the wheel. Moreover, L and W are the
A Omni-directional mobile robot consisting four Mecanum distances between wheel axis and body center of the robot. See
wheel is depicted in Fig. 2. To define a kinematics model for the Fig. 2. The values of v x , v y and m z indicate the generalized
robot, we attach a coordinate system to center of the robot. The
velocity of the center point of the robot. The number of each
inverse kinematics (IK) equations are employed to obtain the
wheel shows in parentheses.
needed angular speed of each motor to achieve desired motion
of the Mecanum wheel mobile platform. Although, the direct III. CONTROL SYSTEM ARCHTITECTURE
kinematics (DK) equations are utilized to determine path of the
robot based on the specified rotational speeds of the motors. The A. Overall system Architucture
IK and DK of the Mecanum robot are obtained by Eq. (1). The Figure 3 indicates the proposed structure of the self-tuning
details are reported in [15]. Here, for convenience, the contact
fuzzy PID controller. The feedback error e(t) and the derivative
between the wheel and the supporting plane is characterized by
of error de(t)/dt are the two inputs to the fuzzy logic inference
the condition that the wheel is rolling without slip.
engine. The main three PID Coefficients ( K p , K i and K d ) are
adjusted by using fuzzy map, which provide a nonlinear
mapping from the error and derivative of error to PID
parameters.
B. Self-Tuning Fuzzy PID Controller
Fuzzy PID control is a kind of nonlinear control which has
the advantages of both fuzzy control and PID control. In this
paper the PID coefficients are adjusted by fuzzy logic.

817
26th Iranian Conference on Electrical Engineering (ICEE2018)

Fundamentally, fuzzy rules play a key role in fuzzy control due


to the direct effects for fuzzy inferences. Here, these rules
designed are based on the characteristics of the Mecanum wheel
and properties of the PID controller. The ranges K p and K d
are described in ¾ÀK p ,min , K p ,max ÎÐ and ¾ Î
ÀK d ,min , K d ,max Ð ,
respectively. These ranges are determined experimentally with
trial and error. The K p and K d parameters are normalized (a)

into the range between zero and one as follow

 
K pw 3 K p # K p ,min / K p ,max # K p ,min  (2)
K w 3 K
d d # K d ,min  / K d ,max # K d ,min 
The integral gain constant is determined by
K i 3 K p2 / W K d  (3)
(b)
In this study, we assume W 3 1 . The parameters K pw and K dw Fig. 4. Membership functions for (a) e ( k ) and (b) de (k ) / dt

are defined as a set of fuzzy rules of the form

if e ( k ) is A i and de (k ) / dt is B i , then K pw is
(4)
C i and K dw is D i , i=1,2,…,m.

Where A i , B i ,C i and D i are fuzzy sets. The membership


functions (MF) of e ( k ) and de (k ) / dt are indicate in Fig. 4a
and 4b, respectively. Here, N represents negative, P positive,
ZO approximately zero, S small, B big. Thus NS used for
negative-small, PB for positive big, and so on. The fuzzy sets
C i and D i are either Big or Small and are indicated by the Fig.5. Membership functions for K wp and K dw [17]

membership functions shown in Fig. 5.


To achieve the reference trajectory, a total of twenty five
rules are defined for K pw and K dw in TABLE I and TABLE II,
respectively. These rules make the relation between error and
derivation of error in terms of linguistic values. The firing value
of the ith rule, ci , in Eq. (4), is obtained by the product of the
MF values in the antecedent part of the rule:

c i 3 c Ai [e (k )]¬ c Bi [de (k ) / dt ] (5)

where c A i and c Bi are the MF value of the fuzzy set of A i


and B i which given a value of e ( k ) and de (k ) / dt ,
respectively. Then Based on ci , the values of K pw and K dw , for
each rule are obtained from their corresponding MFs. The
implication process of a fuzzy rule is described in [17]. Next,
the defuzzification yields the following:
Fig. 3. Block diagram of fuzzy PID control scheme n
K pw 3 ºc K w
i 31
i pi
(6)
n
K dw 3 ºc K w
i 31
i di

818
26th Iranian Conference on Electrical Engineering (ICEE2018)

w and K diw
Where K pi are the value of K pw and K dw
corresponding to the ci for ith rule, respectively. Finally, the
PID parameters calculated from the Eq. (2). All mentioned
process is prepared in STM32 discovery. This experimental
applied to microcontroller using the C programming. In
programming the microcontroller used a methodology that is
described in [18].

TABLE I. FUZZY RULE TABLE FOR VARIABLE K wp


ࢋሶ
NB NS ZO PS PB
NB B B B B B
NS S B B B S
e ZO S S B S S Fig. 6. The schematic map for robot navigation
PS S B B B S
PB B B B B B

TABLE II. FUZZY RULE TABLE FOR VARIABLE K dw


ࢋሶ
NB NS ZO PS PB
NB S S S S S
NS B B S B B
e ZO B B B B B
PS B B S B B
PB S S S S S

IV. SIMULATION, EXPERMIMENT AND DISCUSSION


This section presents the ability of proposed fuzzy-PID
controller on robot motion according to the trajectory in Fig.6.
To approach desired velocity, in this study, each wheel control
separately based on self-tuning controller. The actual error,
taken as the difference between desired angular velocity of each
wheels and the corresponding actual one (Eq. 6), and the delta
error, taken as the difference between current and previous
errors, are used as fuzzy logic inputs.
e i 3 gi ,act # gi ,des , i 3 1, 2,..., 4 (6)

where i is the number of wheel, gi ,act and gi ,des are the
actual and desired angular velocity of ith wheel, respectively.
Figure 6 shows the schematic path of mobile robot to
approach its destination. The number in each figure shows the
order of the movement. From number 0 to 1 and 3 to 4, the robot Fig. 7. Angular velocity of each wheel. The m i indicates the angular
moves toward. From number of 1 to 2 and 6 to 7, it changes its velocity of ith wheel.
orientation without transfer. From 2 to 3 and 4 to 5, the robot
moves diagonally. Finally from 5 to 6 and 7 to 0, it moves in Based on Eq. (1), the reference velocity of mobile robot is
side direction. The desired angular velocity in whole simulation obtained during experiment as Fig. 8. This figure shows, when
is 2.5 rad/s. To reach this navigation, the angular velocity of the only PID is used, there are significant errors between
each of Mecanum wheel changed as Fig. 7. The corresponding desired and real velocities in during experiments. But slight
number of each wheel indicates in Fig. 2, in parenthesis. errors during the motion are happened by using Fuzzy PID. As
it is expected, the maximum errors are happened when the
velocity of wheels are changed. Therefore, results demonstrated
that Fuzzy PID method is better controller than conventional
PID methodology to approach the mobile robot navigation.

819
26th Iranian Conference on Electrical Engineering (ICEE2018)

[2] J.B. Song and K.S. Byun, “Design and control of a four-wheeled
omnidirectional mobile robot with steerable omnidirectional wheels,”
Journal of Robotic Systems, vol. 21, no. 4, pp. 193–208, 2004.
[3] J. Kim, S. Woo, J. Kim, J. Do, S. Kim, and S. Bae, “Inertial navigation
system for an automatic guided vehicle with mecanum wheels,”
International Journal of Precision Engineering and Manufacturing, vol.
13, no. 3, pp. 379–386, 2012.
[4] J. W. Kang, H. S. Hong, B. S. Kim, and M. J. Chung, “Assistive mobile
robot systems helping the disabled workers in a factory environment,”
International Journal of Assistive Robotics and Mechatronics, vol. 9, no.
2, pp. 42–52, 2008.
[5] J. W. Kang, H. S. Hong, B. S. Kim, and M. J. Chung, “Assistive mobile
robot systems helping the disabled workers in a factory environment,”
International Journal of Assistive Robotics and Mechatronics, vol. 9, no.
2, pp. 42–52, 2008.
[6] M. de Villiers and N. S. Tlale, “Development of a Control Model for a
Four Wheel Mecanum Vehicle,” Journal of Dynamic Systems,
Measurement, and Control, vol. 134, 2010,
[7] R. Holmberg and O. Khatib, “Development and control of a holonomic
mobile robot for mobile manipulation tasks,” International Journal of
Robotics Research, vol. 19, no. 11, pp. 1066–1074, 2000.
[8] A. Gfrerrer, “Geometry and kinematics of the mecanum wheel,”
Computer Aided Geometric Design, vol. 25, no. 9, pp. 784–791, 2008.
[9] L. Ferrière, B. Raucent, and G. Campion, “Design of omnimobile robot
wheels,” in Proceedings of the IEEE International Conference
Proceedings on Robotics and Automation, vol. 4, pp. 3664–3670,
Minneapolis, Minn, USA, April 1996.
[10] C.C.Tsai, F. C.Tai, Y. R. Lee, “Motion controller design and embedded
realization for mecanum wheeled omnidirectional robots,” In Proceedings
of the 8th World Congress on Intelligent Control and Automation (pp.
546–551). Taipei, Taiwan, 2011.
Fig. 8. Linear and angular velocities of Mecanum wheel
[11] G. Wampfer, M. Salecker, J. Wittenburg, “Kinematics, dynamics, and
control of omnidirectional vehicles with mecanum wheels,” Mechanics
V. CONCLUSION Based Design of Structures and Machines, 17(2), pp. 165–177, 1989.
In this study, a self-tuning controller is used to achieve [12] N. Tlale, M. de Villiers, “Kinematics and Dynamics Modelling of a
navigation and stable motion of a Mecanum wheel robot. To do Mecanum Wheeled Mobile Platform,” Mechatronics and Machine Vision
in Practice 2008. M2VIP 2008. 15th International Conference on, pp. 657-
this, a fuzzy proportional integral derivative (PID) is employed 662, 2–4 Dec. 2008.
which gains of PID can be tuned by implementing the fuzzy [13] Fahmizal, C. H. Kuo, “Trajectory and heading tracking of a mecanum
rules. The proposed controller is evaluated using a map for wheeled robot using fuzzy logic control, ” International Conference on
Mecanum wheel robot navigation. Result showed the Fuzzy- Instrumentation Control and Automation (ICA), pp. 54-59, 2016
PID method is capable of guaranteeing the robot to achieve [14] C. C. Tsai, and H.-L. Wu, “Nonsingular Terminal Sliding Control Using
stabilization and trajectory tracking. The study of controller for Fuzzy Wavelet Networks for Mecanum Wheeled Omni-directional
Vehicles,” Proc. of the 2010 IEEE International Conference on Fuzzy
Mecanum wheel robot is significant as it can be employed in Systems, Barcelona, Spain, 18-23 July 2010.
many applications like narrow spaces or crowded environments [15] P. Viboonchaicheep, A. Shimada, Y. Kosaka, “Position Rectification
such as hospitals and elderly care facilities. Control for Mecanum Wheeled Omni-directional Vehicles,” Proceedings
Our main contribution is to investigate a fuzzy gain the 29th Annual Conference of the IEEE Industrial Electronics Society,
Roanoke, VA, USA, pp. 854-859, 2003.
scheduling method of PID controller for Mecanum wheel robot.
[16] L. Lih-Chang and S. Hao-Yin, “Modeling and adaptive control of an
In the future, we will plan to use this robot in augmented reality omni-mecanum-wheeled robot,” Intelligent Control and Automation,
(AR) by employing the proposed controller. We will develop a vol.4, no.2, p.166-179, 2013.
path following algorithm that allows the Omni-directional [17] Z. Y. Zhao, M. Tomizuka, S. Isaka, “Fuzzy gain scheduling of PID
mobile robot to autonomously navigate to a desired location as controllers,” IEEE Trans. Syst. Man Cybern., vol. 23, pp. 1392-1398,
it is commanded by a user through an AR interface. Sept. 1993.
[18] Indra Sakti, “Methodology of Fuzzy Logic with Mamdani Fuzzy Models
REFERENCES applied to the microcontroller,” International Conference on Infonnation
Technology Computer and Electrical Engineering (ICIT ACEE), 2014.
[1] K.S. Byun and J.B. Song, “Design and construction of continuous
alternate wheels for an omnidirectional mobile robot,” Journal of Robotic
Systems, vol. 20, no. 9, pp. 569–579, 2003.

820

You might also like