Sunteți pe pagina 1din 5

Advanced Control Algorithms for Mobile Robot

Agata Nawrocka Marcin Nawrocki


AGH University of Science and Technology AGH University of Science and Technology
Faculty of Mechanical Engineering and Robotics Faculty of Mechanical Engineering and Robotics
Department of Process Control Department of Mining, Dressing and Transport Machines
Krakow, Poland Krakow, Poland
nawrocka@agh.edu.pl marcin.nawrocki@agh.edu.pl

Andrzej Kot
AGH University of Science and Technology
Faculty of Mechanical Engineering and Robotics
Department of Process Control
Poland, Krakow
e-mail: ankot@agh.edu.pl

Abstract— Among the issues discussed in this article the main equations. Such an approach has been presented, among others,
problem concerns a neuro-fuzzy system (ANFIS) for controlling a in an academic textbook [1], in which the authors described
mobile robot, which is considered one of the methods of artificial very comprehensively the issues related to the autonomous
intelligence. The first part discusses the classical approach to control of mobile robots with the use of classical methods.
control a mobile robot. Firstly, a mathematical model was
Nevertheless, these solutions achieve their full potential when
presented describing the kinematics of a two-wheel mobile robot,
which was later used for the simulation of the proposed algorithm. there are no obstacles in the robot’s surroundings. There are two
Secondly, a method for designing an ANFIS controller was cases of undesirable objects appearing in a robot’s way: in
described with the use of reverse learning. A flowchart of learning familiar and unfamiliar environments. Having a roadmap
was presented together with a final control layout. The next part allows the use of algorithms for motion planning (Voronoi
was devoted to a detailed description of the proposed algorithm diagram, visibility diagram), which find the shortest path to the
for controlling a mobile robot. It was divided into three parts due destination. However, a problem starts to appear when the robot
to the complexity of the algorithm. Each subsection contains a is in an unfamiliar environment in which data collected from
block diagram and the description of the learning process for each the sensors constitute the sole source of information. The above
of the employed networks.
mentioned algorithms operate only and exclusively with the full
The last part features tests of the proposed solutions. At the
beginning, a comparison between the ANFIS controller and knowledge of the roadmap, and therefore, robots operating in
conventional controllers was presented. Next, a simulation unfamiliar surroundings are navigated by programmes based on
environment, in which the proposed algorithm had been tested, the behavioural patterns of insects (turn left or right in front of
was discussed. Finally, the paper presents the performance of the the obstacle) or on following the path along the nearest wall. As
mobile robot control in an unfamiliar environment with the help these methods fail to be efficient, scientists began employing
of ANFIS. soft computing techniques in robotics. Their research gave rise
Keywords—neural control, ANFIS, mobile robot, symulation to a wide range of scientific articles and books presenting many
tests, robot kinamatics. tools of artificial intelligence from fuzzy logic [2] to neuro-
I. INTRODUCTION fuzzy systems [1], [3][4][5].
Nowadays, robotics and artificial intelligence are strong II. CLASSICAL CONTROL OF THE MOBILE ROBOT
developing branches of modern science. The soft computing The classical approach to the mobile robot control is based
techniques are wide-spread in the software world and are on kinematic and dynamic equations [6]. Over the years,
employed in games, recommendation systems (social media, various algorithms were developed enabling the controlled
dedicated advertising), as well as image and natural speech robot to go around obstacles and execute its task. Before
recognition. However, the classical approach to solving design discussing the control based on the proposed algorithm, the
problems still remains popular in the field of robotics. The main general principles related to the classical approach to the
assumptions made while programming robots involve problem will first be presented.
following the trajectory or reaching the target while
circumnavigating obstacles. Most often tasks are executed
through controlling systems based on kinematic and dynamic

978-1-5090-4862-5/17/$31.00 ©2017 IEEE

412
1) Kinematics of the mobile robot. appropriate projection of the main coordinate system on the XY
axes. Finally, they take the form of equations 4 – 6.
In order to provide a description of the kinematics, a model
of a two-wheel robot with a differential drive is presented in =∫ (4)
Fig. 1. whose axis of rotation coincides with the geometric
centre. The advantage of this design is its simple mathematical =∫ dt ∙ cos (5)
model and the ability to control two independent drives.
Kinematic equations are used for the calculation of the linear = ∫V ∙ (6)
and angular displacement of the robot, which allows for a
representation of the object in space. III. MOBILE ROBOT CONTROL ALGORITHM BASED ON ANFIS
The following is the vector of the mobile robot’s location:
An ANFIS controller appears identical to a fuzzy controller,
[ , , ], where particular components represent the because they share a common feature that is fuzzy logic.
Cartesian coordinates of point P, and the rotation angle for the However, they differ when it comes to how they are designed
mobile robot in relation to the main axis of the coordinate and how they function [8]. A conventional fuzzy controller is
system. When the robot operates, the values are being updated designed entirely by an engineer [11,12]. The ranges and
with the help of kinematic equations. When the motion takes positions of the membership function are imposed a priori. In
place, linear speeds for particular wheels are determined using an ANFIS controller, the stage in which the appearance of fuzzy
equation 1. logic is shaped is performed by neural networks. The task of the
V / = / (1) designer comes down to collecting appropriate training
samples, and sometimes also to determining the imposed
where: / – the angular velocity of the wheels, number of membership functions [13,14]. However, this
respectively, the subscript specifies the left involves a significant increase in network topology, which
wheel and the right wheel, ultimately causes the learning time to grow. In order to prevent
– diameter of a circle. an unwanted expansion of the network, fuzzy clustering is often
used. Thanks to using the method of data grouping, an initial
Y structure of ANFIS is obtained with a number of membership
YR functions designated by that algorithm, and also much smaller
topology. The differences in the obtained structures are
represented by Fig. 2. One can notice that the structure
XR involving an imposed amount of membership functions grows
θ exponentially along with their increase. This effect is undesired,
b
P as it significantly extends the time of learning.

