Thiết kế và chế tạo mô hình máy dán băng keo tự động

65 66 0
Thiết kế và chế tạo mô hình máy dán băng keo tự động

Đang tải... (xem toàn văn)

Tài liệu hạn chế xem trước, để xem đầy đủ mời bạn chọn Tải xuống

Thông tin tài liệu

ĐẠI HỌC ĐÀ NẴNG TRƯỜNG ĐẠI HỌC BÁCH KHOA KHOA CƠ KHÍ ĐỒ ÁN TỐT NGHIỆP NGÀNH: KỸ THUẬT CƠ ĐIỆN TỬ C C R L CHẾ TẠO THIẾT KẾ T VÀ U MƠ HÌNH MÁY DÁN BĂNG KEO TỰ ĐỘNG D ĐỀ TÀI: Người hướng dẫn: Sinh viên thực hiện: Mã số sinh viên: Lớp: Sinh viên thực hiện: Mã số sinh viên: Lớp: TS LÊ HOÀI NAM PHAN HOẰNG HẢO 101150207 15CDT2 HỒ HOÀNG LONG 101150172 15CDT1 Đà Nẵng, 07/2020 Thiết kế chế tạo mơ hình máy dán băng keo tự động TÓM TẮT Tên đề tài: THIẾT KẾ VÀ CHẾ TẠO MƠ HÌNH MÁY DÁN BĂNG KEO TỰ ĐỘNG Họ tên sinh viên: PHAN HOẰNG HẢO MSSV: 101150207 Lớp: 15CDT2 HỒ HOÀNG LONG MSSV: 101150172 Lớp: 15CDT1 Giáo viên hướng dẫn: TS Lê Hoài Nam Giáo viên duyệt: TS Đặng Phước Vinh Nội dung đồ án đề cập đến nhu cầu đóng gói thùng carton Dựa kiến thức học xây dựng sở lý thuyết phương pháp phân tích, tính tốn động học cho máy dán băng keo tự động Dựa vào đó, nhóm tác giả vào thiết kế chế tạo hệ thống dán băng keo tự động nhằm tăng suất nâng cao việc tự động hóa q trình sản xuất, đóng gói sản phẩm Đồ án gồm chương sau: Chương 1: Tổng quan đề tài Chương chủ yếu cung cấp cho người đọc nhìn ban đầu máy dán băng keo, ứng dụng đời sống công nghiệp, đồng thời nêu khái quát tổng quan hệ thống, đặt vấn đề phương án để C C R L T xây dựng máy dán băng keo tự động Chương 2: Thiết kế hệ thống truyền động hệ thống dán băng keo Ở chương này, nhóm tác giả xây dựng lên mơ hình động học máy, đề cập đến vùng làm việc tính tốn động học hệ thống truyền động, cấu dán băng keo từ đưa U D kích thước phù hợp cấu Chương 3: Thiết kế tổng thể mô hình dán băng keo Ở chương nhóm tác giả dựa vào kết chương xây dựng nên phần mơ hình phần mềm vẽ 3D SolidWorks: Bộ phận dán băng keo, hệ thống băng tải, cấu nâng hạ vitme Từ tổng hợp lại thành mơ hình tổng quan Chương 4: Chương giải vấn đề liên quan đến việc lựa chọn dòng vi điều khiển trung tâm, module mở rộng linh kiện khác để thực điều khiển cho máy thiết kế hệ thống điện điều khiển nhằm đảm bảo chức máy Bên cạnh xây dựng lưu đồ thuật tốn, từ xây dựng chương trình cho vi điều khiển giúp điều khiển hệ thống thay đổi kích thước làm việc theo ý muốn Chương 5: Kết luận Chương đánh giá kết đạt nhược điểm từ có hướng phát triển đề tài tương lai SVTH: Phan Hoằng Hảo - Hồ Hoàng Long GVHD: TS Lê Hoài Nam Thiết kế chế tạo mơ hình máy dán băng keo tự động ĐẠI HỌC ĐÀ NẴNG TRƯỜNG ĐẠI HỌC BÁCH KHOA KHOA CƠ KHÍ CỘNG HỊA XÃ HƠI CHỦ NGHĨA VIỆT NAM Độc lập - Tự - Hạnh phúc NHIỆM VỤ ĐỒ ÁN TỐT NGHIỆP TT Họ tên sinh viên Hồ Hoàng Long Số thẻ SV 101150172 Lớp 15CDT1 Ngành Kỹ thuật Cơ điện tử Phan Hoằng Hảo 101150207 15CDT2 Kỹ thuật Cơ điện tử Tên đề tài đồ án: Thiết kế chế tạo mô hình máy dán băng keo tự động Đề tài thuộc diện: ☐ Có ký kết thỏa thuận sở hữu trí tuệ kết thực Các số liệu liệu ban đầu: Thiết kế máy dán thùng carton với kích thước: 250 mm x 250 mm x 250 mm đến 400mm x500mm x800mm Khối lượng 10kg Nội dung phần thuyết minh tính tốn: a Phần chung: TT Họ tên sinh viên Hồ Hoàng Long Phan Hoằng Hảo U D Hồ Hồng Long Phan Hoằng Hảo Nội dung Tìm hiểu tổng quan máy dán băng keo tự động Tính tốn động lực học hệ thống dán băng keo Thiết kế tổng thể mơ hình b Phần riêng: TT Họ tên sinh viên C C R L T Năng xuất máy 5500 sản phẩm Nội dung Thiết kế hệ thống điều khiển Thiết lập lưu đồ thuật tốn điều khiển Tính tốn thiết kế động học băng tải, cấu nâng vitme Các vẽ, đồ thị (ghi rõ loại kích thước vẽ): a Phần chung: TT Họ tên sinh viên Nội dung Hồ Hoàng Long Phan Hoằng Hảo Thiết kế vẽ tổng thể mơ hình máy dán băng keo tự động (kích thước A0) SVTH: Phan Hoằng Hảo - Hồ Hoàng Long GVHD: TS Lê Hồi Nam Thiết kế chế tạo mơ hình máy dán băng keo tự động Phần riêng: TT Họ tên sinh viên Nội dung Hồ Hoàng Long Thiết kế vẽ lưu đồ thuật tốn (kích thước A0) Thiết kế vẽ sơ đồ mạch điện (kích thước A0) Phan Hoằng Hảo Thiết kế vẽ sơ đồ động (kích thước A0) Thiết kế vẽ cụm chi tiết (kích thước A0) Họ tên người hướng dẫn: Lê Hồi Nam Phần/ Nội dung: Tìm hiểu đề tài, tính tốn động học xây dựng ý tưởng mơ hình máy dán băng keo tự động Ngày giao nhiệm vụ đồ án: Ngày hoàn thành đồ án: 20/02/2020 1/7/2020 Trưởng Bộ môn……………………… C C Đà Nẵng, ngày 01 tháng 07 năm 2020 Người hướng dẫn R L T U D SVTH: Phan Hoằng Hảo - Hồ Hoàng Long TS Lê Hoài Nam GVHD: TS Lê Hồi Nam Thiết kế chế tạo mơ hình máy dán băng keo tự động LỜI NĨI ĐẦU Trong bối cảnh kinh tế nay, giới nói chung nước ta nói riêng bước phát triển Đời sống người ngày nâng cao, yêu cầu hàng hóa để phục vụ cho đời sống người không số lượng, chất lượng mà cịn có tính thẩm mỹ Vì cần bao bì, đóng gói Các sản phẩm sau đóng gói, bao bì đóng thành kiện (mỗi kiện có nhiều gói phụ thuộc vào kích thước lớn hay nhỏ kiện) Các kiện thùng làm chất liệu gỗ, giấy… chất liệu chủ yếu giấy Đóng thùng sản phẩm thành kiện giúp bảo quản sản phẩm tốt hơn, việc kiểm tra, vận chuyển từ nơi tới nơi khác đơn giản Đáp ứng cho yêu cầu này, nhiều loại máy móc thiết bị đời Đóng thùng sản phẩm cho sản phẩm vào thùng giấy chế tạo sẵn, sau dùng băng keo dán kín miệng thùng Cơng việc hầu hết thực tay thiết bị cầm tay cho suất thấp Để đáp ứng cho yêu cầu hàng hóa số lượng nhiều, tốc độ nhanh, có tính thẩm mỹ, ta cần áp dụng hệ thống dán thùng tự động Vì vậy, em tiến hành khảo sát thực đề tài: “Thiết kế chế tạo mơ hình máy dán băng keo tự động” Nội dung cụ thể luận văn bao gồm: chọn phương án dán thùng, tính tốn động học, tính bền hệ thống truyền động kết cấu, thiết kế băng tải, thiết kế cấu dán C C R L T U D (chủ yếu xác định kích thước động kết cấu), chọn sơ đồ mạch điện để điều khiển hệ thống Do kiến thức hạn hẹp nên q trình thiết kế tính tốn em khơng tránh khỏi sai sót thiếu thực tế kinh nghiệm thiết kế nên em mong có hướng dẫn bảo thầy để em củng cố hồn thiện kiến thức bước vào thực tế sản xuất tương lai Đà Nẵng, ngày 30 tháng 06 năm 2020 Sinh viên thực PHAN HOẰNG HẢO - HỒ HOÀNG LONG SVTH: Phan Hoằng Hảo - Hồ Hoàng Long GVHD: TS Lê Hoài Nam Thiết kế chế tạo mơ hình máy dán băng keo tự động LỜI CẢM ƠN Trước tiên chúng em xin gửi lời cảm ơn chân thành, sâu sắc tới thầy cô giáo trường Đại học Bách khoa – Đại học Đà Nẵng nói chung thầy giáo khoa Cơ khí, mơn Cơ điện tử nói riêng tận tình giảng dạy, truyền đạt cho em kiến thức, kinh nghiệm quý báu suốt thời gian qua Đặc biệt chúng em xin gửi lời cảm ơn chân thành đến thầy Lê Hoài Nam, thầy trực tiếp bảo, hướng dẫn chúng em suốt trình làm Đồ án tốt nghiệp Trong thời gian chúng em làm việc với thầy, chúng em không ngừng tiếp thu thêm nhiều kiến thức bổ ích mà cịn học tập tinh thần làm việc, thái độ nghiên cứu khoa học nghiêm túc, hiệu quả, điều cần thiết cho em q trình học tập cơng tác sau Mặc dù ảnh hưởng dịch bệnh Covid-19 kéo dài làm ảnh hưởng tiến độ Nhưng đề tài hoàn thành hỗ trợ động viên nhiều từ gia đình, thầy bạn bè Đó tình cảm thật đáng trân trọng khơng đền đáp hết, thật phấn khởi thấy người bên cạnh hồn cảnh khó khăn Qua chúng em mong nhận ý kiến đóng góp quý báu C C R L T U D thầy cô Hội đồng bảo vệ tốt nghiệp để chúng em rút học kinh nghiệm trước bước vào môi trường làm việc kĩ sư công ty, nhà máy Cuối xin chúc gia đình, người thân, q thầy bạn bè nhiều sức khoẻ thành công công việc Xin chân thành cảm ơn! Đà Nẵng, ngày 30 tháng 06 năm 2020 Sinh viên thực Hồ Hoàng Long - Phan Hoằng Hảo SVTH: Phan Hoằng Hảo - Hồ Hoàng Long GVHD: TS Lê Hoài Nam Thiết kế chế tạo mơ hình máy dán băng keo tự động CAM ĐOAN Kính gửi: Tơi tên là: - Ban Giám hiệu Trường Đại học Bách khoa; - Khoa Cơ khí PHAN HOẰNG HẢO HỒ HỒNG LONG LỚP 15CDT2 LỚP 15CDT1 Khoa: Cơ khí Đề tài: Thiết kế chế tạo mơ hình máy dán băng keo tự động Tôi xin cam đoan đồ án tốt nghiệp thực không chép hay trùng với đề tài thực hiện, sử dụng tài liệu tham khảo nêu báo cáo Các số liệu, kết nêu đề tài trung thực C C Nếu sai, tơi xin chịu hồn tồn trách nhiệm R L T U D Đà Nẵng, ngày 30 tháng 06 năm 2020 Sinh viên thực Hồ Hoàng Long - Phan Hoằng Hảo SVTH: Phan Hoằng Hảo - Hồ Hoàng Long GVHD: TS Lê Hoài Nam Thiết kế chế tạo mơ hình máy dán băng keo tự động MỤC LỤC TÓM TẮT LỜI NÓI ĐẦU LỜI CẢM ƠN CAM ĐOAN MỤC LỤC DANH SÁCH CÁC BẢNG, HÌNH ẢNH MỞ ĐẦU 11 CHƯƠNG 1: TỔNG QUAN VỀ ĐỀ TÀI MÁY DÁN BĂNG KEO 12 1.1 GIỚI THIỆU VỀ ĐỀ TÀI 12 1.1.1 Giới thiệu máy dán thùng carton 12 1.1.2 Các loại máy có mặt thị trường Việt Nam 13 1.2 TỔNG QUAN HỆ THỐNG VÀ CÁC PHƯƠNG ÁN 17 1.2.1 Phương án 17 1.2.2 Phương án 18 1.2.3 Phương án 19 1.2.4 Lựa chọn phương án 21 CHƯƠNG 2: THIẾT KẾ HỆ THỐNG TRUYỀN ĐỘNG VÀ HỆ THỐNG DÁN C C R L T U D BĂNG KEO 22 2.1 SƠ ĐỒ ĐỘNG VÀ VÙNG LÀM VIỆC CỦA MÁY DÁN BĂNG KEO 22 2.1.1 Sơ đồ động 22 2.1.2 Vùng làm việc 23 2.2 CHỌN ĐỘNG CƠ TÍNH TỐN ĐỘNG HỌC 23 2.3 THIẾT KẾ CƠ CẤU DÁN BĂNG KEO 25 2.2.1 Sơ đồ nguyên lý 25 2.2.2 Xác định kích thước cấu dán băng keo 26 CHƯƠNG 3: THIẾT KẾ TỔNG THỂ MƠ HÌNH DÁN BĂNG KEO 32 3.1 TỔNG QUAN VỀ THIẾT KẾ MƠ HÌNH 32 3.2 QUY TRÌNH THIẾT KẾ VÀ MÔ PHỎNG 33 3.2.1 Thiết kế phận cắt dán băng keo 33 3.2.2 Thiết kế băng tải 36 3.2.3 Thiết kế truyền động trục vitme 39 3.2.1 Mơ hình tổng quan 39 CHƯƠNG 4: HỆ THỐNG ĐIỀU KHIỂN 41 4.1 GIỚI THIỆU VỀ HỆ THỐNG 41 SVTH: Phan Hoằng Hảo - Hồ Hoàng Long GVHD: TS Lê Hoài Nam Thiết kế chế tạo mơ hình máy dán băng keo tự động 4.2 CÁC THÀNH PHẦN CHÍNH TRONG HỆ THỐNG 41 4.2.1 Bộ điều khiển 41 4.2.2 Driver điều khiển động bước TB6600 43 4.2.3 Module Relay 44 4.2.4 LCD 2004 45 4.2.5 Module I2C hỗ trợ hiển thị LCD 45 4.2.6 Mạch volume xoay rotary encoder 360 độ KY-040 47 4.2.7 Cơng tắc hành trình 48 4.3 SƠ ĐỒ NGUYÊN LÝ MẠCH 49 4.4 LƯU ĐỒ THUẬT TOÁN ĐIỀU KHIỂN 50 4.5 CÁC MENU ĐIỀU KHIỂN 56 CHƯƠNG 5: KẾT LUẬN 57 TÀI LIỆU THAM KHẢO 59 PHỤ LỤC: CODE ĐIỀU KHIỂN ARDUINO MEGA 60 C C R L T U D SVTH: Phan Hoằng Hảo - Hồ Hoàng Long GVHD: TS Lê Hoài Nam Thiết kế chế tạo mơ hình máy dán băng keo tự động DANH SÁCH CÁC BẢNG, HÌNH ẢNH Bảng 1 Các thành phần phương án 17 Bảng Các thành phần phương án 19 Bảng Các thành phần phương án 20 Bảng So sánh phương án thiết kế 21 Bảng Các chi tiết mơ hình động học máy dán băngkeo 22 Bảng 2 Các chi tiết cấu dán băng keo 25 Bảng Các chi tiết băng tải 37 Hình 1 Mục đích đề tài 12 Hình Hình ảnh máy dán băng keo công nghiệp [1] 12 Hình Hình ảnh Máy dán thùng carton PW552TB [2] 13 Hình Máy dán thùng carton Brother FXJ-6050 [3] 14 Hình Máy dán thùng carton SF-6050A [4] 15 Hình Máy dán thùng carton EXC-103TB [5] 16 Hình Kết cấu phương án 17 Hình Kết cấu phương án 18 C C R L T U D Hình Kết cấu phương án 19 Hình Sơ đồ động mơ hình máy dán băng keo 22 Hình 2 Sơ đồ truyền băng tải 23 Hình Động giảm tốc 555 24 Hình Sơ đồ cấu dán băng keo 25 Hình Kích thước băng kéo dán lên thùng 26 Hình Sơ đồ khâu A lăn 26 Hình Sơ đồ khâu C lăn 28 Hình Cơ cấu khâu B 29 Hình Khấu cắt băng keo 30 Hình Phần mềm SolidWorks 2019 33 Hình Tổng quan cấu cắt dán băng keo 33 Hình 3 Càng sau 34 Hình Càng trước 34 Hình Cánh tay địn nối trước với sau 34 SVTH: Phan Hoằng Hảo - Hồ Hoàng Long GVHD: TS Lê Hồi Nam Thiết kế chế tạo mơ hình máy dán băng keo tự động 4.4 Lưu đồ thuật toán điều khiển C C R L T U D Hình 11 Lưu đồ thuật tốn chương trình SVTH: Phan Hoằng Hảo - Hồ Hồng Long GVHD: TS Lê Hoài Nam 50 Thiết kế chế tạo mơ hình máy dán băng keo tự động C C R L T U D Hình 12 Lưu đồ thuật tốn chương trình selection() SVTH: Phan Hoằng Hảo - Hồ Hoàng Long GVHD: TS Lê Hoài Nam 51 Thiết kế chế tạo mơ hình máy dán băng keo tự động Hình 13 Lưu đồ thuật tốn chương trình print_menu() MoveTravel(Position) C C R L T U D Hình 14 Lưu đồ thuật tốn chương trình Homing() SVTH: Phan Hoằng Hảo - Hồ Hoàng Long GVHD: TS Lê Hoài Nam 52 Thiết kế chế tạo mơ hình máy dán băng keo tự động C C R L T U D Hình 15 Lưu đồ thuật tốn chương trình MoveAndChose() Hình 16 Lưu đồ thuật tốn chương trình count1(); SVTH: Phan Hoằng Hảo - Hồ Hoàng Long GVHD: TS Lê Hoài Nam 53 Thiết kế chế tạo mơ hình máy dán băng keo tự động C C R L T U D Hình 17 Lưu đồ thuật tốn chương trình ManualSize(); SVTH: Phan Hoằng Hảo - Hồ Hoàng Long GVHD: TS Lê Hồi Nam 54 Thiết kế chế tạo mơ hình máy dán băng keo tự động C C R L T U D Hình 18 Lưu đồ thuật tốn chương trình AutoSize SVTH: Phan Hoằng Hảo - Hồ Hoàng Long GVHD: TS Lê Hoài Nam 55 Thiết kế chế tạo mơ hình máy dán băng keo tự động 4.5 Các Menu điều khiển C C R L T Hình 19 Các Menu điều khiển U D SVTH: Phan Hoằng Hảo - Hồ Hoàng Long GVHD: TS Lê Hoài Nam 56 Thiết kế chế tạo mơ hình máy dán băng keo tự động Chương 5: KẾT LUẬN ❖ Kết Mặt dù ảnh hưởng dịch Covid 19 làm chậm tiếng độ ĐATN sau tháng thực đề tài, nhóm đạt kết sau: • • • Giải toán động học, yêu cầu đề tài Xây dựng mơ hình máy dán băng keo tự động giống thiết kế Máy hoạt động tương đối xác, dán băng keo, hệ thống thay đổi vị trí kích thước hoạt động mượt mà, ổn định C C R L T U D Hình Hình ảnh mơ hình thực tế Hình Hình ảnh sản phẩm trước sau qua dán keo SVTH: Phan Hoằng Hảo - Hồ Hoàng Long GVHD: TS Lê Hoài Nam 57 Thiết kế chế tạo mơ hình máy dán băng keo tự động C C Hình Hình ảnh sản phẩm khác R L T Hạn chế khó khăn khâu lắp ráp, đồng thời kết cấu khí chưa thực xác nên độ xác mơ hình chưa cao Thông qua khảo sát cho thấy hoạt động khả dán thùng carton sản phẩm phụ thuộc nhiều vào độ bám băng tải U D ❖ Hướng phát triển: Qua kết đạt nhóm đưa hướng phát triển đề tài sau: • Phát triển thêm chức dán băng keo mặt • Phát tiển thêm chức cấp xếp thùng tự động • Cải tiến kết cấu khí để nâng cao độ cứng vững cho máy SVTH: Phan Hoằng Hảo - Hồ Hoàng Long GVHD: TS Lê Hồi Nam 58 Thiết kế chế tạo mơ hình máy dán băng keo tự động TÀI LIỆU THAM KHẢO https://www.cokhicongnghiep.com/may-dan-thung-carton-pro105536.html [Ngày truy cập: 18/06/2020] https://www.choco.vn/may-dan-thung-carton-pw552tb-tai-viet-nam.html [Ngày truy cập: 18/06/2020] https://www.choco.vn/may-dan-thung-carton-brother-fxj-6050mdt0003.html[Ngày truy cập: 18/06/2020] https://cnva.vn/may-dan-thung-carton-tu-dong-kunba-fj-6050a/ [Ngày truy cập: 18/06/2020] http://thietbithuysan.vn/san-pham/470/may-dan-bang-keo-exc-103tb.html [Ngày truy cập: 18/06/2020] https://patents.google.com/patent/US3466843?oq=automatic+box+folding+and +taping+machine[Ngày truy cập: 26/2/2020] https://grabcad.com/library/upper-heading-tape-a-simplified-accuglide-2-3mmatic-1 [Ngày truy cập: 14/03/2020] http://arduino.vn/ [Ngày truy cập: 23/06/2019] C C R L T U D SVTH: Phan Hoằng Hảo - Hồ Hoàng Long GVHD: TS Lê Hoài Nam 59 Thiết kế chế tạo mơ hình máy dán băng keo tự động PHỤ LỤC: CODE ĐIỀU KHIỂN ARDUINO MEGA #include const unsigned long period = 1600; //the value is a number of milliseconds /* Menu system for a 16x2 LCD display and rotary encoder includes sleep mode for LCD */ unsigned long Position=0; int move_finished=1; // Used to check if move is completed long initial_homing=-1; // Used to Home Stepper at startup #include #include // rotary handler #include "AccelStepper.h" #include AF_Stepper motor1(200, 1); LiquidCrystal_I2C lcd(0x27, 20, 4); //0X3F thay đổi tùy theo địa I2C, 0x3F 0x27 // Library created by Mike McCauley at http://www.airspayce.com/mikem/arduino/AccelSte pper/ // AccelStepper Setup AccelStepper stepperX(1, 2, 3); // = Easy Driver interface // NANO Pin connected to STEP pin of Easy Driver in Project pin // NANO Pin connected to DIR pin of Easy Driver in Project pin // Define the Pins used #define PINA A0 #define PINB A1 #define PUSHB A2 #define home_switch // Pin connected to Home Switch (MicroSwitch) #define speaker 10 #define motor // Initialize the Rotary object // Rotary(Encoder Pin 1, Encoder Pin 2, Button Pin) Attach center to ground Rotary r = Rotary(PINA, PINB, PUSHB); // there is no must for using interrupt pins !! void setup () { digitalWrite (PINA, HIGH); // enable pull-ups digitalWrite (PINB, HIGH); digitalWrite (PUSHB, HIGH); pinMode(2, OUTPUT); pinMode(3, OUTPUT); pinMode(speaker, OUTPUT); pinMode(motor, OUTPUT); digitalWrite (motor, LOW); C C R L T U D //Define the Variables used int columnsLCD = 20; char* MenuLine[] = {" HOME", " MOVE 1mm", " MOVE 10mm ", " SIZE 250mm", " SIZE 300mm", " SIZE 350mm", " START"}; int MenuItems = 7; int CursorLine = 0; unsigned long startMillis; unsigned long currentMillis; SVTH: Phan Hoằng Hảo - Hồ Hoàng Long Serial.begin(9600); lcd.init(); lcd.backlight(); welcome(); lcd.clear(); print_menu(); startMillis = millis(); stepperX.setCurrentPosition(0); // Set the current position as zero for now stepperX.setMaxSpeed(500.0); // Set Max Speed of Stepper (Slower to get better accuracy) stepperX.setAcceleration(700.0); // Set Acceleration of Stepper initial_homing=1; } //End of setup void loop () { pinMode(home_switch, INPUT_PULLUP); delay(2); // Wait for EasyDriver wake up volatile unsigned char result = r.process(); if (result) { result == DIR_CCW ? CursorLine = CursorLine : CursorLine = CursorLine + 1; if (CursorLine < 0) { CursorLine = MenuItems - 1; } if (CursorLine > MenuItems - 1) { CursorLine = 0; // roll over to first item } GVHD: TS Lê Hoài Nam 60 Thiết kế chế tạo mơ hình máy dán băng keo tự động print_menu(); } //End if result if (r.buttonPressedReleased(25)) { lcd.setCursor(0, 1); //(col, row) selection(); print_menu(); } //endif buttonPressedReleased } //End loop() /************FUNCTIONS**************/ void welcome() { lcd.clear(); lcd.setCursor(0,0); lcd.print(" DO AN TOT NGHIEP"); lcd.setCursor(0,2); lcd.print("HoHoangLong 15CDT1"); lcd.setCursor(0,3); lcd.print("PhanHoangHao 15CDT2"); delay(3000); lcd.clear(); lcd.setCursor(0,0); lcd.print(" DO AN TOT NGHIEP"); lcd.setCursor(0,2); lcd.print(" Carton"); lcd.setCursor(0,3); lcd.print(" Sealing Machine "); delay(1500); lcd.clear(); } void print_menu() { lcd.clear(); lcd.setCursor(1, 2); //(col, row) lcd.print(" Rotate & Click"); lcd.setCursor(5, 3); //(col, row) lcd.print("To Select"); lcd.setCursor(6, 0); //(col, row) lcd.print("Main Menu"); lcd.setCursor(0, 1); //2nd row lcd.print(""); lcd.setCursor(1, 1); lcd.print(MenuLine[CursorLine]); } void selection() { switch (CursorLine) { case 0: lcd.clear(); lcd.print("HOMING "); //set a flag or something C C R L T U D SVTH: Phan Hoằng Hảo - Hồ Hoàng Long Serial.println("HOMING"); Homing(); if(stepperX.currentPosition()==0) { lcd.clear(); lcd.setCursor(7,0); lcd.print("Homing"); lcd.setCursor(6,1); lcd.print("Completed"); Position=0; break; } case 1: lcd.clear(); lcd.setCursor(0, 1); lcd.print("MOVE 1mm: "); while (CursorLine==1) { lcd.setCursor(11, 1); lcd.print(Position); lcd.setCursor(16, 1); lcd.print("mm"); MoveAndChose(); } //set a flag or something break; case 2: lcd.clear(); lcd.setCursor(0, 1); lcd.print("MOVE 10mm: "); while (CursorLine==2) { lcd.setCursor(11, 1); lcd.print(Position); lcd.setCursor(16, 1); lcd.print("mm"); MoveAndChose(); } break; case 3: while (CursorLine==3) { Position=10; lcd.clear(); lcd.print("Move SIZE 350mm"); MoveTravel(Position); if (stepperX.currentPosition()==Position) { lcd.clear(); lcd.setCursor(7,0); lcd.print("Moving"); lcd.setCursor(6,1); lcd.print("Completed"); GVHD: TS Lê Hoài Nam Thiết kế chế tạo mơ hình máy dán băng keo tự động delay(1000); CursorLine = 0; lcd.clear(); break; } break; print_menu(); } break; case 4: while (CursorLine==4) { Position=60; lcd.clear(); lcd.print("Move SIZE 400mm"); MoveTravel(Position); if (stepperX.currentPosition()==Position) { lcd.clear(); lcd.setCursor(7,0); lcd.print("Moving"); lcd.setCursor(6,1); lcd.print("Completed"); delay(1000); CursorLine = 0; break; } break; //print_menu(); } break; case 5: while (CursorLine==5) { Position=110; lcd.clear(); lcd.print("Move SIZE 450mm"); MoveTravel(Position); if (stepperX.currentPosition()==Position) { lcd.clear(); lcd.setCursor(7,0); lcd.print("Moving"); lcd.setCursor(6,1); lcd.print("Completed"); delay(1000); CursorLine = 0; break; } break; //print_menu(); } break; case 6: Speaker(); lcd.clear(); lcd.setCursor(0,0); lcd.print("Start Machine "); lcd.setCursor(4,2); lcd.print("Press Button "); lcd.setCursor(6,3); lcd.print("To Stop "); while (CursorLine==6) { digitalWrite (motor, HIGH); if (r.buttonPressedReleased(25)) { digitalWrite (motor, LOW); CursorLine = 0; break; } C C R L T U D SVTH: Phan Hoằng Hảo - Hồ Hoàng Long } //print_menu(); break; default: break; } //end switch CursorLine = 0; // reset to start position } //End selection void MoveAndChose() { volatile unsigned char result = r.process(); if (result) { if (result == r.clockwise()) {if(CursorLine==2)Position =Position+10; else Position =Position+1; if(Position>=400)Position=400; } else if (result == r.counterClockwise()) { if(Position>0) {if(CursorLine==2&&Position>10)Position =Position-10; else Position =Position-1;} }//end else lcd.setCursor(12, 1); lcd.print(" "); lcd.setCursor(11, 1); lcd.print(Position); }//end if Result currentMillis = millis(); //get the number of milliseconds since the program started //lcd.setCursor(16, 0); //(col, row) //lcd.print((currentMillis - startMillis) / 1000); GVHD: TS Lê Hoài Nam Thiết kế chế tạo mơ hình máy dán băng keo tự động if (currentMillis - startMillis >= &&stepperX.currentPosition()!=Position) whether the period has elapsed { period //test MoveTravel(Position); startMillis = millis(); } if (r.buttonPressedReleased(25)) {lcd.clear(); CursorLine = 0; print_menu(); } } void Homing() { // Set Max Speed and Acceleration of each Steppers at startup for homing stepperX.setMaxSpeed(600.0); // Set Max Speed of Stepper (Slower to get better accuracy) stepperX.setAcceleration(700.0); // Set Acceleration of Stepper // Start Homing procedure of Stepper Motor at startup Serial.print("Stepper is Homing "); while (digitalRead(home_switch)) { // Make the Stepper move CCW until the switch is activated stepperX.moveTo(initial_homing); // Set the position to move to initial_homing ; // Decrease by for next move if needed stepperX.run(); // Start moving the stepper delay(2); } stepperX.setCurrentPosition(0); // Set the current position as zero for now stepperX.setMaxSpeed(500.0); // Set Max Speed of Stepper (Slower to get better accuracy) stepperX.setAcceleration(700.0); // Set Acceleration of Stepper initial_homing=1; while (!digitalRead(home_switch)) { // Make the Stepper move CW until the switch is deactivated stepperX.moveTo(initial_homing); stepperX.run(); initial_homing++; delay(20); } stepperX.setCurrentPosition(0); Serial.println("Homing Completed"); C C R L T U D SVTH: Phan Hoằng Hảo - Hồ Hoàng Long Serial.println(""); stepperX.setMaxSpeed(900.0); // Set Max Speed of Stepper (Faster for regular movements) stepperX.setAcceleration(1000.0); // Set Acceleration of Stepper } void MoveTravel(long TravelX) { //if (Serial.available()>0) { // Check if values are available in the Serial Buffer move_finished=0; // Set variable for checking move of the Stepper TravelX=TravelX*200;// Put numeric value from buffer in TravelX variable if(TravelX==0)TravelX=1; if (TravelX 75000) { // Make sure the position entered is not beyond the HOME or MAX position Serial.println(""); Serial.println("Please enter a value greater than zero and smaller or equal to 135000 "); Serial.println(""); } else { Serial.print("Moving stepper into position: "); Serial.println(TravelX); //stepperX.moveTo(TravelX); // Set new moveto position of Stepper stepperX.runToNewPosition(TravelX); //delay(1000); // Wait seconds before moving the Stepper } } if (TravelX >= && TravelX

Ngày đăng: 14/11/2020, 11:24

Từ khóa liên quan

Tài liệu cùng người dùng

  • Đang cập nhật ...

Tài liệu liên quan