Nâng cao chất lượng điều khiển cho robot Scara, chương 11

Chia sẻ: Van Teo | Ngày: | Loại File: PDF | Số trang:10

Thêm vào BST

Báo xấu

243
lượt xem 86
download

Download Vui lòng tải xuống để xem tài liệu đầy đủ

Đặt vấn đề Trong chương III đã tiến hành xây dựng mô hình của các khâu tính toán, mô hình robot và bộ điều khiển PID. Sau đó đã xây dựng các chương trình phục vụ mô phỏng và khảo sát các chế độ làm việc của hệ thống. Trong chương này sẽ trình bày các kết quả khảo sát nhận được thông qua các chương trình mô phỏng nêu trên. Thông qua việc đánh giá sai số quỹ đạo đặt và quỹ đạo thực để đánh giá chất lượng điều chỉnh bám chính xác của phương pháp điều khiển...

Chủ đề:

Bình luận(0) Đăng nhập để gửi bình luận!

Lưu

Nội dung Text: Nâng cao chất lượng điều khiển cho robot Scara, chương 11

CHƯƠNG 11 MÔ PHỎNG VỚI MÔ HÌNH ROBOT SCARA SERPENT 4.1. Đặt vấn đề Trong chương III đã tiến hành xây dựng mô hình của các khâu tính toán, mô hình robot và bộ điều khiển PID. Sau đó đã xây dựng các chương trình phục vụ mô phỏng và khảo sát các chế độ làm việc của hệ thống. Trong chương này sẽ trình bày các kết quả khảo sát nhận được thông qua các chương trình mô phỏng nêu trên. Thông qua việc đánh giá sai số quỹ đạo đặt và quỹ đạo thực để đánh giá chất lượng điều chỉnh bám chính xác của phương pháp điều khiển được nghiên cứu. Việc mô hình hóa và nghiên cứu mô phỏng hệ thống điều khiển chuyển động được thực hiện trên nền Matlab-Simulink, giao diện GUI. 4.2. Sơ đồ mô hình hóa các khâu của hệ thống 4.2.1. Mô hình chung của robot Tạo quỹ đạo & d,d Bộ điều Cơ cấu chấp & tt ,tt ui chuyển khiển mô hành động chuẩn men động (Robot) Phản hồi
Hình 4.1: Sơ đồ khối mô hình hóa robot Scara Serpent sử dụng bộ điều khiển mômen động. Động lực học của robot Scara Serpent được mô tả bằng hệ phương trình trạng thái (2.71), (2.72) và (2.73) tương ứng với 3 khớp quay của robot. Mỗi hệ phương trình vi phân cho từng khớp gồm hai phương trình vi phân với biến trạng thái là góc quay  q i ( x i1 ) và tốc độ góc của khớp q i ( x i 2 ) . Các biến trạng thái đó sẽ được xác định bằng tích phân các trạng thái tương ứng (Hình 3.3). 4.2.2. Mô hình khối tạo quỹ đạo chuyển động chuẩn Hình 4.2 mô tả sơ đồ khối tạo quỹ đạo chuyển động chuẩn. Các điều kiện đầu và cuối của quỹ đạo chuyển động chuẩn được tính thông qua các toạ độ đặt (x0, y0), (x c, yc) và thời gian chuyển động (td). Quỹ đạo chuyển động chuẩn của cả 3 khớp được xác định theo 3 giai đoạn: gia tốc, tốc độ không đổi và giảm tốc, biểu diễn bằng các phương trình (3.8), (3.10) và (3.14).
Hình 4.2: Sơ đồ khối tạo quỹ đạo chuyển động chuẩn. 4.2.3. Mô hình bộ điều khiển Hình 4.3: Mô hình bộ điều khiển cho khớp 1 của robot Scara Serpent. Các khớp 2, 4 có mô hình bộ điều khiển cũng tương tự như khớp 1. Bộ tham số [KP, KI, KD] của bộ điều khiển PID được chọn theo phương pháp Ziegler – Nichols.
4.3. Giao diện chương trình mô phỏng robot Scara Serpent Khi chạy chương trình mô phỏng ta đánh lệnh >> RBSCARA_SP trên cửa sổ chính của chương trình Matlab, trên màn hình hiện ra bảng làm việc chính như sau: Hình 4.4: Menu chính của chương trình. Chương trình RBSCARA_SP gồm các chức năng chính sau: - Nhập các thông số cho mô hình. - Động học thuận. - Động học ngược. - Mô phỏng.
- Hiển thị. - Thoát. Chương trình được thiết kế trên giao diện GUI trong Matlab, với các nút thực hiện các chức năng như trên. Các chức năng của chương trình được giới thiệu như ở dưới: Các thông số của robot Scara Serpent được nhập vào khối thông số của robot như Hình 4.5. Hình 4.5: Thông số của mô hình robot Scara Serpent. Khi ta nhấn vào nút Động học thuận: Chương trình tính vị trí điểm tác động cuối của robot khi biết giá trị góc quay các khớp như Hình 4.6.
Hình 4.6: Động học thuận robot Scara Serpent. Nhập giá trị góc quay các biến khớp 1 và 2 với giới hạn góc quay như sau: 1 = -96 0  960 (so với trục Ox); 2 = -115 0  1150 (so với trục thanh 1). Chương trình sẽ báo lỗi nếu giá trị nhập vào không nằm trong giới hạn góc quay:
Hình 4.7: Động học thuận robot Scara Serpent (báo lỗi). Khi ta nhấn vào nút Động học ngược: Chương trình tính góc quay của các khớp khi biết vị trí tọa độ của tay máy robot như Hình 4.8.
Hình 4.8: Động học ngược robot Scara Serpent. Tay robot được thiết kế chuyển động theo một quỹ đạo xuất phát từ vị trí ban đầu có toạ độ điểm đầu (x0, y0) đến vị trí cuối có toạ độ điểm cuối (xc, yc) với thời gian chuyển động là td (Hình 4.2). Các toạ độ ban đầu và kết thúc phải thoả mãn điều kiện (4.1) và giá trị định vị Nx phải thoả mãn điều kiện (4.2). Và X 2  Y 2  (0.4) 2 . (4.1) Giá trị định vị : Nx < 1. ( 4.2) Chương trình sẽ báo lỗi nếu giá trị (X, Y, N x ) nhập vào không nằm trong giới hạn: Hình 4.9: Động học ngược robot Scara Serpent (báo lỗi).
Khi ta nhấn vào nút Mô phỏng: Mô hình sẽ hiện ra như Hình 4.10.
Hình 4.10: Sơ đồ khối mô hình chuẩn robot Scara Serpent. Khi ta nhấn vào nút Hiển thị: Đưa ra bảng thông số của robot như Hình 4.11. Hình 4.11: Bảng thông số của robot Scara Serpent.