Fig. 1. Diagram of a mobile robot in a Cartesian [7]

The obtained linear speeds of the wheels are used to


designate the linear and angular speeds at point , which are
Fig. 2. ANFIS structures: a) the number of membership functions imposed a
calculated using the formulae 2 and 3. priori by the designer; b) the number of membership functions designated by
V + (2) using fuzzy clustering
V =
In his book [9], R. Jang presented a comprehensive theory
where: – the linear speed of the robot at a point P related to the adaptive neuro-fuzzy inference system (ANFIS),
– linear speed of the right wheel, as well as ways in which it can be used. One of these, among
– linear velocity of the left wheel. others, was to present different variants of controllers based on
ANFIS. The most common method of designing these
V − ( 3)
= controllers is the so-called reverse learning. The block diagram
of the learning algorithm is presented in Fig. 3.
where: – angular speeds of the robot at point , In traditional solutions, the controller for a direct current
– linear speeds of the right wheel, engine is created following the model of traditional fuzzy
– linear velocity of the left wheel, controllers, i.e. where the input consists of the error = −
– track width of a mobile robot. and the change in error = − − . However,
the flowchart of the proposed controller which was presented in
The values of the [ , , ] vector are determined by Fig. 3. is based solely on the publication. This concept assumes
calculating the integrals of the formulae 2 and 3 and then the that the inputs of the controller are: the reference signal ,

413
which in this case is the target engine speed, and the response error amounted to around 0.087 in both cases. The final shape
of the system . of the membership function is shown inFig. 6. and Fig. 7. As is
Part of the navigation algorithm for the mobile robot evident, their shape after learning does not differ too much
responsible for circumventing obstacles consists of two neuro- compared to the original settings. This is due to the use of fuzzy
fuzzy networks. Inputs of both structures are readings of three clustering, which in itself can initially estimate the groups of
distance sensors, while the outputs are speeds of engines, with samples which are included in the grouped data.
the stipulation that each of them is responsible for a different
actuator.
In order to train these structures, collecting appropriate
samples was necessary. For this purpose, various obstacle
variants that occur in the robot’s environment were created in a
simulation programme. The result of the simulation was
collecting 30 training data.
The structure training was carried out using the Fuzzy Logic
Toolbox of MATLAB/Simulink. Initially, a method imposing
the number of membership functions was used. The training
process was carried out for a triangular, bell and Gaussian
membership functions and respectively for the numbers Fig. 5. Network structure adapted to circumnavigate obstacles
[ , , ], [5,5,5] and [7,7,7]. After 100 iterations, the training
error for all cases [ , , ] equalled 0.88. For the remaining When compared to previous attempts, a much bigger ratio
variants, depending on the type of the membership function, it of difference in network responses to training values was
amounted to . One might think that such network obtained. However, as will be shown later, this error allowed to
performance should be satisfactory, but during testing it was achieve the ability to generalise decisions taken by the robot in
found that the algorithm does not have the ability to generalise, an unknown environment. The algorithm is able to determine
and thus the robot could not move about in an environment with what speed the robot should apply in any setting of obstacles
obstacles. and itself.
u(k) y(k+1)
Obiekt
+

- ANFIS
y(k)
z −1
Identyfikator

Fig. 3. Block diagram presenting reverse learning Fig. 6. ANFIS network membership functions of the left engine

As the results obtained through the method involving an


imposed number of membership functions proved
unsatisfactory, fuzzy clustering was used in order to obtain the
initial structure of an inference system. Fuzzy clustering was
carried out for each speed with the same training data assumed
as input. As a consequence, identical results were obtained for
both, i.e. twelve initial membership functions which can be seen
in Fig. 4. The structure of the network was presented in Fig. 5. Fig. 7. ANFIS network membership functions of the right engine

A. Simulation and analysis of the algorithm


So far, only theoretical information concerning the
presented control of the mobile robot was presented. A
comparison of the ANFIS controller and other controllers is
presented below.
B. Comparison of controllers
Fig. 4. The initial shape of membership functions respectively for the In order to design the controller, what is required is training
inputs of the left, middle, and right sensors
data corresponding to two inputs and one output. Their
Next, the obtained initial models of fuzzy inference were acquisition was carried out in Simulink. The next stage
subjected to a training process for 100 epochs. The training consisted in carrying out training based on the collected

