8 views

Uploaded by Umer_Farooq_1557

- controlsystems
- The International Journal of Computational Science, Information Technology and Control Engineering (IJCSITCE)
- Shen Li Resume.pdf
- 04b-Jaffe
- The Design of Reduced Order Controllers for the Stabilization of Large Scale Linear Discrete-Time Control Systems
- English Robot Script 2 - KumaBearMan
- IJCCSCE
- 2014 Editorial
- Reference Tracking Control of Hypersonic Vehicles Using Switched Linear Parameter-Varying Approach _IEEE
- Treesa s1 Seminar
- Robotics Engg Intro
- CHE 404 Fall 2014 Detailed Syllabus
- IJCSITCE
- Designing Sociable Robots - Cynthia L Breazeal
- Robotics
- 1-s2.0-S0888327017305654-main
- Jurnal Rev asdaper Translating
- Asimov Worksheet
- Adaptive Control Tutorial -SIAM
- GetTRDoc[1]

You are on page 1of 5

Using Fuzzy Azimuth Estimator

2

Division of Electrical Electronic and Control Engineering, Kongju National University

3

Department of Computer Engineering, Seokyeong University

1

Department of Electrical and Robotics Engineering, Soonchunhyang University, KOREA

seungwo@sch.ac.kr

Abstract: - Home service robot are not working in the fixed task such as industrial robot, because they are together with

human in the same indoor space, but have to do in much more flexible and various environments. Most of them are

developed on the base of the wheel-base mobile robot in the same method as a vehicle robot for factory automation. In

these days, for holonomic system characteristics, omni-directional wheels are used in the mobile robot. A holonomic

robot, using omni-directional wheels, is capable of driving in any direction. But trajectory control for omni-directional

mobile robot is not easy. Especially, azimuth control which sensor uncertainty problem is included is much more

difficult. This paper develops trajectory controller of 3-wheels omni-directional mobile robot using fuzzy azimuth

estimator. A trajectory controller for an omni-directional mobile robot, which each motor is controlled by an individual

PID law to follow the speed command from inverse kinematics, needs a precise sensing data of its azimuth and exact

estimation of reference azimuth value. It has imprecision and uncertainty inherent to perception sensors for azimuth. In

this paper, they are solved by using fuzzy logic inference which can be used straightforward to perform the control of the

mobile robot by means of the fuzzy behavior-based scheme already existent in literature. Finally, the good performance

of the developed mobile robot is confirmed through live tests of path control task.

Key-Words: -Omni-Directional Mobile Robot, Holonomic System, Tracking, Azimuth, Fuzzy Inference, Gyro-Sensor

Mobile robot has great applicable potential in human growing attention among the mobile robotics researchers.

society in the future. The functions will no longer be [1,2,3] In this paper, a Swedish OWMR is, with a

restricted to accomplish tasks in assembly and proposal of new control algorithm, developed as a

manufacturing at a fixed position. In order to accomplish holonomic mobile robot.

practical tasks, a mobile robot has to be navigated The trajectory control of OWMR is so difficult because

smoothly in the real world wherein unexpected changes it has much more uncertainty than conventional WMR.

take place. Conventional wheeled mobile robot(WMR) is The dynamic equation is nonlinear and time-varying in

restricted in their motion because they cannot move the extreme. Thus, this paper presents accurate trajectory

sideways without a preliminary maneuvering. Various control method of 3-wheels omni-directional mobile

mechanisms have been developed to improve the robot using fuzzy azimuth estimator. The OWMR of this

maneuverability of WMR. But they have never made the paper has three omni-directional wheels, arranged 120

conventional WMR overcome the problem of deg apart. Each wheel is driven by a DC motor installed

non-holonomic system. For example, a differential drive with an optical shaft encoder. A gyro sensor is used for

design which has two motors mounted in fixed positions the perception of azimuth. It is controlled by independent

on the left and right side of the robot. Then, the PID law for each motor to follow the speed command

differential wheel drive has a kind of deficiency. It cannot from inverse kinematics without considering the coupled

drive in all possible direction. For this reason, this robot nonlinear dynamics explicitly in the controller design. A

