H 975 [8] [9] 4 H [10] H [11] [15] H I H II H Fig. 2 H [16] [18] [19] H [8] Fig. 3 3 b, β, δ d Double U Joint [20] a e A G β 2 z C B

Size: px

Start display at page:

Download "H 975 [8] [9] 4 H [10] H [11] [15] H I H II H Fig. 2 H [16] [18] [19] H [8] Fig. 3 3 b, β, δ d Double U Joint [20] a e A G β 2 z C B"

かずまさおおふさ
7 years ago
Views:

1 974 Vol. 19 No. 8, pp , 2001 H H Design of Hybrid Compliance using Upper/Lower Bound in the Frequency Domain Shaping and Control of Dynamic Compliance of Humanoid Shoulder Mechanisms Masafumi Okada 1, Yoshihiko Nakamura 1 2 and Shin-ichiro Hoshino 3 Design and control of mechanical compliance would be one of the most important technical foci in making humanoid robots really interactive with the humans. For task execution and safety insurance the issue must be discussed and offered useful and realistic solutions. In this paper,we propose a theoretical design principle of mechanical compliance. Passive compliance implies mechanically embedded one in drive systems and is reliable but not tunable in nature,while active compliance is a controlled compliance and,therefore,widely tunable,but less reliable specially in high frequency domain. The basic idea of this paper is to use active compliance in the lower frequency domain and to rely on passive compliance in the higher frequency. H control theory based on systems identification allows a systematic method to design the hybrid compliance in frequency domain. The proposed design is applied to the shoulder mechanism of a humanoid robot. Its implementation and experiments are to be shown with successful results. Key Words: H Control,Hybrid Compliance,Humanoid Robot,Frequency Dependent Dynamic Compliance 1. [1] [6] f y G G [7] Fig NTT 1 Department of Mechano Informatics, University of Tokyo 2 Japan Science and Technology Corporation 3 NTT DATA Corporation Fig. 1 Shaping dynamic compliance JRSJ Vol. 19 No Nov., 2001

2 H 975 [8] [9] 4 H [10] H [11] [15] H I H II H Fig. 2 H [16] [18] [19] H [8] Fig. 3 3 b, β, δ d Double U Joint [20] a e A G β 2 z C B G E D D G 3 E β δ θ 21 θ 22 θ 41 θ 42 Fig. 4 E ( I R y θ 21 Rθ x 22 L z L 3 Rθ x 41 R y θ 42 Rπ) z R z 2 π(i 1)r = li 3 r := [ b ] T (i =1, 2, 3) 1 2 R ξ θ ξ θ Lξ l ξ l l i E b B D E 1 l 1 l 2 l 3 Fig. 3 Cybernetic shoulder Fig. 2 Shaping dynamic compliance Fig. 4 Definition of rotations

coefficient of viscosity Type Spring constant Coefficient of [N/m] viscosity [kg/s] 1 1.609 10 3 0.625 2 5.963 10 2 0.45 3 5.963 10 2 1.

3 976 Fig. 5 The cybernetic shoulder with the rigid or elastic link θ 41 θ 42 l 1 = Js(θ 21,θ 22) l 2 3 L 3 l 3 E l i θ 41 θ 42 L J s Table 1 Spring constant and coefficient of viscosity Type Spring constant Coefficient of [N/m] viscosity [kg/s] E k 1 k 2 k 3 θ 41 θ 42 L 3 C s 1 k C s = J s 0 k 2 0 Js T k 3 E θ 41 θ 42 L E Fig [mm 2 ] Fig. 5 2 φ5 [mm] Fig Fig. 5 3 Fig. 5 1 Fig. 5 Table 1 Fig. 6 Humanoid robot 2. 3 Fig. 6 z PD Fig. 7 1 [kg] [ e ] [ ] x e 0 y e 0 z 0 = [mm] 5 JRSJ Vol. 19 No Nov., 2001

4 H 977 Fig. 10 Generalized control system Fig. 7 Experimental setup Fig. 11 Local feedback system [ z y ] [ G11 G 12 = G 21 G 22 ][ f u ] 8 z : y : f : u : Fig. 10 C f z Fig. 8 Step responses of the strain G zf G zf = G 11 G 12(I + CG 21) 1 CG 21 9 H G zf < 1 10 C H G(s) := sup G(jω) 0<ω< 11 Fig. 9 Frequency analysis Fig. 8 9 W f (s) W f (s) = 6 (s + 100) [rad/s] 3. H 3. 1 H [9] [ ] G11 G 12 G = G 21 G 22 7 H P P Fig. 11 C l P θ m θ u θ u θ m C l

