Robust Position Control of Ultrasonic Motor Considering Dead-Zone
Total Page:16
File Type:pdf, Size:1020Kb
Robust Position Control of Ultrasonic Motor Considering Dead-Zone Shogo Odomari1, Araz Darba1, Kosuke Uchida1, Tomonobu Senjyu1, and Atsushi Yona1 1Department of Electrical and Electronics Engineering, University of the Ryukyus, Japan E-mail: [email protected] Abstract— Intrinsic properties of ultrasonic motor (high torque for low speed, high static torque, compact S1 D1 S3 D3 C L1 USM Load in size, etc.) offer great advantages for industrial ap- 1 Va plications. However, when load torque is applied, dead- E zone occurs in the control input. Therefore, a nonlinear Vb y controller, which considers dead-zone, is adopted for ul- C2 L 2 trasonic motor. The state quantities, such as acceleration, S2 D2 S4 D4 RE speed, and position are needed to apply the nonlinear controller for position control. However, rotary encoder causes quantization errors in the speed information. This − f MOS FET Micro ye paper presents a robust position control method for ultra- driver φ computer sonic motor considering dead-zone. The state variables y for nonlinear controller are estimated by a Variable r e Structure System(VSS) observer. Besides, a small, low Personal cost, and good response nonlinear controller is designed computer by using a micro computer that is essential in embedded system for the developments of industrial equipments. Fig. 1 Drive system of USM. Effectiveness of the proposed method is verified by the experimental results. 150 Va Vb 100 I. INTRODUCTION B V , [V] 50 A In recent years, ultrasonic motor(USM) is gaining V 0 attention as it has good characteristics and is small in size. The drive source of ultrasonic motor is ultrasonic -50 Control input -100 vibration of piezoelectric element. USM is expected to 0 5 10 15 20 be applied to robot actuator, high precision positioning Time [msec] and medical equipments[1]. The operating principle Fig. 2 Output voltages of two-phase inverter. of an USM has complicated speeds characteristics compared to a conventional electromagnetic motor which makes it a special kind of motor. control system at low cost, can upgrade response, and However, an USM has dead-zone in its control input can make the system design easily). with applied load torque[3]. Since H∞ controller is a This paper presents a digital implementation[8]-[10] linear controller[2], it cannot control the USM with un- of a nonlinear controller and a VSS observer by using known dead-zone. Therefore, nonlinear controller[4]- a micro computer for efficient position control of the [6], which is not used dead-zone inverse, is used for USM with unknown dead-zone. The state variables robust position control of USM with unknown dead- are estimated by the VSS observer and are used in zone. To apply nonlinear controller for position control nonlinear controller. The proposed nonlinear controller of USM, state variables such as acceleration, speed and is found satisfactory. position of the USM are needed. Speed information detected by a rotary encoder have quantization errors, II. SYSTEM CONFIGURATION especially in low speed region. Therefore, to estimate actual rotor speed accurately, a VSS observer[7] is pro- A. Driving system of USM posed with the possibility of decreasing quantization Configuration of the USM control system used in error. this study is shown in Fig. 1. The USM used in Essential industrial equipments are developed in the experiment is a traveling wave USM(SHINSEI small size, lightweight and power-saving technology, CORPORATION : USR-60). Output voltages of the by using embedded system. Usage of micro computer two-phase inverter are shown in Fig. 2. A traveling in embedded system, has advantages(such as it can dis- wave is formed on the stator surface when this voltage cretize all processing, can design stable and small size is applied to the stator, the rotor moves, and USM turns circuit in comparison to analog circuit, can construct to the opposite direction of the traveling wave. Table 1. Design specifications of USM. r Drive frequency 40 kHz + e Nonlinear u y USM RE ye Drive voltage 100 Vrms - Controller Rated current 53 mA/phase Rated torque 0.314 Nm Rated output power 3 W x Rated speed 9.0 rad/s VSS Observer Mass 0.240 kg Fig. 5 System configuration. y(t) mr u(t) 6 5 4 mr 3 S1 S2 bl 2 0 u(t) 1 ml br 0 PWM Voltage [V] -1 ml u(t) 0 5 10 15 20 Time [μsec] Fig. 6 Dead-zone model. Fig. 3 PWM signal. get sinusoidal voltage by making resonance with the equivalent circuit of the USM as shown in Fig. 4. III. CONTROL ALGORITHM Fig. 4 Equivalent circuit of USM. System configuration in this study is shown in Fig. 5. This section is designed nonlinear controller and VSS observer. Specifications of the USM is shown in Table 1. An electromagnetic brake of the load and the rotary A. Dead-zone model encoder are connected by a coupling. Electromag- Dead-zone model is shown in Fig. 6 and mathemat- netic brake is used to apply the load torque when ical equation is given as follows. voltage is applied. The rotary encoder is used for ⎧ ⎨ m u t − b b ≤ u t , detecting the produced pulse in proportion to angle r( ( ) r) r ( ) y t b <ut <b , of the rotation of the motor shaft. Micro controller ( )=⎩ 0 l ( ) r (1) m u t − b u t ≤ b , detects the rotor position for pulse number by rotary l( ( ) l) ( ) l encoder(10,000 pulse/rev.). Reference position r and This equation is rewritten as measured position ye of the USM are recorded. There y t mu t d u t , are two control methods of USM: driving frequency ( )= ( )+ ( ( )) (2) control and applied voltage phase difference control. where, In position control of the USM, applied voltage phase m ≤ u t , difference control has higher efficiency than driving m r 0 ( ) = m u t < , (3) frequency control. In this study, we use applied voltage l ( ) 0 phase difference control, and the driving frequency f ⎧ ⎪ −m b b ≤ u t , is constant at 41 kHz. ⎨⎪ r r r ( ) −m u t ≤ u t <b , d u t r ( )0 ( ) r B. Driving circuit configuration ( ( )) = ⎪ −m u t b <ut < , (4) ⎩⎪ l ( ) l ( ) 0 Power MOS-FET are used as switching device. The −mlbl u(t) ≤ bl. USM is a large capacitive load by looked from the B. Nonlinear controller design inverter side. For improved efficiency by decreasing capacitive load, intercalate inductances are set in se- Nonlinear system for position control of USM is ries. given as follows. In PWM signal to generate micro computer input to x(3) t ζω x ω2 x inverter circuit, short to switch on both arm of tops ( )+2 n ¨ + n ˙, (3) and bottoms, braking of switching devices by over = x (t)+a3x¨ + a2x˙, ω2 K y t bmu t bd u t , current, we should input PWM signals with off time = n f ( )= ( )+ ( ( )) (5) to both arms(dead time). Generated PWM signals with 2 2 where, a =[a1 a2 a3]=[0 ωn 2ζωn], b = ωnKf . dead time are shown in Fig. 3. In Fig. 3, to generate The filter tracking error is defined as dead time in input signal to switching device S1 and n−1 S2 can check. The inverter produces rectangular wave d s(t)= + λ e(t)=ΛT e(t), (6) forms with these PWM signals. However, we can dt where, ΛT =[λ2 2λ 1], e(t)=r(t) − x(t).If Main Routine Timer Interrupt T 2 START START we define Λv =[0 λ 2λ], the filter tracking error Step 1 differential equation is given as follows. Step 4 Initializing Yes No micro computer T (3) t < 10s s˙(t)=Λv e(t)+e (t), Step 2 Step 5 T = Λv e(t)+a3x¨ + a2x˙ Displaying Deciding Step 7 (3) opening message control input −bmu(t) − bd(u(t)) + r (t). (7) Displaying Step 6 measured value It should satisfy s(t)˙s(t) ≤−M|s(t)| to keep s(t)=0 Step 3 Estimating Waiting state values which leads to ideal control input of Eq. (8). timer interrupt 1 (3) T a3 u(t)=kds(t)+ bm (r (t)+Λv e(t)) + bm x¨ END a d u t 2 x − ( ( )) M s t , Fig. 7 Control algorithm. +bm ˙ m + sgn( ( )) (8) where kd is a constant and M is the positive constant. We obtain the following equation when we rewrite Eq. State estimate error e is defined by (7) using Eq. (8). e(t)=ˆx(t) − x(t). (16) s˙(t)=ud(t)+ a3x¨ + a2x˙ − bd(u(t)) and F estimation error α is defined by u (t) −bm k s t d a3 x d ( )+ bm + bm ¨ α F {y t − y t }. a d u t = ˆ( ) ( ) (17) 2 x − ( ( )) M s t . + bm ˙ m + sgn( ( )) (9) where, xˆ(t) and yˆ(t) are the estimated value of x(t) and y(t). Using these equations, the design of the VSS u r(3) t ΛT e t where, d = ( )+ v ( ). observer can be obtained. Next, Lyapunov function is selected as follows. xˆ˙ (t)=A0xˆ + Ly + Bu + Bδ, 1 2 − α ρforα , V t s t . α =0 (18) c( )= bm ( ) (10) δ(t)= 2 0 for α =0. Differentiating the equation, we have where, ρ is a constant. The following error equation 1 can be obtained by differentiating Eq. (18). V˙c(t)= bm ss˙, uds(t) s(t) a x a x − d(u(t))s(t) = bm + bm ( 3 ¨ + 2 ˙) m ˙ e˙ = xˆ − x˙ ud a3 a2 −s(t) kds(t)+ + x¨ + x˙ = A0xˆ + Ly + Bu + Bδ − Ax − Bh − Bu bm bm bm = A0e + Bδ − Bh d(u(t)) − m + Msgn(s(t)) , α A0e − B α ρ − Bh for α =0 , −k s2 t − M|s t |≤−k s2 t .