is called 'non-holonomic'. In contrast, a holonomic robot, trajectory controller for an omni-directional mobile robot

using omni-directional wheels, is capable of driving in needs a precise sensing data of its azimuth and exact

any direction. In the last few years, Swedish omni- estimation of reference azimuth value. It has imprecision

and uncertainty inherent to perception sensors for

Proceedings of the 10th WSEAS Int. Conference on ROBOTICS, CONTROL and MANUFACTURING TECHNOLOGY

aliasing. The uncertainty consists of disturbance and slip In the body frame and by Newton’s law, we can have

of mobile robot. In this paper, they are solved by using é1 ù

fuzzy logic inference which can be used straightforward ê 0 0ú

to perform the control of the mobile robot by means of the éu& ù é rv ù ê m F

úé u ù

ê v& ú = ê- ru ú + ê 0 1

fuzzy behavior-based scheme already existent in

ê ú ê ú ê 0 ú ê Fv úú

ê (1)

literature. An azimuth estimator is designed by m ú

êë r& úû êë 0 úû ê 1 ú êë FN úû

Mamdani-typed fuzzy inference method. Also, it is 0 0

perfectly implemented on the 3-wheels OWMR êë m úû

developed in this paper.

The paper is organized as follows: the kinematics model From the force analysis in the body frame, we have

for a 3 Swedish wheeled mobile robot is derived in the

Section II. The tracking control algorithm and the fuzzy

azimuth estimator are explained in Section III. éu& ù é rv ù é f1 ù

Experimental results of the trajectory controller are ê v& ú = ê- rv ú + H × B ê f ú (2)

ê ú ê ú ê 2ú

reported and live test results of 3-wheels ODMR are êë r& úû êë 0 úû êë f 3 úû

given, in Section IV. At last, some concluding remarks

are addressed in Section V. Where,

é1 ù

êm 0 0ú

2 Dynamics of OWMR é 0 cos d - cos d ù

ê ú, ê- 1 sin d

As a first step to develop a robot controller, the equations H =ê0

1

0ú B = ê sin d úú

of robot motion need to be derived. Several simplifying ê m ú êë L L L úû

ê0 1ú

assumptions are made. For example, it is assumed that êë 0

m úû

there is no slip in all the three wheels, and the friction

force is simplified to be represented by a viscous friction

coefficient. Electrical time constant of the motor is also From geometry of 3-wheels OWMR in Fig. 1, we have

neglected. It is expected that the feedback controller

based on this simplified model can compensate the éu ù éw m1 ù

êv ú = B T Rê

( ) w m 2 úú

-1

unmodeled dynamics. There are two coordinate frames (3)

used in the modeling: the body frame and the world frame. ê ú n ê

The body frame is fixed on the moving robot with the êë r úû êëw m 3 úû

origin in the center of chassis, the world frame is fixed on

the play ground, and symbols used in OWMR dynamic The dynamics of each DC motor can be described as

model is listed, as shown in Fig. 1.[3] equation (4) and (5).

dia

La + R a i a + k 3w m = E (4)

dt

Rf

J 0w m + b0w m + = k 2 ia (5)

n

E , ia , La , Ra is the applied armature voltage, the

armature current, the armature inductance, the armature

resistance, in the order named. k 3 is the back emf

constant and k 2 is the motor torque constant. J 0 is the

combined inertia of the motor, gear train and wheel

referred to the motor shaft and b0 is the viscous friction

coefficient.

Because the electrical time constant of the motor is

very small comparing to the mechanical time constant,

we can neglect dynamics of the motor electric circuit,

which leads to La dia = 0 and ia = 1 (E - k 3w n ) . From those,

Fig. 1. Force Analysis and Nomenclature dt R

we can derive the dynamics of the three identical motors.

Proceedings of the 10th WSEAS Int. Conference on ROBOTICS, CONTROL and MANUFACTURING TECHNOLOGY

éw& m1 ù éw m1 ù é f1 ù The state and output equations (6) and (7) are

ê ú ê ú Rê ú described in the absolute coordinate system. It should be

&

J 0 êw m 2 ú + b0 êw m 2 ú + ê f 2 ú

