Beruflich Dokumente
Kultur Dokumente
Abstract— The main objective of this study is to design an robot to move smoothly, precisely and in a stable steady state
Adaptive Neuro Fuzzy Inference System (ANFIS) algorithm to manner.
solve the problem of finding the inverse kinematics to control the
movement of the modified PUMA 560 arm in robotic system. Conventional wheeled mobile robots (WMR) have limited
and restricted way of motion because they cannot move
Accuracy and stability are two major issues that face sideways without a preliminary maneuvering. Different types
designers when control system design is intended. Tuning the of mechanisms were developed for the improvement of the
system to coup with the variations and changes in the maneuverability of WMR. Despite, the conventional WMR
environment where the system is expected to work. In this paper couldn’t offer practical solutions to precision and stability
the mechanical design of modified PUMA 560 robotic arm with 6 problems.
DoF was revisited and implemented with new powerful features
and the experimental results were tracked. The main problem is A differential drive design which has two motors mounted
the dynamic equations which are nonlinear and time-varying in in fixed positions on the left and right side of the robot has a
the extreme. The challenge was how to manipulate these known deficiency; viz. it cannot drive in all possible
equations in such a way leading to a better performance directions. For this reason, this robot is called 'non-
regarding accuracy and stability of the system. The method used holonomic'. In contrast, a holonomic robot, using omni-
to control the base of robot arm which consists of 3-wheels with directional wheels, is capable of moving in any direction.[3]
120 degrees apart was designed and implemented. After that
accurate trajectory control methods which use Adaptive Neuro
II. DYNAMICS OF OWMR
Fuzzy Inference System of 3-wheels omni-directional mobile
robot were implemented. Thus the design of full new robot The dynamics of DC motor can be described as the
system structure was used in the validation and testing the equations (1) and (2) as follow
performance of proposed methods. This included modification of
the PUMA 560 arm by the addition of an omini-directinal
wheeled mobile robot (OWMR) base structure to the robotic La
d ia + R a L a + K 3ω = E
m
arm. This base consisted of three motors for 3-wheels which are dt (1)
positioned 120 degrees apart. The resulting robot was a modified
PUMA 560 robotic arm with 6 axes. The results obtained showed
a significant improvement in both accuracy and stability of the Rf
system proposed. Hence, objectives were met to a great extent. J 0ω m + b0ω m + = k2ia (2)
n
Keywords— Dynamics of OWMR; Mobile robot; trajectory
controller; omni-directional E, ia, La, Ra are the applied armature voltage, the armature
current, the armature inductance, the armature resistance, in
the order named. K3 is the back emf constant and k2 is the
I. INTRODUCTION motor torque constant. J0 is the combined inertia of the motor,
Mobile robot have a wide range of applications in a wide gear train and wheel referred to the motor shaft and b0 is the
range of industrial applications. A wide range of these viscous friction coefficient.
applications are in manufacturing and positioning of tools,
The transfer function of the state space representation of
equipment and systems. Real world applications need the
DC motor as follow:
transfer function of DC motor =
1 ω 1 ω 2
(3) Z = Z 1 + Z 2
τs + 1 ω 1 + ω 2 ω 1 + ω 2
(4)
The value of τ is determined from the first order response of Substituting the fuzzy if-then rules into the equation 5
DC motor. below
Here the accurate trajectory control method of 3-wheels The results are as follows
omni-directional mobile robot using adaptive neuro fuzzy
inference system ANFIS based on PUMA 560 as robotic arm z1 = p1 x + q1 y + r1 (6)
is implemented. The base of hardware design system is
composed from three wheels which are arranged 120 deg (7)
apart.
z2 = p2 x + q2 y + r2
Each wheel is driven by an electric motor (DC motor)
which are connected by a shaft encoder. An embedded system Tracking analysis (Scenario No.1):
unit consisting of sensors is used for the perception of desired After rearrangement, the output can be written as a linear
location. It is controlled by specific predetermined parameters combination of the consequent parameters, [2].
with proportional- integral differentiator (PID) plus ANFIS
controller law for each motor to follow the speed and direction The values of these consequent parameters must be
command from inverse kinematics. [5] calculated to obtain the desired tracking system as shown in
table: 1.
The controller structure using specific estimator is
designed and implemented. It is combined by history data. The To complete the hardware system design the pre-process
proposed hardware design is shown in the Fig. 1 there are two stage to determine the external parameter such as the time
methods of entering data, through firstly a keypad and constant of DC motor must be implemented. From
secondly by using sensors with decoders.[4] experimental results the value of τ = 0.65 (ms)-1.
w1
= 0.5 y1
w1 + w2
w2
= 0.5 y2
w1 + w2
Since w1 = 1 & w2 = 1.
TABLE 2. The Values of Consequent Parameters