Thiết kế hệ thống cơ điện tử cho robot hai bậc tự do RR
Lớp : CĐT2 K55 ĐẠI HỌC BÁCH KHOA HÀ NỘI VIỆN CƠ KHÍ ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ Đề tài THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ CHO ROBOT HAI BẬC TỰ DO RR Giáo viên hướng dẫn Ths MẠC THỊ THOA Sinh viên thực hiện Đinh Đức Anh Hà Nội 12/2013 NỘI DUNG TRÌNH BÀY 1. Giới thiệu chung về robot công nghiệp 2. Thiết kế mô hình 3D của robot RR 3. Tính toán động học thuận, ngược robot RR 4. Bài toán tĩnh học robot RR 5. Bài toán động lực học Robt RR 6. Thiết kế quỹ đạo chuyển động 7. Điều khiển và mô phỏng robot 1. GIỚI THIỆU CHUNG VỀ ROBOT Trên thế giới: Năm 1921, thuật ngữ “Robot” xuất phát từ tiếng CH Séc(Czech), nó xuất hiện lần đầu tiên trong một vở kịch Rossum’s Universal Robot của Karel Capek cùng năm đó. Cho đến nay, thế giới đã có những bước phát triển vô cùng mạnh mẽ trong lĩnh vực Robot.đặc biệt là các nước có nền công nghiệp phát triển như : Anh, Thụy Điển,Nhật,Mỹ, CHLB Đức,Pháp, Ý……. Trong nước: Tháng 4/1998 Nhà máy Rorze/Robotech chế tạo và lắp ráp đặt ở Hải Phòng với vốn 46 triệu đôla, đi vào hoạt động. Năm 2002, công ty TOSY của Việt Nam thành lập, nghiên cứu chế tạo Robot giải trí, tới nay đã có hơn 800 thành viên. Tháng 10/2003, Hội khoa học và công nghệ Robot Việt Nam được thành lập. 2. THIẾT KẾ MÔ HÌNH 3D CỦA ROBOT RR Ta thiết kế mô hình 3D của robot có dạng như sau 3. TÍNH TOÁN ĐỘNG HỌC THUẬN VÀ NGƯỢC Ta có sơ đồ đặt hệ tọa độ cho robot theo quy tắc Denavit-Hatenberg như sau : BẢNG DH VÀ KHÔNG GIAN LÀM VIỆC Sau khi chọn trục tọa độ như trên ta có bảng DH: Với giá trị giới hạn góc xoay các biến khớp như trên thì ta có không gian làm việc (hay vùng làm việc ) của robot có thể vẽ như sau: Không gian làm việc của robot Dạng tổng quát của ma trân Denavit-Havtenberg cho các khâu có dạng như sau : Ma trận Denavit-Hatenberg của khâu 1: Ma trận Denavit-Hatenberg của khâu 2 CÁC MA TRẬN TRUYỀN DH Thiết lập các phương trình động học Từ các ma trận trên ta xác định được ma trận biến đổi tọa độ thuần nhât của khâu 2 so với khâu cố định là: Ma trận trên cho ta biết vị trí và hướng của khâu thao tác trong hệ tọa độ cố định hay nói cách khác là vị trí của điểm tác động cuối và hướng của hệ tọa độ động gắn vào khâu tại điểm tác động cuối trong hệ tọa độ cố định,nên có thể biểu diễn qua các biến khớp qi Thiết lập các phương trình động học(?ếp) Ta có ma trận Cacdan biểu diễn hướng của hệ tọa độ động cuối đối với khâu đế Từ ma trận trên kết hợp với ma trận Thì ta có các phương trình động học Robot [...]... gia tốc của khớp Khớp 1 6 thiết kế quỹ đạo chuyển động (tiếp) Khớp 2 6 thiết kế quỹ đạo chuyển động (tiếp) 6 thiết kế quỹ đạo chuyển động (tiếp) 6.2 Thiết kế quỹ đạo theo không gian làm việc 6 thiết kế quỹ đạo chuyển động (tiếp) Ta được đồ thị 6 thiết kế quỹ đạo chuyển động (tiếp) Hình vẽ mô phỏng vị trí cơ cấu theo t khi đó 6 thiết kế quỹ đạo chuyển động (tiếp) 6.3 thiết kế quỹ đạo chuyển động điểm cuối... giữa hai vị trí sẽ thỏa mãn 4 điều kiện : vị trí ban đầu và vị trí cuối cùng, tốc độ tại vị trí ban đầu và tốc độ tại vị trí cuối cùng Do đó đa thức bậc 3 sẽ phù hợp với quỹ đạo của khớp robot: 6 thiết kế quỹ đạo chuyển động (tiếp) 6 thiết kế quỹ đạo chuyển động (tiếp) Khớp 1 Khớp 2 6 thiết kế quỹ đạo chuyển động (tiếp) Ta thu được các đồ thị tương ứng của vị trí, vận tốc và gia tốc của khớp Khớp 1 6 thiết. .. hình 4 Bài toán tĩnh học (tiếp) Phương pháp: 4 Bài toán tĩnh học (tiếp) Kết quả 5 Tính toán động lực học Mô hình 5 Tính toán động lực học (tiếp) Ma trận khối lượng suy rộng 5 Tính toán động lực học (tiếp) Sau khi thay các thông số vào ta thu được các phương trình vi phân chuyển động của robot 6 thiết kế quỹ đạo chuyển động 6.1 thiết kế quỹ đạo theo không gian khớp Là xác định đường biểu diễn của vị trí...Động học thuận Chọn quy luật chuyển động bất kì như sau: Động học thuận (tiếp) Thay các giá trị trên vào phương trình ta được : Do thi xE,yE,zE 150 100 như hình vẽ xE,yE,zE [cm] Và được đồ thị 50 0 -50 -100 -150 xE yE zE 0 1 2 3 4 5 t [s] 6 7 8 9 10 Đồ thị vận tốc và gia tốc điểm tác động cuối Với các thông số đã chọn như trên... chuyển động (tiếp) Hình vẽ mô phỏng vị trí cơ cấu theo t khi đó 6 thiết kế quỹ đạo chuyển động (tiếp) 6.3 thiết kế quỹ đạo chuyển động điểm cuối di chuyển theo đường tròn đường kính AB Tiến hành giải hệ phương trình ta thu được . Lớp : CĐT2 K55 ĐẠI HỌC BÁCH KHOA HÀ NỘI VIỆN CƠ KHÍ ĐỒ ÁN THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ Đề tài THIẾT KẾ HỆ THỐNG CƠ ĐIỆN TỬ CHO ROBOT HAI BẬC TỰ DO RR Giáo viên hướng dẫn Ths MẠC THỊ THOA Sinh. chung về robot công nghiệp 2. Thiết kế mô hình 3D của robot RR 3. Tính toán động học thuận, ngược robot RR 4. Bài toán tĩnh học robot RR 5. Bài toán động lực học Robt RR 6. Thiết kế quỹ đạo. nghệ Robot Việt Nam được thành lập. 2. THIẾT KẾ MÔ HÌNH 3D CỦA ROBOT RR Ta thiết kế mô hình 3D của robot có dạng như sau 3. TÍNH TOÁN ĐỘNG HỌC THUẬN VÀ NGƯỢC Ta có sơ đồ đặt hệ tọa độ cho robot