n noted, however, that the control input is the quantity in

êë w& 3 úû êëw m 3 úû êë f 3 úû (6) the moving coordinate system. Therefore, the control

é E1 ù éw m1 ù input in the absolute coordinate system must be

k 2 ê ú k 2 k3 êw ú transformed into the control input for each assembly, i.e.,

= E2 -

Ra ê ú Ra ê m2 ú signal expressed in the moving coordinate system, if the

êë E3 úû êëw m 3 úû

control input is designed in the absolute coordinate

From combination of the upper equations, we get the system. Then, the transformation for each input can be

dynamic model of the mobile robot in the body frame derived from kinematics as follows.

with the applied motor voltage E1 , E 2 , E 3 as shown in

equation (7).

é x& ù écosy (k ) - siny (k ) 0ù éu ù

ê y& ú = ê siny (k ) cosy (k ) 0ú ê v ú (8)

éu& ù é rv ù ê ú ê úê ú

ê v& ú = G -1 ê- rv ú - G -1 HBBæç k 2 × k 3 + b ö÷ êëy& úû êë 0 0 1úû êë r úû

ê ú ê ú ç R 0÷

êë r& úû êë 0 úû è a ø

(7) A trajectory controller for an omni-directional mobile

éu ù é E1 ù robot needs a precise sensing data of its azimuth and

n2 ê ú k n êE ú exact estimation of reference azimuth value. It has

´ 2 ê v ú + G -1 HB 2 ê 2ú imprecision and uncertainty inherent to perception

R R × Ra

êë r úû êë E3 úû sensors for azimuth. The imprecision is made by sensor

2 noise and aliasing. The uncertainty consists of

Where, G = æç I + HBB T n J 0 ö÷ disturbance and slip of mobile robot. As we can see in Fig.

ç R2 ÷

è ø 2, they are solved by using fuzzy logic inference which

can be used straightforward to perform the control of the

3 Tracking Control and Fuzzy Estimator mobile robot by means of the fuzzy behavior-based

This section represents accurate trajectory control scheme already existent in literature. The new

method of 3-wheels omni-directional mobile robot using enhancement azimuth is derived as equation (9).

fuzzy azimuth estimator. The OWMR of this paper has

three omni-directional wheels, arranged 120 deg apart. y d¢ (k + 1) = y d (k + 1) + K FG (y d (k ) -y gyro (k )) (9)

Each wheel is driven by a DC motor installed with an

optical shaft encoder. A gyro sensor is used for the y d (k ) is the kth azimuth angle computed from

perception of azimuth. It is controlled by independent

trajectory planning, y gyro (k ) is the kth output of gyro

PID law for each motor to follow the speed command

from inverse kinematics without considering the coupled sensor and y d¢ (k + 1) is new value of the (k+1)th

nonlinear dynamics explicitly in the controller design. azimuth. Its gain KFG is in real-time tuned by fuzzy

The controller structure using fuzzy azimuth estimator is azimuth tuner of Fig. 3.

shown in the Fig. 2.

Mamdani’s inference engine is used in fuzzy azimuth

tuner. Input signal is change rate of error between desired

azimuth and gyro/encoder sensors. Output is gain of

azimuth estimator KFG . Fuzzy rule base of linguistic

Fig. 2. The Tracking Control Structure variables is given in Table 1.

Proceedings of the 10th WSEAS Int. Conference on ROBOTICS, CONTROL and MANUFACTURING TECHNOLOGY

Table 1. Fuzzy Rule Base measurement of the rotation speed of DC motors and

Gyro sensor measures the posture angle of OWMR.

Change Rate y ge&

of Error NE ZE PE

NE PB PS NS

y ee& ZE PS ZE NS

PE PS NS NB

designed through partitioning technique of experimental

data from gyro and encoder sensors. They are shown in

Fig. 4 and Fig. 5. Fig. 7. Configuration of Control System

The tracking control results are shown in the Fig. 8. Fig.

8.a shows the tracking result from the starting moving

angle 30o to the ending moving angle -150o without

self-rotation. Fig. 8.b and Fig. 8.c show the same results

as Fig. 8.a on different moving angles. We can confirm

