Chương 1. Tổng quan về động cơ DC Servo Harmonic RHS17 -6006 1.1. 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 7, Đầu ra (bánh răng) ; 8, Cơ cấu chấp hành 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ế 9, Vỏ ; 10, Chíp điều khiển 1.2. 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 Đối tượng điều khiển ở đây là động cơ Động cơ RHS 17-6006 của hãng Harmonic. Động cơ này thuộc dòng RHS - series (Sizes 20) 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.
Trang 1ĐỀ CƯƠNG SƠ BỘ
Đề bài 32: Thiết kế xấp xỉ liên tục khâu điều chỉnh vị trí động cơ DC
SERVO Hanrmonic RHS 17-6006
Chương 1 Tổng quan về động cơ DC Servo Harmonic RHS17 -6006 1.1 Cấu tạo của động cơ servo
1.2 Nguyên lý hoạt động
1.3 Các tham số cơ bản của động cơ
Chương 2 Xây dựng mô hình điều khiển vị trí Động cơ Servo
Harmonic RHS 17-6006
2.1 Cấu trúc điều khiển số vị trí động cơ
2.2 Xây dựng hệ phương trình tính toán động học động cơ Servo
Harmonic RH 8D-6006
2.3 Xây dựng bộ điều khiển vị trí đông cơ Servo Harmonic RHS 17-6006
Trang 2ĐIỀU KHIỂN SỐ
Đề bài 32: Thiết kế xấp xỉ liên tục khâu điều chỉnh vị trí động cơ DC
SERVO Hanrmonic RHS 17-6006
Chương 1 Tổng quan về động cơ DC Servo Harmonic RHS17 -6006
1.1 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
7, Đầu ra (bánh răng) ; 8, Cơ cấu chấp hành
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ế
9, Vỏ ; 10, Chíp điều khiển 1.2 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
Đối tượng điều khiển ở đây là động cơ Động cơ RHS 17-6006 của hãng Harmonic Động cơ này thuộc dòng RHS - series (Sizes 20) 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
Trang 31.2 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 Ω
Nhiệt độ môi trường : -10 ~ +40oC
Nhiệt độ lưu trữ: -20 ~ +60 oC
Độ ẩ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ơ
Công suất đầu ra (sau hộp số) W 8.6
Mômen cực đại đầu ra Tm In-lb 24
Hằng số điện B.E.M.F ( ảnh
hưởng của tốc độ đến sđđ phần
ứng )(Kb)
Mô men quán tính (J) In-bl –sec2 0.033
Trang 4Kgm2 3.7
Độ dốc đặc tính cơ In-lb/rpm 0.42
Hệ số momen nhớt ( Bf) In-lb/rpm 0.086
Nm/rpm 9.7e-3
Chương 2 Xây dựng mô hình điều khiển vị trí Động cơ
Servo Harmonic RHS 17-6006
2.1.Cấu trúc điều khiển số vị trí động cơ
-Fω và Fφ lần lượt là hàm truyền phản hồi tốc độ và vị trí
-BBĐ Công Suất có chức năng biến đổi điện áp DC 0-5V thành 0-24V
Hình 2.1: Cấu trúc điều khiển số vị trí động cơ phản hồi tốc độ và vị trí từ
Encoder
Công suất
-F w
F phi Phi
Trang 5Hình 2.2: Phồi vị trí bằng cách lấy tích phân tốc độ theo thời gian
2.2 Xây dựng hệ phương trình tính toán động học động cơ Servo
Harmonic RH 8D-6006
Tham số chính:
-Ra=10
-La=2.2mH
-Kt=2.1 Nm/A
-Kb=0.22 V/rpm
-Bf=9.7*e-3
-J=3.7*e-3
=> Ta có
(1) Chuyển sang miền Laplace ta có
1
.
.
.
a a
dc c
dc t a
b
a
s
J s
n
U e i R L i
i
e K
(2)
Công suất
-F w
Tích phân Phi
Trang 6Có
a
a U e a s R
T R T
Thay vào (2) ta được hệ phương trình sau :
1
.
.
.
a
a a
a
a
dc c
dc t a
b
a
s
J s
n
i
e K
(5)
Từ hệ phương trình trên,ta có cấu trúc của động cơ như sau :
Hình 2.2 : Cấu trúc động cơ DC servo
Trang 7Hình 2.3 : Đặc tính tốc độ động cơ
Hình 2.4 : Đặc tính dòng phần ứng động cơ 2.3 Xây dựng bộ điều khiển vị trí đông cơ Servo Harmonic RHS 17-6006
Để điều khiển vị trí động cơ DC servo thông thường ta dùng hệ thống ba vòng điều chỉnh ,Tuy nhiên động cơ DC servo RHS 17- 6006 là loại động
cơ cỡ nhỏ nên có thể bỏ qua mạch vòng dòng
Ta chọn :
-Chu kỳ trích mẫu mạch tốc độ : Tw=0.001s
-Chu kỳ trích mẫu mạch vòng vị trí : Tφ=0.1s
Trang 8Hình 2.6: Cấu trúc mạch vòng điều khiển vị trí 2.3.1 Xây dựng vòng điều khiển tốc đọ
Ta coi bộ biến đổi công suất là khâu quán tính bậc nhất với : Tf=1/f với
f=30kZ(Tần số băm xung)
Hàm truyền bộ biến đổi công suất là :
0.0092 ( )
1 3.333 005 1
bd
=>Mạch vòng dòng điện có cấu trúc như sau :
2
2.133 ( )
dc s
G
s
=>Hàm truyền đối tượng mạch vòng tốc đọ có cấu trúc sau :
3
1.963 ( )
( ) dc
s G
Sử dụng công cụ SISO design của matlab=>xác định được hàm truyền
đạt của vòng điều chỉnh tốc độ là
Trang 90.05( 0.08)
( )
1
z s
z
Xấp xỉ luật PID sử dụng phương pháp hình thang cho thành phần I và phân thức sai bậc 2 cho thành phần D
1 2 3 1
( )
( )
3
7
5
2
2
r
U z
z
E z
Tv
T
Tv
T
G
z
Cấu trúc :
Hình 2.7 Mạch vòng tốc độ
Mô phỏng hệ ta được :
Trang 10Hình 2.8 Hệ tọa độ cực và đáp ứng của hệ thống trên SISO design 2.3.2 Xây dựng bộ điều khiển vị trí
Tổng hợp BĐK vị trí Rphi tương tự như các mạch vòng khác.Tuy nhiên cấu trúc của mạch vòng vị trí sẽ không có thành phần I mà chỉ là P hay PD
Trang 11Để đơn giản,ta coi BĐK vị trí là một khâu khuếch đại với hệ số
k=400,thời gian lấy mẫu la T=0.1 s
Sừ dụng khối c2000lib,chọn khối c2000 PI controller ta được cấu trúc sau :
Kết quả Mô phỏng :
Đáp ứng tốc độ
Trang 12Đáp ứng vị trí
Trang 13Kết Luận
Tài liệu tham khảo
[1] GS.TS Nguyễn Phùng Quang
Điều khiển số (Digital Control System) – Đại học Bách khoa Hà Nội – 2007
[2] Phạm Văn Khánh
Đồ án tốt nghiệp ĐTĐ47 – 2010
[3] Harmonic drive actuator – Precision Gearing & Motion Control
DC Servo System – RHS & RFS Series
[4] http://www.wattpad.com/900591-dong-co-servo ngày 25/4/2012 23h:30
