Thiết kế mạch điều khiển mô hình cánh tay máy 5 bậc tự do dùng vi xử lý 8085

chinh sua boi: nguyenvanbientbd47@gmail.com BỘ GIÁO DỤC & ĐÀO TẠO CỘNG HÒA Xà HỘI CHỦ NGHĨA VIỆT NAM ĐẠI HỌC QUỐC GIA TP.HCM ĐỘC LẬP- TỰ DO- HẠNH PHÚC TRƯỜNG ĐẠI HỌC SƯ PHẠM KỸ THUẬT KHOA ĐIỆN BỘ MÔN ĐIỆN TỬ NHIỆM VỤ ĐỒ ÁN TỐT NGHIỆP Họ và tên : LÊ TẤN MINH Lớp :95 KĐĐ Nghành : Kỹ thuật Điện –Điện Tử 1-Tên đề tài : THIẾT KẾ MẠCH ĐIỀU KHIỂN MÔ HÌNH CÁNH TAY MÁY 5 BẬC TỰ DO DÙNG VI XỬ LÝ 8085 2 – Các số liệu : -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- 3 – Nội dung của phần thuyết minh tính toán : -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- 4 – Các bản vẽ : ---------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- 5 – Giáo viên hướng dẫn : NGUYỄN THANH BÌNH 6 – Ngày giao nhiệm vụ : 7 – Ngày hoàn thành nhiệm vụ : Giáo viên hướng dẫn Thông qua bộ môn Ngày 28 tháng 2 năm 2000 Chủ nhiệm bộ môn chinh sua boi: nguyenvanbientbd47@gmail.com NHẬN XÉT CỦA GIÁO VIÊN HƯỚNG DẪN ----------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ----------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- ------------------------------------------------------------------------------------------------------------- Giáo viên hướng dẫn chinh sua boi: nguyenvanbientbd47@gmail.com NHẬN XÉT CỦA GIÁO VIÊN DUYỆT ----------------------------------------------------------------------------------------------------------- ----------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- -------------------------------------------------------------------------------------------------------------- Giáo viên duyệt chinh sua boi: nguyenvanbientbd47@gmail.com Lời nói đầu Trong những năm gần đây theo sự tiến bộ của khoa học kỹ thuật, công cuộc công nghiệp hóa hiện đại hóa đất nước đang diễn ra khá tốt đẹp. Trước tình hình đó đã có khá nhiều yêu cầu cấp bách và cũng là những thách thức được đặt ra cho giới trí thức. Tay máy công nghiệp là một lĩnh vực mới mà ở Việt Nam đang nghiên cứu và từng bước chế tạo để ứng dụng vào quá trình sản xuất góp phần nâng cao năng xuất lao động. Kỹ thuật vi xử lí rất ưu việt đã trở nên rất cần thiết trong ngành điện tử, nó đã thay thế các thiết bị có cấu tạo phức tạp thành đơn giản. Ưùng dụng vi xử lí rất rộng rải từ máy móc quan trọng trong nền công nghiệp đến các thiết bị chuyên dùng. Với các ưu điểm về các chỉ tiêu kỹ thuật và tính linh hoạt của vi xử lí, việc nghiên cứu và ứng dụng vi xử lí rất cần thiết. Không nên dừng lại ở cách sử dụng, cách tốt nhất để hiểu rỏ thiết bị mới và đi sâu vào tìm hiểu bản chất hoạt động bên trong của thiết bị đó. Thực hiện đề tài : “THIẾT KẾ MẠCH ĐIỀU KHIỂN MÔ HÌNH CÁNH TAY MÁY NĂM BẬC TỰ DO” như là một cách để thể hiện một phần trong những kiến thức mà em đã đạt được sau năm năm học tập tại trường. Do có sự hạn chế về thời gian cũng như kiến thức và kinh nghệm nên không tránh khỏi những sai sót. Rất mong nhận được ý kiến đóng góp của quý thầy cô và các bạn sinh viên Khoa Điện về đề tài này. Thủ Đức Ngày 28 Tháng 02 Năm 2000 Sinh Viên Thực Hiện LÊ TẤN MINH chinh sua boi: nguyenvanbientbd47@gmail.com LỜI CẢM TẠ Tập đồ án được hoàn thành như là một bước ngoặt báo hiệu kết thúc thời gian học tập tại trường ĐHSPKT. Nếu không có sự đóng góp về nhiều phía chắc chắn người thực hiện dề tài này khó mà đạt được nhũng kết quả sau 5 năm học đại học Đó là sự đóng góp tích cực về vật chất, sự ủng hộ động viện tinh thần về phía gia đình – đã hình thành một chỗ dựa vững chắc. Em sẽ mãi mãi ghi nhớ. Được học môn vi xử lý và các môn khác cùng với sự trực tiếp hướng dẫn nhiệt tình của thầy Nguyễn Thanh Bình giúp em thực hiện đề tài. Xin chân thành cảm ơn. Trong số kiến thức mà em đạt được có sự đóng góp của nhiều thầy cô, cùng với sự giúp đỡ, những lời động viên đúng lúc trong khi học và trong thời gian thực hiện đề tài của các bạn sinh viên Khóa 95 KĐĐ, có lẽ em không thể nào quên. Thủ Đức Ngày 28 Tháng 02 Năm 2000 Sinh Viên Thực Hiện LÊ TẤN MINH chinh sua boi: nguyenvanbientbd47@gmail.com Chương 1 chinh sua boi: nguyenvanbientbd47@gmail.com 1.1 ĐẶT VẤN ĐỀ Sự phát triển của khoa học kỹ thuật ngày càng nhanh góp phần nâng cao năng suất lao động. Đặt biệt sự ra đời và phát triển của công nghệ chế tạo Robot nhằm tạo ra sự tự động hóa trong quá trình sản xuất giảm đi sức lao động bằng chân tay của người lao động Đối với các nưước ngoài thì Robot đã được nghiên cứu và chế tạo để ứng dụng vào sản suất đả có từ trước. Riêng ở nước ta lĩnh vực này còn khá mới mẽ. Tuy có sự đầu tư để nghiên cứu nhưng còn hạn chế ,có thể dùng mô hình cánh tay máy để phục vụ trực tiếp cho công việc giảng dạy tại trường nhằm giúp cho sinh viên hiểu rỏ hơn về lý thuyết, tạo điều kiện cho việc dạy và học được sinh động hơn . Bức xúc trước nhu cầu tìm hiểu về tay máy công nghiệp từ chính bản thân và của những người yêu thích về lĩnh vực này, nhóm đã bắt tay vào việc thực hiện nghiên cứu đề tài: “THIẾT KẾ MẠCH ĐIỀU KHIỂN MÔ HÌNH CÁNH TAY MÁY NĂM BẬC TỰ DO”. 1.2 TẦM QUAN TRỌNG CỦA VẤN ĐỀ Ở Việt Nam nói chung công nghệ chế tạo tay máy còn chậm phát triển, chúng ta vẩn chưa có nhà máy nào có khả năng chế tạo các bộ phận cấu thành của tay máy đạt tiêu chuẩn quốc tế. Tận dụng những vật liệu có sẳn để gia công các chi tiết cơ khí cũng như linh kiện , thiết bị điện có sẳn do nước ngòai sản suất để thiết kế thành những sản phẩm cụ thể trước hết là ứng dụng làm phương tiện giảng dạy trong trường học và từ đó phát triển cao hơn để ứng dụng vào trong sản suất đã và đang là hướng đi đúng đắng của các kỹ sư ở Việt Nam . Đề tài : “THIẾT KẾ MẠCH ĐIỀU KHIỂN MÔ HÌNH CÁNH TAY MÁY NĂM BẬC TỰ DO” không nằm ngoài nhận định trên. Điều quan trọng hơn hết là các vấn đề liên quan đến cấu tạo, nguyên lý hoạt động của tay máy và phần lý thuyết về các hoạt động xảy ra bên trong vi xử lí sẽ được giới thiệu trong đề tài này. Nó sẽ là nguồn thông tin hửu ích cho những ai muốn tìm hiểu về lĩnh vực này. 1.3 GIỚI HẠN VẤN ĐỀ Tay máy rất đa dạng về nguồn gốc và chủng loại đây là lần đầu thực hiện nghiên cứu đề tài: “THIẾT KẾ MẠCH ĐIỀU KHIỂN MÔ HÌNH CÁNH TAY MÁY NĂM BẬC TỰ DO” trong điều kiện: • Thời gian thực hiện đề tài chỉ trong 6 tuần • Kinh nghiệm thực tế chưa có nhiều • Tài liệu về vi xử lí và tay máy còn hiếm Vì vậy nhóm đã thực hiện nghiên cứu đề tài với những đặc điểm chính sau đây: • Lập trình bằng KIT vi xử lí 8085 • Thiết kế mạch điều khiển cánh tay máy • Xây dựng những chương trình tiêu biểu 1.4 MỤC ĐÍCH NGHIÊN CỨU Thực hiện đề tài “THIẾT KẾ MẠCH ĐIỀU KHIỂN MÔ HÌNH CÁNH TAY MÁY NĂM BẬC TỰ DO” là một công việc để người thực hiện đề tài nghiên cứu kỹ khái niệm mô hình, nguyên lý làm việc cũng như tập lệnh của vi xử lí. Sản phẩm của đề tài trước hết có thể được ứng dụng vào phương tiện giảng dạy tại trường; và nếu được phát triển rộng, đi sâu hơn thì có thể ứng dụng vào trong thực tế chinh sua boi: nguyenvanbientbd47@gmail.com sản xuất công nghiệp,và đặc biệt cung cấp một cái nhìn tổng quát về vi xử lí và tay máy công nghiệp. chinh sua boi: nguyenvanbientbd47@gmail.com CHƯƠNG 2 chinh sua boi: nguyenvanbientbd47@gmail.com 2.1 DÀN Ý NGHIÊN CỨU • Giới thiệu tổng quát về tay máy • Thiết kế mạch điều khiển cánh tay máy • Xây dựng phần mềm • Thi công • Hướng dẫn thao tác 2.2 ĐỐI TƯỢNG NGHIÊN CỨU Chủ yếu là mô hình cánh tay máy được gia công 2.3 PHƯƠNG PHÁP VÀ PHƯƠNG TIỆN NGHIÊN CỨU  Phương Pháp Tham khảo tài liệu: chủ yếu là các tài liệu về kỹ thuật số, kỹ thuật vi xử lí, điện tử cơ bản Thực nghiệm: viết chương trình thử nghiệm trên KIT vi xử lý 8085  Phương Tiện • Ngòai KIT vi xử lí 8085 và mô hìmh cánh tay máy, nhóm còn thực hiện dề tài còn thiết kế thêm các mạch phụ để thử nghiệm các chương trình liên quan đến 8255 và 8279 2.4 THỜI GIAN NGHIÊN CỨU Nhóm thực nghiên cứu đề tài từ ngày đăng ký đề tài, công việc được phân bố cho 6 tuần làm việc như sau: Tuần 1 : Lập đề cương tổng quát Tuần 2 : Thu thập tài liệu Tuần 3 : Lập đề cương chi tiết Tuần 4,5 : Khai triển đề cương và đánh máy Tuần 6 : Sửa chữa và in ấn chinh sua boi: nguyenvanbientbd47@gmail.com CHƯƠNG 3 chinh sua boi: nguyenvanbientbd47@gmail.com 3.1 LỊCH SỬ PHÁT TRIỂN Thuật ngữ ROBOT xuất hiện vào năm 1920 trong một tác phẩm văn học của nhà văn Tiệp Khắc có tên Karel Capek. Thuật ngữ Inducstrial Robot (IR) - xuất hiện đầu tiên ở Mỹ do công ty AMF (American Manchine and Foundry company) quảng cáo mô tả một thiết bị mang dáng dấp và có một số chức năng như tay người được điều khiển tự động để thực hiện một số thao tác sản xuất thiết bị có tên gọi Versatran. Quá trình phát triển của IR có thể tóm tắt như sau: - Từ những năn 50 ở Mỹ xuất hiện viện nghiên cứu đầu tiên. - Đang đầu những năm 60 xuất hiện sản phẩm đầu tiên tên Versatran của công ty AMF. - Ở Anh người ta bắt đầu nghiên cứu và chế tạo các IR theo bản quyền của Mỹ từ năm 1967; - Ở các nước Tây Âu khác như : Đức, Ý, Pháp, Thụy Điển, từ những năm 70. - Châu Á có Nhật bắt đầu nghiên cứu ứng dụng IR từ năm 1968. Đến nay trên thế giới có khoảng trên 20 công ty sản xuất IR trong số đó có 80 công ty của Nhật , 90 công ty của các nước Tây Âu, 30 công ty của Mỹ và một số công ty ở Nga, Tiệp … Theo chủng loại, mức độ điều khiển, và khả năng nhận biết thông tin của tay máy - người máy đã được sản xuất trên thế giới có thể phân loại các IR thành các thế hệ sau: Thế hệ 1 : thế hệ có kiểu điều khiển theo chu trình dạng chương trình cứng không có khả năng nhận biết thông tin Thế hệ 2 : thế hệ có kiểu điều khiển theo chu kì dạng chương trình mềm bước đầu đa có khả năng nhận biết thông tin Thế hệ 3 : thế hệ có kiểu điều khiển dạng tinh khôn ,có khả năng nhận biết thông tin và bước đầu đã có một số chức năng lý trí của con người Đối với tay máy công nghiệp đã có hơn 250 loại ,trong số đó có hơn 40% là loại tay máy có kiểu điều khiển đơn giản thuộc thế hệ thứ nhất . Sự xuất hiện của robot và sự gia tăng vai trò của chúng trong sản xuất và xã hội loài người làm xuất hiện một ngành khoa học mới là ngành robot học (Robotic) . trên thế giới ở nhiều nước đã xuất hiện những viện nghiên cứu riêng về robot . Ở Việt Nam, từ những năm giữa của thập kỷ 80 đã có viện nghiên cứu về robot . 3.2 SƠ ĐỒ CẤU TRÚC CHỨC NĂNG CỦA IR Vậy robot là gì ? cho tới hiện nay chưa có một định nghĩa chính xác về robot, và cứ hai năm một lần trên thế giới người ta lại tổ chức một hội nghị khoa học bàn về robot nhằm thông tin những thành tựu đã đạt được trong nghiên cứu và chế tạo robot đồng thời thống nhất các thuật ngữ về robotic. để hiểu được về IR, trước hết chúng ta quan sát sơ đồ cấu trúc và chức năng của IR như sau: chinh sua boi: nguyenvanbientbd47@gmail.com Hình 3.1 : Sơ đồ cấu trúc và chức năng của robot Trong sơ đồ trên các đường chỉ thị mối quan hệ thông tin thuận , thông tin chỉ huy thực hiện nhiệm vụ cho robot. Các đường chỉ mối liên hệ thông tin ngược, thông tin phản hồi về quá trình làm việc của robot. Chức năng của bộ phận giao tiếp là liên lạc với người vận hành là thực hiện quá trình “Dạy học “ cho robot, nhờ đó Robot biết được nhiệm vụ phải thực hiện. Chức năng của hệ thống điều khiển là thực hiện việc tái hiện lại các hành động (nhiệm vụ) đã được ‘học’. Bộ phận chấp hành giúp cho Robot có đủ “sức”, tức chịu được tải trọng mà robot phải chịu trong quá trình làm việc , bộ phận này bao gồm các bộ phận, phần 1 - bộ phận truyền chuyển động - phần tạo các khả năng chuyển động cho robot và phần 2 - bộ phận chịu lực - phần chịu lực của Robot . Bộ phận cảm biến tín hiệu làm nhiệm vụ nhận biết, đo lường và biến đổi thông tin các loại tín hiệu như: các nội tín trong bản thân Robot - đó là các tín hiệu về vị trí, vận tốc, gia tốc trong từng thành phần của bộ phận chấp hành các ngoại tín hiệu - là các tín hiệu từ môi trường bên ngoài có ảnh hưởng tới hoạt động của Robot . Với cấu trúc và chức năng như trên Robot phần nào mang tính “người“ còn phần máy chính là trạng thái vật lý của cấu trúc. Với IR, tính chất người và ”máy” cũng được thể hiện đầy đủ như trên, duy chỉ hình thức mang dáng dấp của tay “Người”. Người vận hành Thiết bị liên lạc với người vận hành Hệ thống đều khiển Hệ thống Truyền động Hệ thống chịu lực Hệ thống cảm biến tín hiệu Môi trường Bên ngoài Liênhệ ngược Liên hệ nguợc chinh sua boi: nguyenvanbientbd47@gmail.com 3.3 CẤU TRÚC TỔÀNG QUÁT CỦA IR Chúng ta hãy xem xét cấu trúc của một tay máy công nghiệp có sơ đồ ở hình 3.2. Tay máy trên hình 3.2 có 6 bậc tự do với 6 trục chuyển động như sau: 1. Chuyển động quét của tay máy (chuyển động quay phải hay quay trái của thân người); 2. Chuyển động lên hay xuống theo chiều thẳng đứng (chuyễn động của khớp bả vai) 3. Chuyển động duổi ra hay co vào của cánh tay (chuyển động của khớp khuỷu tay) 4. Chuyển động lật lên xuống của bàn tay so với cổ tay; 5. Chuyển động quay ngược hay thuận chiều kim đồng hồ của bàn tay so với cổ tay. So với chuyển động của tay người (không tính đến chuyển động của các ngón tay) có 10 bậc tự do (10 khả năng chuyển động độc lập) tay máy trên là loại có đủ khả năng nắm bắt một vật bất kỳ trong không gian. Tay máy công nghiệp thường có các bộ phận chính sau: - Hệ thống điều khiển; - Hệ thống chấp hành : Bao gồm Các nguồn động lực, hệ thống truyền động, hệ thống chịu lực; - Bàn kẹp : Bàn kẹp là bộ phận công tác cuối cùng của tay máy ,nơi cầm nắm các thiết bị cộng nghệ hay vật cần duy chuyển, bộ phận chấp hành _ phần kết cấu cơ khí của tay máy bao gồm các loại động cơ như : các động cơ thủy lực, khí nén, cơ cấu servo điện tử, động cơ bước mỗi chuyển động của IR thường có một động cơ riêng và các thanh chịu lực. Hệ thống điều khiển - thường là loại đơn giản làm việc có chu kỳ vận hành theo nguyên lý của hệ thống điều khiển hở hoặc kín. Hình 3.2 : Mô hình hệ thống chấp hành tay máy công nghiệp chinh sua boi: nguyenvanbientbd47@gmail.com Phân loại tay máy theo cấu trúc sơ đồ động Thông thường cấu trúc chấp hành của tay máy công nghiệp được mô hình hóa trong dạng chuổi động với các khâu và khớp như trong nguyên lý máy với các giả thuyết cơ bản như sau: - Chỉ dùng các khớp động loại 5 (khớp quay, khớp tịnh tiến, khớp vít) - Trục quay hướng tịnh tiến của các khớp thì song song hay vuông góc với nhau. - Chuổi động là chuổi động hở, đơn giản. Dưới đây là chuổi động của một tay máy công nghiệp tổng quát có 6 bậc tự do, các khớp A, B, F là các khớp tổng quát có nghỉa là chúng có thể là khớp quay, cũng có thể là khớp tịnh tiến, các khớp D, E, K chỉ là những khớp quay. Các khâu được đánh số bắt đầu từ khâu 0 _ giá cố định , tiếp đến là các khâu 1, 2, …, n _ các khâu động _ khâu tổng quát ký hiệu là khâu i, (i=0,1,2,…,n), khâu, khâu n cuối cùng là khâu mang bàn kẹp của tay máy. Tương tự như tay người để bàn kẹp (bàn tay) làm việc được cần có ba loại chuyển động, tương ứng với các chuyển động này là ba dạng cấu trúc của tay máy như sau: Cấu trúc chuyển động toàn bộ (Chân người) cấu trúc này thực hiện chuyển động đem toàn bộ tay máy (tay người) đến vị trí làm việc . Cấu trúc này hết sức đa dạng và thông thường nếu không phải là tay máy hoạt động trong hệ thống mà chuyển động này cần có sự kiểm soát người ta thường coi tay máy là đứng yên khâu 0 gọi giá cố định của tay máy. Cấu trúc xác định hàm kẹp bao gồm các khớp AB và F các khâu 1, 2 và 3, chuyển động của cấu trúc này nhằm đem theo bàn kẹp tới vị trí làm việc .Do giả thiết về loại khớp động dùng trong chế tạo máy thông thường ta có những phối hợp sau đây của các khớp và từ đó tạo nên các cấu trúc xác định vị trí của bàn kẹp trong các không gian vị trí làm việc khác nhau của bàn kẹp . Phối hợp TTT nghĩa là 3 khớp đều là khớp tịnh tiến và một khớp quay. Đây là cấu trúc hoạt động trong hệ tọa độ đề các so với các tọa độ S0 vì điểm M nằm trên khâu 3 được xác định bởi ba chuyển động tịnh tiến và một chuyển động quay (tư