the good performance of the tracking control using fuzzy

Fig. 4. Premise Membership Functions estimator through the experimental results of the

designed OWMR.

A mobile robot with three omni-directional wheels is

a. Moving Angle : 30°→ -150°

developed as Fig. 6. The DC motor which the rated

torque is 31Kg·cm is used for driving the omni-

directional wheeled mobile robot. The diameter of

omni-directional wheel is 79mm and the distance from

center point of robot to wheel is 198mm.

Fig. 6. The 3-Wheels OWMR

The configuration of tracking control system is given

Fig. 8. The Tracking Control without Self-Rotation

in the Fig. 7. The encoder sensors are used for the

Proceedings of the 10th WSEAS Int. Conference on ROBOTICS, CONTROL and MANUFACTURING TECHNOLOGY

The results of tracking control with self-rotation are [2] T.A. Baede, Motion control of an omni directional

shown in the Fig. 9. The precise movement control with mobile robot, Traineeship report DCT 2006, 2006.

self-rotation guarantees the holonomic characteristics of [3] Y. Liu, X. Wu, J. Zhu and J. Lew, Omni-directional

OWMR. Through the below results, we can confirm the mobile robot controller design by trajectory

good performance of a holonomic system. linearization, in: Proceedings of the American

Control Conference, vol. 4, 2003, pp. 3423-3428

[4] Y. Liu, J.J. Zhu, R.L. Williams and J. Wu,

Omni-directional mobile robot controller based on

trajectory lineariztion, Robotics and Autonomous

Systems, vol. 56, 2008, pp. 461-479.

[5] T.K. Nagy, P. Ganguly and R. D'Andrea, Real-time

trajectory generation for omnidirectional vehicles, in:

Proceedings of the American Control Conference, vol.

1, 2002, pp. 286-291.

a. Moving from front to right with self-rotation [6] K. Watanabe, Control of an omnidirectional mobile

robot, in: Proceedings of 1998 Second International

Conference on Knowledge-Based Intelligent

Electronic Systems, vol. 1, 1998, pp. 51-60.

[7] K. Watanabe, Y. Shiraishi, S.G. Tzafestas and J.

Tang, Feedback Control of an Omnidirectional

Autonomous Platform for Mobile Service Robots,

Journal of Intelligent and Robotic System, vol.22, no.

3-4, 1998, pp. 315-330.

[8] J. Wu, Dynamic path planning of an

omni-directional robot in a dynamic environment,

b. Moving from back to left with self-rotation Ph.D. Dissertation, Ohio University, Athens, OH,

2005.

Fig. 9. The Tracking Control with Self-Rotation [9] R.P.A. van Heandel, Design of an omnidirectional

universal mobile platform, Internal report DCT 2005,

p. 117, 2005.

5 CONCLUSION

A holonomic mobile robot using 3 omni-directional

wheels is developed in this paper. Its tracking controller,

which each motor is, on the base of posture, controlled by

an individual PID law to follow the speed command from

inverse kinematics without considering the coupled

nonlinear dynamics explicitly in the controller design,

and fuzzy azimuth estimator, which is used

straightforward to perform the control of the mobile robot

by means of the fuzzy behavior-based scheme already

existent in literature, are presented in this paper. Also, the

good performance of the developed mobile robot is

confirmed through live tests of path control task.

References:

[1] A. Ashmore and N. Barnes, Omni-drive Robot

Motion on Curved Paths: The Fastest Path between

Two Points Is Not a Straight-Line, AI 2002:

Advances in Artificial Intelligence, vol. 2557, 2002,

pp. 225-236.

