RFS25 - 6018
1. Tổng quan về động cơ DC Servo RFS 25-6018 * Cấu tạo của động cơ servo: Hình 1: Cấu tạo động cơ servo 1, Động cơ ; 2, Bản mạch 3, dây dương nguồn ; 4, Dây tín hiệu 5, Dây âm nguồn ; 6, Điện thế kế 7, Đầu ra (bánh răng) ; 8, Cơ cấu chấp hành 9, Vỏ ; 10, Chíp điều khiển * Nguyên lý hoạt động: - Động cơ servo được thiết kế để quay có giới hạn mà không phải quay liên tục như động cơ DC hay động cơ bước. Mặc dù ta có thể chỉnh động cơ servo quay liên tục được nhưng công dụng chính của động cơ servo là đạt được góc quay chính xác khoảng từ 90 o - 180 o . Điều khiển động cơ là điều khiển độ rộng xung (PWM), động cơ đòi hỏi tín hiệu từ 30 – 60 xung/s. Hai thông số chính của động cơ là momen xoắn và thời gian để trục động cơ quay một góc. + Momen xoắn của động cơ là tổng ngẫu lực mà nó sinh ra, các servo có momen xoắn rất cao nhờ vào hệ thống bánh răng giảm tốc. 1 + Thời gian để trục động cơ quay một góc ( thường bằng 60 o ) là thời gian transitor. Các servo nhỏ thường quay khoảng 0,25s/60 o trong khi các servo lơn quay chậm hơn. Thời gian transitor càng nhanh thì servo hoạt động càng nhanh. Từ thời gian transitor ta có thể tính được vận tốc quay theo vòng/phút của trục động cơ. - Động cơ servo được thiết kế cho những hệ thống hồi tiếp vòng kín. Tín hiệu ra của động cơ được nối với một mạch điều khiển. Khi động cơ quay, vận tốc và vị trí sẽ được hồi tiếp về mạch điều khiển. - Khi tốc độ động cơ bị lệch so với tốc độ đặt, cơ cấu hồi tiếp sẽ nhận thấy tín hiệu chưa đạt được vị trí mong muốn. Mạch điều khiển tiếp tục chỉnh sai lệch cho động cơ đạt được điểm chính xác. - Để lấy tín hiệu phản hồi về và điều khiển chính xác động cơ theo mong muốn, người ta đã tích hợp động cơ vói mooyj bộ encorder và một bộ điều khiển. - Encorder đo vận tốc tức thời của động cơ, chuyển thành tín hiệu điều khiển đưa về bộ điều khiển. - Bộ điều khiển nhận được tín hiệu từ encorder gửi về, lập tức phân tích, xử lý tín hiệu đó và tiến hành điều khiển động cơ theo một thuật toán cho trước. * Động cơ RFS 25-6018: Đối tượng điều khiển ở đây là động cơ Động cơ RFS 25-6018 của hãng Harmonic. Động cơ này thuộc dòng RFS - series (Sizes 25) là dòng động cơ được thiết kế nhỏ gọn, truyền động chính xác, mô men lớn và có gắn sẵn encoder. * Các tham số cơ bản của động cơ được trình bày trong bảng 1. Kiểu chạy : Liên tục Kích thích : Nam châm vĩnh cửu Cách điện : lớp F Điện trở cách điện : 100M Ω 2 Nhiệt độ môi trường : -10 ~ +40 o C Nhiệt độ lưu trữ: -20 ~ +60 o C Độ ẩm môi trường : 20 ~ 80 % ( không ngưng tụ ) Độ rung : 2.5g (5 ~ 400HZ) Shock : 30g (11ms) Bôi trơn : Dầu nhờn (SK-1A) Đầu ra : Mặt bích Bảng 1: Thông số động cơ Thông số Đơn vị Động cơ RFS 25- 6018 Công suất đầu ra (sau hộp số) W 185 Điện áp định mức V 75 Dòng điện định mức A 3.9 Mômen định mức T N In-lb 260 Nm 30 Tốc độ định mức n N rpm 60 Mômen hãm liên tục In-lb 312 Nm 36 Dòng đỉnh A 10.0 Mômen cực đại đầu ra T m In-lb 868 Nm 100 Tốc độ cực đại rpm 80 Hằng số mômen (K T ) In-lb/A 91 Nm/A 11.5 Hằng số điện B.E.M.F ( ảnh hưởng của tốc độ đến sđđ phần ứng )(Kb) v/rpm 1.18 Mô men quán tính (J) In-bl –sec 2 9.5 Kgm 2 1.1 Hằng số thời gian cơ khí ms 5.2 Độ dốc đặc tính cơ In-lb/rpm 194 Nm/rpm 22 Hệ số momen nhớt ( Bf) In-lb/rpm 1.0 Nm/rpm 1.1e-1 Tỷ số truyền 1:R 50 Tải trọng hướng tâm lb 551 N RFS:2500 3 Tải trọng hướng trục lb 243 N RFS:1100 Công suất động cơ W 300 Tốc độ định mức động cơ rpm 3000 Điện trở phần ứng Ω 0.6 Điện cảm phần ứng mH 0.92 Dòng khởi động A 1.5 Dòng không tải A 0.7 2. Mô hình toán của động cơ DC Servo RFS 25-6018 Các phương trình toán học động cơ DC servo RFS 25-6018 Các tham số cơ bản cảu động cơ: Ra = 0.6 La = 0.92 mH Kt = 11.5 Nm/A Kb = 1.18 V/rpm Bf = 1.1e-2 J = 1.1 (Kgm 2 ) Ta có: 1 ( ) A A A A A A dc c dc t A A b di u e i R L dt d M M dt J M K i e K n ω − = + = − = = Chuyển sang miền ảnh laplace: 1 ( ) A A A A A A dc c dc t A A b u e i R L i s s M M J M K i e K n ω − = + = − = = 4 ( ) 1 1 ( ) A A A A A dc c dc t A A b i u e R L s M M Js M K i e K n ω = − + = − ⇔ = = Thay A A A L T R = ta có hệ phương trình sau: ( ) 1/ 1 1 ( ) A A A A A dc c dc t A A b R i u e T s M M Js M K i e K n ω = − + = − ⇔ = = Từ hệ phương trình trên ta xây dựng được sơ đồ cấu trúc của động cơ như sau: Hình 1: Cấu trúc động cơ DC servo Thay các thông số của động cơ vào ta được mô hình động cơ DC servo trên simulink sau: 5 Hình 2: Cấu trúc động cơ DC servo RFS 25-6018 Đặc tính quá độ tốc độ và dòng của động cơ: Hình 3: Đặc tính dòng phần ứng động cơ DC servo RFS 25-6018 6 Hình 4: Đặc tính tốc độ động cơ DC servo RFS 25-6018 3. Các phương pháp thiết kế xấp xỉ liên tục Ta chọn bộ điều khiển có dạng PI, luật điều khiển được mô tả bởi công thức: ( ) 1 0 1 ( ) ( ) R c u t K e t e d T τ τ = + ∫ K R : Hệ số tỉ lệ T c : Hằng số thời gian chậm sau Để thiết kế trên miền thời gian xấp xỉ liên tục ta xấp xỉ thành phần I theo các phương pháp sau: * Sử dụng phương pháp hình chữ nhật: xấp xỉ thành phần I ( ) 1 1 k I i i I T u k e T − = ≈ ∑ ( ) 1 1 1 1 k I i i I T u k e T − − = ⇒ − ≈ ∑ ( / ) I C R T T K = 7 Trừ vế với vế và chuyển vế đổi dấu ta có: ( ) ( ) 1 1 I I i I T u k u k e T − ⇒ ≈ − + ( ) 1 1 ( ) ( ) I T U z z U z z E z T − − ⇒ = + ( ) 1 1 ( ) 1 I U z T z E z T z − − ⇒ = − ( ) 1 1 1 1 R I T z R z K T z ω − − − ⇒ = + − * Sử dụng phương pháp hình thang: ( ) ( ) 1 1 1 2 k I i i i I T u k e e T − = ≈ + ∑ ( ) ( ) 1 1 1 1 1 2 k I i i i I T u k e e T − − = ⇒ − ≈ + ∑ ( / ) I C R T T K = ( ) ( ) ( ) 1 1 1 2 I I i i I T u k u k e e T − ⇒ ≈ − + + ( ) ( ) ( ) 1 1 1 2 k k I T u k u k e e T − ⇒ ≈ − + + ( ) ( ) 1 1 1 ( ) ( ) ( ) 2 I T U z z U z E z z E z T − − ⇒ = + + ( ) 1 1 1 ( ) 2 1 I U z T z E z T z − − + ⇒ = − ( ) 1 1 1 1 2 1 R I T z R z K T z ω − − − + ⇒ = + − 8 4. Tổng hợp bộ điều khiển 4.1. Thiết kế bộ điều khiển trên miền thời gian liên tục Để điều khiển tốc độ động cơ DC servo thông thường ta dùng hệ thống hai vòng điều chỉnh. Tuy nhiên động cơ DC servo RFS 25-6018 là loại động cơ cỡ nhỏ nên có thể bỏ qua mạch vòng dòng. Hình 5: Cấu trúc mạch vòng điều chỉnh tốc độ Xây dựng vòng điều khiển tốc độ: ta chọn bộ điều khiển dạng PI 1 ( ) R R R T s R s K T s ω + = Ta có hàm truyền hệ hở: ( ) 2 0.001012 0. 11. 66 0.006 5 6 ho s s G s + = + Hàm truyền hệ kín: ( ) 2 0.001012 0.66 1 1 5 3.5 1. 8 kin s s G s + + = ( ) 11363.6364 (s+630.9) (s+21.26) kin G s ⇒ = ( ) 0.8472 (0.0016s+1) (0.047s+1) kin G s ⇒ = 9 => s C s B s A ssss sG sH s 0047.010016.01)0047.01)(0016.01( 8472.0)( )( + + + += ++ == =>0.8472= A(1+0.0016s)(1+0.0047s)+B.s.(1+0.0047s)+C.s.(1+0.0016s) =>0.8472=A(1+0.0063s+7.52*10 -6 s 2 )+Bs+0.0047Bs 2 +Cs+0.0016Cs 2 =>0.8472=A+(0.0063A+B+C)s+(7.52*10 -6 A+0.0047B+0.0016C)s 2 =>Ta có hệ 3 phương trình 3 ẩn: =>A=0.8472 (1) 0.0063A+B+C=0=>B+C=-5.34*10 -3 (2) 7.52*10 -6 A+0.0047B+0.0016C=0=>0.0047B+0.0016C=-6.37*10 -6 (3) Từ 2 và 3 ta có: =>B=7.01*10 -4 =>C=-6.04*10 -3 => ssssss sH s + − + += + − + += − 76.212 285.1 625 438.08472.0 0047.01 10*6.04 0016.01 10*01.78472.0 )( -34 Tra bảng ảnh Z H(z)= TT ez z ez z z z 76.212625 .285.1.438.0 1 8472.0 −− − − − + − G(z)=(1- 1 − z )H(z)= )285.1.438.0 1 .8472.0( 1 76.212625 TT ez z ez z z z z z −− − − − + − − TT ez z ez z 76.212625 1 285.1 1 .438.08472.0 −− − − − − − += Với chu kì trích mẫu T=0.1s ta có 276.215.62 1 285.1 1 .438.08472.0)( −− − − − − − += ez z ez z zG )10*7.5)(10*2.7( )10*7.5)(1(438.0)10*7.5)(10*2.7(84.0 )( 1028 101028 −− −−− −− −−+−− = zz zzzz zG )10*7.5)(10*2.7( )10*2.7)(1(285.1 1028 28 −− − −− −−− zz zz )10*1.410*8.5( )10*7.51(438.0)10*1.410*8.5(84.0 )( 37102 10237102 −− −−− +− +−++− = zz zzzz zG )10*1.410*8.5( )10*2.71(275.1 37102 282 −− − +− +−− zz zz 37102 10 10*1.410*8.5 10*5.2847.0 )( −− − +− + = zz z zG Áp dụng tiêu chuẩn tối ưu modul ta có: 2 2 1 ( ) 1 2 2 MC F s s s δ δ τ τ = + + 10