Wheelchair Stabilizing by Controlling The Speed Control of Its DC Motor
Wheelchair Stabilizing by Controlling The Speed Control of Its DC Motor
Wheelchair Stabilizing by Controlling The Speed Control of Its DC Motor
In section 3, hardware design and experimental results separated by PWM, and PID control. Finally, the paper is concluded in Section 4. II. DC MOTOR MATHEMATICS MODEL AND THE CONTROL THEORY A. DC Motor mathematics model Please We consider a DC shunt motors as is shown in Fig.1. DC shunt motors have the field coil in parallel (shunt) with the armature. The current in the field coil and the armature are independent of one another. As a result, these motors have excellent speed and position control. Hence DC shunt motors are typically used applications that require five or more horse power. The equations describing the dynamic behavior of the DC motor are given below.
. INTRODUCTION
CCORDING
to Wheelchairs, Wheelchairs give mobility to people who cannot walk. Knowing basic information about the types, accessibility, leans and safe use of wheelchairs is important [1]. Many prototypes of wheelchairs were developed in the research laboratories. Thus, EPW make up a significant portion of the mobility assistive devices in use today for the motor disabled and patients in recovery. While standard wheelchairs are mainly used by those who have the necessary upper-body strength to propel and manoeuvre it, EPW are destined for those who cannot: people with excessive body weight, poor health, weak upper limbs, and those longtime living with the disability [2]. To approach the motion control problem of an EPW with DC motor control. The DC motor has been widely used in industry. As a result, speed control of DC motor has attracted considerable research and several methods have evolved. Proportional-Integral Derivative (PID) controllers have been widely used for speed control of DC motor [4],[7]. Some of the most significant developments in wheelchairs are in the speed control. The actual speed sometimes can not follow the instruction speed as given from the joy stick. As the same time, right or left wheel usually do not run in the same speed. It may cause disorientation of the wheelchair [5]. The purpose of this paper is to discuss on how to achieve the best control performance of a wheelchair. In section 2, the discussion focuses on mathematical model and the conceptual design of a PID controller.
Where, Ra : the armature resistance, La : the armature inductance, ia : the armature current, i f : the field current, ea : the input voltage, eb : the back electromotive force (EMF), tm : the motor torque, : an angular velocity of rotor, J : rotating inertial measurement of motor bearing, B : a damping coefficient. Because the back EMF eb is proportional to speed directly, then
d (t ) = K b (t ) dt Making use of the KCL voltage law can get eb (t ) = K b dia (t ) + eb (t ) dt From Newton law, the motor torque can obtain ea (t ) = Ra ia (t ) + La
Tm (t ) = J d 2 (t ) d +B = KT ia (t ) dt dt 2
(1)
(2)
Dechrit Maneetham is with Department of Mechatronics, Rajamangala University of Technology Thanyaburi Thailand (phone:+668 6882 1475;email: [email protected]) Benchalak Muangmeesri is with Department of Art Design and Technology, Rajamangala University of Technology Thanyaburi Thailand (phone:+668 1801 1474 (email: [email protected]) Petrus Sutyasadi is with Department of Mechatronics, Sanata Dhama University , Indonesia ;email: petrusstyasadi@ yahoo.co.id)
(3)
310
Take (1), (2), and (3) into Laplace transform respectively, the equations can be formulated as follows:
Ea ( s) = ( Ra + La s ) I a ( s) + Eb ( s ) Eb ( s ) = K b ( s ) Tm ( s ) = B( s ) + Js( s ) = KT I a ( s )
(4)
(5) (6)
B. PID Control The PID controller includes a proportional term, integral term and derivative term, where the proportional term is to adjust the output of controller according to all of the magnitude of error, the integral term is used to remove the steady state error of control system and improve the steady state response, the derivative term is used to predict a trend of error and improve the transient response of the system. These functions have been enough to the most control processes. Because the structure of PID controller is simple, it is the most extensive control method to be used in industry so far. The PID controller is mainly to adjust an appropriate proportional gain ( KP) , integral gain ( KI ) , and differential gain ( KD) to achieve the optimal control performance. The PID controller system block diagram of this paper is shown in Fig. 4.
The transfer function of DC motor speed with respect to the input voltage can be written as follows:
G (s) = KT ( s ) = Ea ( s ) ( La s + Ra )( Js + B ) + K b KT
(7)
From Equation (7) the armature inductance is very small in practices, hence, the transfer function of DC motor speed to the input voltage can be simplified as follows, K ( s ) (8) = m Ea ( s ) s + 1
The relationship between the input e(t) and output u(t) can be formulated in the following,
de(t ) dt
(9)
The transfer function is expressed as follows, K U (s) (10) = KP + I + KD s E (s) s The controlled plant in this paper is a DC motor. The PID DC motor speed control system block diagram is shown in Fig .5. C ( s) =
From Equation (8), the transfer function can be drawn the DC motor system block diagram which is shown in Fig. 3.
311
The closed loop transfer function of DC motor speed control system expresses as follows,
KI Km KP + s KD s 1+ s K K 1+ KP + I + KD s m s 1+ s
( s ) G ( s) = = R( s)
(KD s2 + KP s + KI )Km ( K D K m + ) s 2 + (1 + K P K m ) s + K I K m
(11)
III. HARDWARE DESIGN AND EXPERIMENTAL RESULTS A. System Design In this research designed the control system of an EPW for the disabled. The system composes of 24 volt and 250 watt DC motor. The former one controlled by Pulse Width Modulation (PWM) generated from a Microcontroller PIC 16F877 through the H-Bridge functions on forward-backward movement of electric wheelchair. Microcontroller used as the controller is PIC16F877 microcontroller. This microcontroller circuit is designed as a single chip circuit. A personal computer (PC) is connected to this microcontroller for data acquisition process. The microcontroller will read the speed and then control the speed of a wheelchair by using PID control algorithm. Two DC motors are used as the pulley and belt for moving links of the wheel. Because we need to control the speed and direction of the DC motor, H-Bridge driver circuit is used in this system. PID controller applied in this research is a parallel PID controller. PWM is a switching technique in which the supply voltage is full applied to the load and then removed. the on and off times being precisely controlled. An integrated circuit PWM controller. A H-bridge contains four switching power devices (power mosfets were used in this application) and the motor load is placed across the central arms, then execute the parameter adjustment of the PID controller through the designed program under the Microcontroller control. The system design is shown in Fig. 6.
(b)
Fig. 6 (a) Schematic Diagram and (b) Electric Power Wheelchair
Software of PWM is designed by using PIC code vision program. Fig 7. shows flowchart of the designed software.
B. Experimental Results In this section, we test that examined 21 patients referred to be assessed for the provision of an EPW by compared with weight and duty cycle at 15 meters are provided in Table 1. The purpose of this EPW demo track is to familiarize the students with power converters and their functions as used in power electronics applications. To allow the students are perfectly as working in the laboratory the DC motor bus voltage and the control signals are allow bellow 30 volt. (a)
312
30%
(m/s)
50%
(m/s)
70%
(m/s)
90%
(m/s)
0 0 0 0 0 0 0
In order to illustrate that the PWM is functioning the DAC was set to 126 out of 255. The result can be observed on Figs 8-9. (a)
(b)
(b) (a)
Fig. 9 (a) Speed control, (b) 90% PWM and Encoder signal
In the following, apply the real gain of PID control parameters KP, Ki Kd with MATLAB simulink, simulate the PID control of DC motor speed control system according to the hardware connected wire and the system function block diagram is to draw the PID speed control system and verify with the actual system response. The simulation results of the response of PID speed control in DC motor are shown in Fig 10.
(b)
Fig. 8 (a) Speed control, (b) 30% PWM and Encoder signal
(a)
313
(b) Fig. 10 Comparative response of open and closed loop with (a) and (b)
IV. CONCLUSION From the experimental results, we can conclude that the PID controller can control the speed of an EPW well. The simulation of the DC motor was done using the software package MATLAB/SIMULINK. But this is depended on the setting value of PID parameters. By setting the PID parameters with proper value, we can get good system response. As the same time, PWM designed has been simulated and observed to have good performance. In the driving test of the four levels of speed, percent duty cycle of PWM and average voltage supplied to 24 volt motor are investigated. The lowest speed (Level 1) of wheelchair has the percent duty cycle of 30% and the average voltage of 16.2 volt, consequently the maximum weight be able to load on the chair at 40 kg, and the maximum weight be able to load on the chair at 100 kg as much as Level 4 which has the percent duty cycle of 90% and the average voltage of 22 volt. Overall, a speed controller has been designed successfully for closed loop operation of the DC motor and the motor runs very closed to the reference speed. ACKNOWLEDGMENT The authors would like to thank the Dean of Medical Center Srinakharinwirot Hospital, for his valuable expertise and helpful suggestions. We are also grateful a special thanks to my scholarship donor, this support of this work by Rajamangala University of Technology Thanyaburi (RMUTT) is gratefully acknowledged.
[1]
Workshop on the role of experiments in robotics research ICRA, May, Alaska,2010. [6] Francisco.P.L, Pedro.S.O, Luis.P.R. and Rui.E.A. An Elecric Wheelchair as a Tool for Motivating Students in Power Electronics International Symposium on Power Electronics Rlectrical Drives, Automation and Motion, IEEE,pp.481-485,2008. [7] Thiang, Handry.K. and Edwin.P. Position Control of a Manipulator sing PID Control Algorithm Based on ATmega8535 Microcontroller International Conference on Instrumentation, Control & Automation, October 20-22, Bandung, Indonesia, pp.196-199,2009. [8] Atef.S.O. and Al.M. Proportional Integral and Derivative Control of Brushless DC Motor European Journal of Scientific Research, Vol.35,No.2,pp.198-203,2009. [9] Hongwu. W, Benjamin. S, Garrett. G.G, Dan. D. and Rory. A.Cooper. Real-Time Model-Based Electrical Powered Wheelchair Control. Med Eng,Phys,Decemberhttp://www.ncbi.nlm.nih.gov/pmc/articles/PMC281 1532/,2009. [10] Zhihong. Tian. and Wenhui. Xu. Electric Wheelchair Controller Based on Parameter Self-Adjusting Fuzzy PID Computational Intelligence and Natural Computing CINC '09. International Conference, Tianjin Univ. of Sci. & Technol, Tianjin, China,2009. [11] Carmen. P, DiGiovine. and Rory A. C. Dynamic calibration of a wheelchair dynamometer Journal of Rehabilitation Research and Development January/February, Vol. 38, No. 1, pp. 4155,2001.
[2]
REFERENCES O. R.Lee.Kirby, Maria.T.Sampson, Fredrik.A.V.Thoren, Donald.A.Macleod. Wheelchair stability: Effect of body position Journal of Rehabilitation Research and Development,Vol.32, No.4, pp.367-372,1995. G.Bourhis and M.Sahnoun. Assisted Control Mode for a Smart Wheelchair Proceeding of the 2007 IEEE 10th International Conference on Rehabilitation Robotics, June 12-15, Noordwijk, The Netherlands, pp.158-163,2007. Velazquez R. On the Dynamics and Control of Robotic Wheelchairs IFToMM Symposium on Mechanism Design for Robotics, September 2830, Universidad Panamericana, Mexico City, Mexico,2010. Neenu.T and Poongodi.P. Position Control of DC Motor Using Genetic Algorithm Based PID Controller Proceedings of the World Congress on Engineering, June 1-3, London, U.K,2009. Tom.C and Yiannis.D. Robotic Wheelchairs: Scientific Experimentation of Social Intervention In Proc. of the Euron GEM Sig
314