414
samples. For this purpose, again a tool in the Fuzzy Logic not unequivocal. On the one hand, the application of ANFIS or
Toolbox was used. This time, the best results were achieved other AI techniques allows to reach the destination in a
when using the method involving an imposed number of collision-free way in an unfamiliar environment, but on the
membership functions. In order to design the controller, three other hand, traditional algorithms can achieve similar results.
triangular membership functions were used. The training was The biggest problem during the design of an adaptive neuro-
carried out in 100 epochs, however after a few iterations the fuzzy inference system turned out to be collecting appropriate
network had already reached the global minimum, which is training samples. The most common effect of this was the
evidenced by a constant error rate at the level of the overtraining of the network, which resulted in that the control
0.00312851. The final result is a plane of the ANFIS system, did not work at all, because it could not orient itself in an
which was presented in Fig. 8. environment other than the one from which the training data
had been obtained.
Despite the problems that arose in the course of designing
the control, further work will be carried out in order to apply
other artificial intelligence techniques. What is also considered
is the use of swarm algorithms and neuroevolution networks in
robotics.
ACKNOWLEDGMENT
Scientific research was financed from AGH, WIMiR Statute
Work: 11.11.130.958.
REFERENCES
[1] Nourbakhsh, I. R., & Siegwart, R. (2004). Introduction to autonomous
Fig. 8. Plane of the ANFIS controller
mobile robots. The MIT Press, Cambridge, Massachusetts, England,
ISBN 0, 262(19502), 142-150.
Once the ANFIS controller is ready, one can compare its [2] Hendzel, Z., & Muszyńska1b, M. (2012). Neuronowo-rozmyte systemy
characteristic features with other controllers. To this end, a sterowania mobilnym robotem kołowym.
traditional PID-type controller was designed, the difference [3] Mohanty, P. K., & Parhi, D. R. (2014). A New Intelligent Motion
being that the settings were selected by a Simulink Design Planning for Mobile Robot Navigation using Multiple Adaptive Neuro-
Optimisation tool using the method of the steepest descent. The Fuzzy Inference System. Applied Mathematics & Information Sciences,
8(5), 2527.
main assumption when shaping the response was the shortest
[4] Al-Mayyahi, A., Wang, W., & Birch, P. (2014). Adaptive neuro-fuzzy
time of adjustment, that is: one which is closest to the ANFIS technique for autonomous ground vehicle navigation. Robotics, 3(4), 349-
controller. 370.
A comparison of the response of the ANFIS controller with [5] Algabr, M., Mathkour, H., & Ramdane, H. (2014). Mobile robot
a PID controller and the response of an open system is presented navigation and obstacleavoidance using ANFIS in unknown environment.
International Journal of Computer Applications, 91(14), 15952-5400.
in Fig. 9. What is important is the small static error of the
[6] Tahboub, K. K., & Al-Din, M. S. (2009). A neuro-fuzzy reasoning system
system with the proposed controller, although it is acceptable for mobile robot navigation. JJMIE, 3(1), 77-88.
and equals approximately 2.5%. One can also see significant [7] Bartyzel, G.(2015) Sterowanie robotem mobilnym z wykorzystaniem
differences in the time of adjustment between the various ANFIS. Praca dyplomowa, Kraków.
responses. For the open system the adjustment time equals 0.3 [8] Pramonohadi, S. (2013, November). A comparative study of PID, ANFIS
[s], for PID it equals 0.15 [s], while for ANFIS it is 0.01 [s]. and hybrid PID-ANFIS controllers for speed control of Brushless DC
Motor drive. In Computer, Control, Informatics and Its Applications
(IC3INA), 2013 International Conference on (pp. 117-122). IEEE.
[9] Jang, J. S. R., Sun, C. T., & Mizutani, E. (1997). Neuro-fuzzy and soft
computing; a computational approach to learning and machine
intelligence.
[10] MathWorks, Inc, & Wang, W. C. (1998). Fuzzy Logic Toolbox: for Use
with MATLAB: User's Guide. Mathworks, Incorporated.
[11] Nawrocki, M., & Nawrocka, A. (2014, May). Artificial neural networks
for identification in real time of the robot manipulator model parameters.
In Proceedings of the 2014 15th International Carpathian Control
Conference (ICCC).
[12] Nawrocka, A., Nawrocki, M., & Kot, A. (2014, May). Fuzzy logic
controller for rehabilitation robot manipulator. In Control Conference
Fig. 9. Comparison of the responses of control systems (ICCC), 2014 15th International Carpathian (pp. 379-382). IEEE
[13] Bielecki A., Bielecka M., Ernst S. (2016). Proposal of intelligent,
IV. CONCLUSION predictive fuzzy controller for off-grid devices. IFAC Papers Online, 49-
25, 523-528.
The main concept behind the presented results was to
[14] Bielecki A., Lenart M., (2016). Neural system for power load prediction in
examine whether artificial intelligence techniques are able to a week time horizon. Lecture Notes in Artificial Intelligence, vol., 9692,
replace the navigation algorithms which are widely used in 25-34.
robotics to control mobile robots. The answer to this question is

415
416

S-ar putea să vă placă și