5 978 Fig. 12 Disturbance input y = G close f G close Fig. 13 C v =0 y := y y 0 17 Fig. 13 Vibration control system θ u y 0 y θ r θ m τ K I k f f Fig. 12 J u J m y ẏ = [ ] [ ] θu J u J m 12 θ m P ] [ ] [ θu θ m P m1 τ u = P τ + τ m [ ] Pu1 P u2 P := P m P u1 P u2 P m1 P m2 K K f y y = G open f 15 Fig. 13 C v y 0 y y y 0 1 [ ] f y y = K(θu,θ m)g G = [ f y 0 y0 u 18 G sg m G ti k G tj G u P u2c l G sg m P u2c l G si k P u2c l G sj G s := (I + P m2c l ) 1 G t := I G s G u := P u1j T u + P u2j T m G m := P m1j T u + P m2j T m I : ] y 0 C l f u C v 18 y = [ ] [ ] f Ḡ f Ḡ u 24 u C v C v C v I 2 C v G close G close 1 II C v Fig. 14 W 1 W 2 W 3 Fig. 14 C v f z 1 H JRSJ Vol. 19 No Nov., 2001

6 H 979 Fig. 14 Generalized control system for design of C v 1 G close W 1 < 1 25 G close < W W 1 1 f z 2 ( ) W2 I G close W 1 < 1 27 G W 1 close > W W 2 W 2 W 1 1 G close W 1 W 2 f z 2 z 1 z 2 f z 3 ( ) 1 W 3 I + Cv Ḡ u Cv Ḡ f < 1 30 W 3 W 3 W 1 W 1 W P Fig. 14 f u y 4. 2 C v Fig. 14 Ḡf Ḡu Ḡf Fig. 8 Ḡu u y Ḡ u M [21] [mm] Ḡu OE Output Error [21] Ḡu Ḡm u Ḡ u Ḡf Fig. 8 Ḡf Ḡm f ARX [21] Ḡ m u = (s )(s +34.7) (s j)(s j) 31 Ḡ m f = (s j)(s j) (s j)(s j) ω =23.8 [rad/s] Case Ḡm u Ḡm f Fig. 14 C v W 1 W 2 W 3 W 1 = 7(s + 15) 3 (s +5) 2 (s ) 33 W 2 = (s + 10)3 W 3 = 35 (s ) 3 W 1 W 2 =0 W 3 Fig. 15 C v G open W 1 G close C v C v W

7 980 Fig. 15 Gain plots of closed loop systems (Case 1) Fig. 17 Gain plots of closed loop systems (Case 2) Fig. 16 Step responses of the controlled system (Case 1) W 3 G open G close C v H C v C v Fig. 7 Fig. 16 Fig. 8 G open C v 2 C v C v Fig. 16 Fig. 15 Case 2 C v G open < G close 36 Fig. 18 Step responses of the controlled systems (Case 2) 12(s + 20) W 1 = 37 s W 2 = 38 (s +5) 2 214(s + 10)3 W 3 = 39 (s ) 3 Fig Case 1 W 1 1 G close G open Fig. 16 Fig. 18 Fig JRSJ Vol. 19 No Nov., 2001

8 H 981 W 1 G close 0 C v C v 1 E Fig. 4 θ 41 θ 42 L 3 H H 3 4 JSPS RFTF96P00801 [ 1 ] R.P.C. Paul and B. Shimano: Compliance and Control, Proc. of the 1976 Joint Automatic Control Conference, pp , [ 2 ] H. Hanafusa and H. Asada: Stable Prehension by a Robot Hand with Elastic Fingers, Proc. of the 7th International Symposium on Industrial Robots, pp , [ 3 ] N. Hogan: Mechanical Impedance Control in Assistive Devicesand Manipulators, Proc. of the 1980 Joint Automatic Control Conference, TA10 B, [ 4 ] J.K. Salisbury: Active Stiffness Control of a Manipulator in Cartesian Coordinates, Proc. of the IEEE Conference on Decision and Control, [ 5 ] N. Hogan: Impedance Control: An Approach to Manipulation: Part 1 3, ASME Journal of Dynamic Systems, Measurement and Control, vol.107, pp.1 24, [ 6 ] K.F. L-Kovitz, J.E. Colgate and S.D.R. Carnes: Design of Components for Programmable Passive Imprdance, Proc. of IEEE International Conference on Roboticsand Automation, pp , [7] [8] 98 ROBOMEC 98 1BI2 3, [9] 99 ROBOMEC 99 2P , [10] K. Glover and J.C. Doyle: A State Space Approach to H Optimal Control, in Three Decadesof Mathmatical System Theory (H. Nijmeijer, J.M. Schumacher eds.). pp , Springer Verlag, [11] 2 D.D. vol.29, no.12, pp , [12] µ 11 pp.29 32, [13] 12 pp.51 52, [14] 1 vol.32, no.7, pp , [15] 2 2 vol.32, no.7, pp , [16] H 20 pp , [17] 2 H 21 pp , [18] 5 pp.s 176 S 179, [19] H 13 pp.27 28, [20] M.E. Rosheim: Robot Evolution, The Development of Anthrobotics. JOHN & SONS, INC., [21] L. Ljüng: System Identification Theory for the User

9 982 Prentice Hall, Masafumi Okada PD IEEE Yoshihiko Nakamura CG IEEE ASME Shin ichiro Hoshino NTT JRSJ Vol. 19 No Nov., 2001

MmUm+FopX m Mm+Mop F-Mm(Fop-Mopum)M m+mop MSuS+FX S M S+MOb Fs-Ms(Mobus-Fex)M s+mob Fig. 1 Particle model of single degree of freedom master/ slave sy

MmUm+FopX m Mm+Mop F-Mm(Fop-Mopum)M m+mop MSuS+FX S M S+MOb Fs-Ms(Mobus-Fex)M s+mob Fig. 1 Particle model of single degree of freedom master/ slave sy Analysis and Improvement of Digital Control Stability for Master-Slave Manipulator System Koichi YOSHIDA* and Tetsuro YABUTA* Some bilateral controls of master-slave system have been designed, which can