- controlsystemsUploaded byapi-19799369
- The International Journal of Computational Science, Information Technology and Control Engineering (IJCSITCE)Uploaded byAnonymous BI4sNIkiNw
- Shen Li Resume.pdfUploaded byShen Li
- 04b-JaffeUploaded byLe Dinh Phong
- The Design of Reduced Order Controllers for the Stabilization of Large Scale Linear Discrete-Time Control SystemsUploaded bysipij
- English Robot Script 2 - KumaBearManUploaded byKumaresh Muthu
- IJCCSCEUploaded byAnonymous pKuPK3zU
- 2014 EditorialUploaded byYee Jiea Pang
- Reference Tracking Control of Hypersonic Vehicles Using Switched Linear Parameter-Varying Approach _IEEEUploaded byP_lee
- Treesa s1 SeminarUploaded byMathew George
- Robotics Engg IntroUploaded bySiva Shankar
- CHE 404 Fall 2014 Detailed SyllabusUploaded byJuliaAbdullatif
- IJCSITCEUploaded byAnonymous BI4sNIkiNw
- Designing Sociable Robots - Cynthia L BreazealUploaded byAlexander Cuervo
- RoboticsUploaded bygopir28
- 1-s2.0-S0888327017305654-mainUploaded bychinnavenkateswarlu
- Jurnal Rev asdaper TranslatingUploaded byIndra Hedar
- Asimov WorksheetUploaded byCasper Lu
- Adaptive Control Tutorial -SIAMUploaded byCrystal Nassouri
- GetTRDoc[1]Uploaded byAria Irani
- Fundamentals_of_Flow_characterization_d350407x012Uploaded byTragool Somkiat
- A DSP-Based Implementation of a Nonlinear Model Reference Adaptive Control for a 1.5 kW Three-Phase Three-Level Boost-Type Vienna RectifierUploaded byVien Cao
- From the Main ProblemUploaded byIie Prasetya Geonino
- Nce Tact 2026Uploaded bySerag El-Deen
- Lect 04 Hand OutUploaded byGholamreza Ilkhani
- Process Control LoopUploaded byAnkan Bhunia
- UT Dallas Syllabus for ee4310.501 06f taught by William Boyd (wwb014000)Uploaded byUT Dallas Provost's Technology Group
- Nature as a BiologicallyUploaded bySan Surya
- FORMAT.docxUploaded byroselle

- Daewoo Matiz 2000-2013 Heating, Ventilation and Air Conditioner 21-33Uploaded bytivilardo
- Final Mis Report - AccUploaded bymajiclover
- Ahmad's Resume (1)Uploaded byAhmad Abunassar
- 740-741 REV Release B GBUploaded byMisi Szasz
- TOSHIBA Aquilion Series_BrochureUploaded byIbrahim Dagher
- PEC Codes and LimitsUploaded byImran Razzaq
- Thermal Dynamics Ultra-cut 200 Eng-omUploaded bysajsigaloma
- Rotor SpinningUploaded byJasmeet Singh
- Wagner Aircoat Manual Automatic GunsUploaded byMik Aeil
- Automation EstimationUploaded byG.C.Reddy
- IRJET-Design and Development of GUI based Wireless Robot for Condition Monitoring of Conveyor SystemUploaded byIRJET Journal
- Fault Detection and Protection of Induction Motors Using SensorsUploaded bydhirajsingh_avit
- Quick Selection Guide - Cool Only & Heat PumpUploaded bylijo
- Presentacion Perfect Harmony - Ecuador-2013Uploaded byCristhian Gavino
- 2013 catalog.pdfUploaded byAlfredo Mtz Reyes
- Ds Epolicy OrchestratorUploaded byhnevkar
- Accenture BPM Automation BrochureUploaded bylaser132
- Document(16)Uploaded byDavid Alvarez Miranda
- Smart 600Uploaded byCristiano Munhoz
- inquiry paperUploaded byapi-341656346
- Duct and Blower Door Testing CalculatorUploaded byAditya Suardi
- Advances in Seismic Fault Interpretation AutomationUploaded byMahmoud Said
- Adavanced Distribution Automation.pdfUploaded byMarcosGodoyPereyra
- Unit 7finalUploaded byjerry_jed
- Distribution Transformer BrochureUploaded byhari sudhan
- Arteor-B2CUploaded byluvfear
- Psychrometrics ProblemUploaded byPraveenkumar Kashyab
- Supplemental Guidance on Ongoing AuthorizationUploaded bychandramani_yadav197
- PEG_70_KAP_01Uploaded byaakashtrivedi
- 2016_Werum_B.pdfUploaded byAnonymous FZs3yBHh7