Tài liệu với các nội dung: phân tích, thiết kế cấu trúc 3D; phần động học; thiết kế quỹ đạo; mô phỏng Open GL; động lực học; thiết kế bộ điều khiển... Mời các bạn cùng tham khảo tài liệu để nắm chi tiết nội dung.
MỤC LỤC MỤC LỤC THÀNH VIÊN VÀ PHÂN CÔNG CÔNG VIỆC: CHƯƠNG 1: PHÂN TÍCH, THIẾT KẾ CẤU TRÚC 3D 1.1 Phân tích cấu trúc 1.2 Thiết kế 3D Robot Solidworks 1.2.1 Thiết kế khâu đặt hệ trục 1.2.2 Lắm ghép xuất file 15 CHƯƠNG 2: PHẦN ĐỘNG HỌC 17 2.1 Động học thuận 17 2.1.1 Tình phương trình động học cần thiết 17 2.1.2 Phương trình quỹ đạo điểm cuối, vận tốc, gia tốc 19 2.1.3 Mô động học thuận 24 2.2 Động học ngược .40 2.2.1 Giải toán động học ngược phương pháp số (Newton-raphson) 40 2.2.2 Kết tính tốn biến khớp, vận tốc khớp, giá tốc khớp 45 2.2.3 Kiểm tra tính xác tốn ngược: 49 CHƯƠNG 3: THIẾT KẾ QUỸ ĐẠO 52 3.1 Thiết kê quỹ đạo hình học đơn giản: 52 3.2 Thiết kế quỹ đạo qua điểm: .53 CHƯƠNG 4: MÔ PHỎNG OPEN GL 63 4.1 Giới thiệu chung OpenGL 63 4.2 Mơ quỹ đạo đường tròn: .76 Bài tập lớn mô hệ điện tử: Nhóm 1 CHƯƠNG 5: ĐỘNG LỰC HỌC 77 5.1 Động lực học tổng quát .77 5.3 Mô số toán động lực học ngược: 81 5.4 Mơ tốn động lực học thuận: 87 CHƯƠNG 6: THIẾT KẾ BỘ ĐIỀU KHIỂN 90 6.1 Chọn luật điều khiển PID tổng quát 90 6.2 Mô PID Simulink 92 CHƯƠNG 7: KẾT QUẢ VÀ ĐỒ THỊ 95 7.1 Mơ tả vị trí code tính tốn 95 7.2 Phần động học tổng quát : 96 7.3 Động học thuận 98 7.4 Động học ngược .105 7.5 Thiết kế quỹ đạo .111 7.6 Động lực học ngược 113 PHỤ LỤC 116 Bài tập lớn mô hệ điện tử: Nhóm THÀNH VIÊN VÀ PHÂN CÔNG CÔNG VIỆC: Họ tên Phạm Thanh Tú MSSV Phân công Đánh giá 20156794 Động học (thuận ngược 10/10 code maple, matlab) + Tích cực động lực học (tổng quát+ngược) + thiết kế quỹ Nguyễn Trọng Huy 201557 đạo 3d + xuất stl + hỗ trợ 10/10 06 mô Simulink Tích cực (sửa Nguyễn Tiến Lợi lỗi xuất, 201559 trục, body), open GL Động học (thuận, 10/10 93 code maple) + động Tích học( hỗ trợ sửa lỗi, sửa code) 3d+Mô Open GL+ 10/10 Bùi Văn Trường PID+ động lực học ( tham Tích cực Nguyễn Mạnh Thắng gia hỗ trợ giải, sửa lỗi) 20156502 3d+Mô Simulink 10/10 +PID +động lực học (viết Tích cực khối Đỗ văn Đức simulink + thuận+ngược) 20155389 PID + Hỗ trợ mô 10/10 Simulink + hỗ trợ sửa lỗi Tích cực code NOTE: - Các kết tính tốn q dài trình bày phụ lục Bài tập lớn mô hệ điện tử: Nhóm TIẾN ĐỘ HỒN THÀNH VÀ CHƯA HỒN THÀNH ST T Mục Động học Thuận Cơng việc Hoàn thành Quy luật quỹ đạo điểm cuối Yes Mơ số (Đặc biệt bất kì) Yes Ngược Mơ số đường thẳng Yes Mơ số tròn Yes Kiểm tra toán mức vận tốc Yes Thiết kế quỹ đạo Động lực Đơn giản Quỹ đạo tròn thẳng theo thời gian Yes điểm Thiết kế quy luật khớp, vận tốc Yes Tổng quát Tính ma trận khối lượng, ma trận C, phương trình vi phân Yes Ngược Tính mơ men đối vơi dạng quỹ đạo thẳng, tròn Yes Bài tập lớn mơ hệ điện tử: Nhóm 4 PID Mô Báo cáo Thuận Sử dụng kết tính ngược tính Yes ngược lại biến khớp Thiết kế Thiết kế xong PID Yes Chọn hệ Từ toán động lực học thuận số ko có PID so sánh độ lệch đồ thị (tính tốn, thực) tìm hệ số Yes Mơ Mô PID simulink Yes Open GL Chạy thành cơng quỹ đạo thẳng tròn Yes Mơ Matlab Chạy thành cơng quỹ đạo thẳng Yes tròn matlab Mơ hình có gắn PID sử dụng kết tính tốn động lực học Words Hồn thành báo cáo chi tiết Yes Power point Hoàn thành báo cáo No Bài tập lớn mơ hệ điện tử: Nhóm DANH MỤC HÌNH ẢNH Hình Mơ hình Robot hệ trục Dh tương ứng Hình Minh họa phương pháp đặt hệ trục D-H: Hình Khâu đế 13 Hình Cách đặt Hệ trục khâu đế 13 Hình Khâu .14 Hình Cách đặt hệ trục khâu .14 Hình Khâu .15 Hình Cách đặt hệ trục khâu tịnh tiến ( khâu 2) 15 Hình Khâu .16 Hình 10 Cách đặt hệ trục khâu quay (Khâu 3) 16 Hình 11 Khâu 17 Hình 12 Cách đặt hệ trục khâu quay (khâu 4) .17 Hình 13 Miền làm việc theo phương X-Y .25 Hình 14 Miền làm việc không gian Y-Z .26 Hình 15 Miền làm việc khơng gian X-Z 26 Hình 16 Miền làm việc vẽ không gian 3D 27 Hình 17 Quỹ đạo điểm cuối toán thuận kiểm tra .29 Hình 18 Quỹ đạo mơ thuận 30 Hình 19 Đồ thị vận tốc, gia tốc điểm E theo phương x 31 Hình 20 Đồ thị vận tốc, gia tốc điểm E theo phương y 31 Hình 21 Đồ thị vận tốc gia tốc điểm E theo phương z 31 Hình 22 Đồ thị vận tốc, gia tốc khối tâm khâu theo x 32 Hình 23 Đồ thị vận tốc, gia tốc khối tâm khâu theo y 33 Hình 24 Đồ thị vận tốc, gia tốc khối tâm khâu theo z 33 Hình 25 Đồ thị vận tốc, gia tốc khối tâm khâu theo x 34 Hình 26 Đồ thị vận tốc, gia tốc khối tâm khâu theo y 34 Bài tập lớn mô hệ điện tử: Nhóm Hình 27 Đồ thị vận tốc, gia tốc khối tâm khâu theo z 35 Hình 28 Đồ thị vận tốc, gia tốc khối tâm khâu theo x 35 Hình 29 Đồ thị vận tốc, gia tốc khối tâm khâu theo y 36 Hình 30 Đồ thị vận tốc, gia tốc khối tâm khâu theo z 36 Hình 31 Đồ thị vận tốc, gia tốc khối tâm khâu theo x 37 Hình 32 Đồ thị vận tốc, gia tốc khối tâm khâu theo y 37 Hình 33 Đồ thị vận tốc, gia tốc khối tâm khâu theo z 38 Hình 34 Vận tốc gia tốc góc khâu theo x,y,z 39 Hình 35 Vận tốc gia tốc góc khâu theo x,y,z 40 Hình 36 Vận tốc gia tốc góc khâu theo x,y,z 41 Hình 37 Vận tốc gia tốc góc khâu theo x,y,z 42 Hình 38 Quỹ đại điểm cuối theo quy luật cho trước .44 Hình 39 Đồ thị kiểm tra 45 Hình 40 Vẽ hai đồ thị miền 45 Hình 41 Đồ thị quy luật cho trước 46 Hình 42 Đồ thị kiểm tra 47 Hình 43 Vẽ hai đồ thị miền 47 Hình 44 Đồ thị q1 48 Hình 45 Đồ thị q2 49 Hình 46 Đồ thị q3 50 Hình 47 Đồ thị q4 51 Hình 48 Đồ thị vận tốc thực vận tốc kiểm tra phương x 52 Hình 49 Đồ thị vận tốc thực vận tốc kiểm tra phương y 53 Hình 50 Đồ thị vận tốc thực vận tốc kiểm tra phương z 53 Hình 51 Quỹ đạo đoạn 59 Hình 52 Quỹ đạo đoạn 60 Hình 53 Quỹ đạo đoạn 60 Hình 54 Quỹ đạo đoạn 61 Bài tập lớn mơ hệ điện tử: Nhóm Hình 55 Quỹ đọa qua điểm .61 Hình 56 Đồ thị vận tốc theo phương x 63 Hình 57 Đồ thị vận tốc theo phương y 64 Hình 58 Đồ thị vận tốc theo phương z 65 Hình 59 Mơ quỹ đạo tròn 79 Hình 60 Mơ hình động học Robotác thông số đầu vào: 81 Hình 61 Mơ tả sumlink giải động học ngược 85 Hình 62 Đồ thị MoMen khâu .85 Hình 63 Đồ thị Lực khâu 86 Hình 64 Đồ thị Momen khâu 86 Hình 65 Đồ thị Momen khâu 87 Hình 66 Đồ thị Momen khớp .87 Hình 67 Đồ thị Lực khớp 88 Hình 68 Đồ thị Momen khớp .88 Hình 69 Đồ thị Momen khớp .89 Hình 70 Mô tả simulink giải động học thuận 90 Hình 71 Đồ thị tính tốn so sánh q1 91 Hình 72 Đồ thị tính tốn so sánh q2 91 Hình 73 Đồ thị tính tốn so sánh q3 92 Hình 74 Đồ thị tính tốn so sánh q4 92 Hình 75 Mơ hình điều khiển tổng quát 93 Hình 76 Mơ hình điều khiển PID thiết kế Thiết kế: 93 Hình 77 Toàn sơ đồ PID 95 Hình 78 Tín hiệu đặt 96 Hình 79 Khối tính Mơ men, Lực 96 Hình 80 Khối tính biến khớp thực tế theo lực, mơ men điều khiển 97 Hình 81 Khối so sánh lực thực tế tính tốn 97 Hình 82 Khối PID 97 Bài tập lớn mơ hệ điện tử: Nhóm Hình 83 quỹ đạo điểm cuối toán thuận theo quỹ đạo tùy ý bên .102 Hình 84 Đồ thị vận tốc gia tốc điểm cuối 103 Hình 85 Vận tốc gia tốc góc khâu theo x,y,z 104 Hình 86 Vận tốc gia tốc góc khâu theo x,y,z 105 Hình 87 Vận tốc gia tốc góc khâu theo x,y,z 106 Hình 88 Vận tốc gia tốc góc khâu theo x,y,z 107 Hình 89 Kiểm tra quỹ đạo thẳng 108 Hình 90 Kiểm tra quỹ đạo tròn 109 Hình 91 Kiểm tra khớp .110 Hình 92 Kiểm tra khớp .110 Hình 93 Kiểm tra khớp .111 Hình 94 Kiểm tra khớp .111 Hình 95 kiểm tra vận tốc phương x .112 Hình 96 kiểm tra vận tốc phương y .112 Hình 97 Kiểm tra vận tốc phương z 113 Hình 98 Đồ thị quỹ đạo điểm chọn 115 Bài tập lớn mô hệ điện tử: Nhóm CHƯƠNG 1: PHÂN TÍCH, THIẾT KẾ CẤU TRÚC 3D 1.1 Phân tích cấu trúc Bài tập lớn mơ hệ điện tử: Nhóm 10 7.5 Thiết kế quỹ đạo Đầu vào: Thiết kế quỹ đạo trơn điều khiển vận tốc qua điểm Đầu Phương trình q1: Phương trình q2 Phương trình q3: Bài tập lớn mơ hệ điện tử: Nhóm 149 Phương trình q4: Đồ thị: Hình 136 Đồ thị quỹ đạo điểm chọn Bài tập lớn mô hệ điện tử: Nhóm 150 7.6 Động lực học ngược Đầu vào: Đường tròn: Đường thẳng: Bài tập lớn mơ hệ điện tử: Nhóm 151 Đầu ra: Đường tròn: Bài tập lớn mơ hệ điện tử: Nhóm 152 Đường thẳng: Bài tập lớn mơ hệ điện tử: Nhóm 153 7.7 Động lực học thuận: Đầu vào: Các lực, Mô men tính từ tốn động lực học ngược Bài tốn khơng dùng PID: Bài tốn có dùng PID: Đường thẳng Bài tập lớn mô hệ điện tử: Nhóm 154 Đường tròn Bài tập lớn mơ hệ điện tử: Nhóm 155 Bài tập lớn mơ hệ điện tử: Nhóm 156 PHỤ LỤC Các phương trình động học tìm được: Bài tập lớn mơ hệ điện tử: Nhóm 157 Ma trận chuyển khâu cố định Bài tập lớn mô hệ điện tử: Nhóm 158 Các hàm tọa độ khâu cuối theo thời gian (quy luật động học thuận): Các vận tốc tốc khâu cuối: Bài tập lớn mơ hệ điện tử: Nhóm 159 Các ma trận khối tâm khâu với hệ sở: Các ma trận Jacobi tịnh tiến khối tâm: Bài tập lớn mô hệ điện tử: Nhóm 160 Các ma trận sóng: Bài tập lớn mơ hệ điện tử: Nhóm 161 Các ma trận vận tốc góc khâu Các ma trận gia tốc góc: Bài tập lớn mơ hệ điện tử: Nhóm 162 10.Các ma trận Jacobi quay 11 Ma trận khối lượng M: 12 Ma trận C: 13 Các phương trình vi phân chuyển động: Bài tập lớn mô hệ điện tử: Nhóm 163 ... đặt hệ trục khâu quay (khâu 4) 1.2.2 Lắm ghép xuất file Bài tập lớn mô hệ điện tử: Nhóm 20 - Hình ảnh ghép ( khâu) - Các bước xuất file dùng để mô phỏng: Bài tập lớn mô hệ điện tử: Nhóm 21 Bài tập. .. để hiển thị hệ trục: - Hình ảnh thiết kế 3D ( khâu): Bài tập lớn mô hệ điện tử: Nhóm 15 Hình Khâu đế - Hệ trục đặt khâu khớp 1: Hình Cách đặt Hệ trục khâu đế Bài tập lớn mơ hệ điện tử: Nhóm 16... trục Cách đặt hệ trục mong muốn solidword: Chọn Move/copy , bơi đen tồn khâu Bài tập lớn mô hệ điện tử: Nhóm 13 Chọn tọa độ điểm đầu điểm cần đặt hệ trục: Bài tập lớn mô hệ điện tử: Nhóm 14 Chọn