Thiết kế, chế tạo Robot sơn tường tự động

58 503 6
Thiết kế, chế tạo Robot sơn tường 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

Chương MỞ ĐẦU 1.1 Đặt vấn đề Ngày nay, Robot học đạt thành tựu to lớn sản xuất công nghiệp Những cánh tay robot có khả làm việc với tốc độ cao, xác liên tục làm suất lao động tăng nhiều lần Chúng làm việc mơi trường độc hại hàn, phun sơn, nhà máy hạt nhân, hay lắp ráp linh kiện điện tử tạo điện thoại, máy tính cơng việc đòi hỏi tỉ mỉ, xác cao Nếu trước người luôn phải tự tay làm hết tất việc trình lao động, sản xuất ngày chuyện sang trang hồn tồn Những cơng nghệ với tính vượt trội sử dụng rộng rãi tất nhà máy khắp nước Trong phải kể đến robot phun sơn loại robot nhiều doanh nghiệp tin tưởng chọn lựa để sản xuất dây chuyền sản xuất Ưu điểm robot sơn tường nhờ tác dụng điều khiển lên xuống trình phun sơn tự động, chúng giảm thiểu hàng chục cơng nhân đảm nhận vai trò phun sơn thơng thường Bởi cách làm việc thói quen người khác nên nhiều sản phẩm làm không tay Những robot phun sơn tự động khắc phục nhược điểm Những robot cài đặt, gắn súng sơn có tốc độ ấn định sẵn nên tốc độ lượng sơn nhanh khiến cho sản phẩm nhận giống hồn tồn xuất vơ lỗi kĩ thuật mà người thợ bình thường hay mắc phải Một robot gắn nhiều súng sơn lúc khiến hiệu công việc tăng lên gấp bội Thực tiễn cho thấy phương pháp lăn sơn phun sơn có nhược điểm gây hại môi trường, suất sơn không cao, tiềm ẩn nguy tai nạn lao động, hao phí sơn rơi rớt, q trình vệ sinh sau thi cơng vất vả Thị trường có số mẫu máy lăn sơn phun sơn song tính hạn chế, áp dụng cho nhà cao tầng Từ thực tiễn này, nhóm định nghiên cứu thiết kế Robot sơn tường tự động Vì lý thiết yếu nêu trên, nhóm em chọn đề tài : “ Thiết kế, chế tạo Robot sơn tường tự động ” 1.2 Nội dung đề tài Robot sơn tường tự động đề tài đòi hỏi kiến thức tổng hợp nhiều lĩnh vực : khí thiết kế, thiết bị sơn, động lực học, mạch điện tử, vi điều khiển, mơ hình hóa, mơ v…v Do đó, đòi hỏi cần cố gắng, tâm nổ lực để hồn thành tốt đề tài Các vấn đề đề tài : Tìm hiểu nghiên cứu robot sơn tường tự động có Tim hiều module phun cao áp sơn nước lên bề mặt tường Thiết kế , chế tạo robot kích thước 100cm x 80cm x 80 cm có khả sơn tường tự động Điều khiển robot sơn tường tự động theo chế độ : sơn thẳng, sơn ngang , sơn theo chu trình lặp lại 1.3 Tìm hiểu Robot phun sơn Từ trước tới đa số cơng việc đòi hỏi sác tỉ mỉ người ta làm thủ cơng Tuy nhiên khoa học có bước đột phá nhờ vào sáng tạo không ngừng nghỉ từ người nhiều cơng việc trở nên dễ dàng nhờ giúp đỡ loại máy móc Trong loại máy móc đại khơng thể khơng nói tới loại robot phun sơn Đây sản phẩm kỉ ứng dụng rộng rãi công xưởng nước ta Robot phun sơn có tên gọi khác thiết bị tự động điều khiển loại súng phun sơn Chúng có thiết kế gắn liền với buồng phun sơn tự động để người sử dụng điều khiển hoạt động chúng với tốc độ ổn định phun sơn cách xác Robot máy đa năng, tích hợp nhiều chức với súng phun, máy nén khí, quạt gió, máy chà, hay máy đánh bóng… Chính tích hợp mà nhà xưởng không cần phải thuê nhiều công nhân chuyên phun sơn trước kia, tiết kiệm nhiều chi phí hoạt động sản xuất công xưởng Nếu trước người cơng nhân làm việc lại có cách làm khác nhau, nên sản phẩm làm đơi có lớp sơn khơng đồng có robot chuyên dụng xuất để khắc phục nhược điểm người Các sản phẩm tạo loại robot có lớp sơn đến hoàn hảo chất lượng sản phẩm đạt đến hoàn mĩ lớn Hơn bạn robot lại gắn đồng thời nhiều súng phun sơn lúc, nên hiệu suất lao động công xưởng lại tăng lên Khiến cho chúng trở thành sản phẩm công xưởng đầu tư nhiều Chương TỔNG QUAN 2.1 Lịch sử phát triển máy phun sơn tự động Vì vấn đề nhu cầu an tồn lao động tiết kiệm thời gian lẫn chi phí nên robot sơn tự động đời nhằm giúp người trình sơn : Hình 2.1 : Sự phát triển ngành sơn xây dựng Sơn tường thủ công Sơn tường phụ kiện Robot sơn tường tự động Robot sơn tường tay Robot sơn tường đại 2.2 Tình hình phát triển nước ngồi 2.2.1 Tại nhật có robot phun sơn tự động Yaskawa MH165-100 Robot phun sơn tự động yaskawa MH165-100 linh hoạt nhanh, linh hoạt mạnh mẽ giải trọng tải nặng lên đến 100 kg Đây robot có sáu trục, sàn làm việc lớn đạt 4.091 mm theo chiều dọc, 3.010 mm theo chiều ngang Tốc độ trục nhanh, giúp giảm thời gian chu kỳ tăng tổng sản lượng sản xuất Nhìn chung, robot phun sơn tự động Yaskawa MH165-100 gọn, giúp đạt vào không gian chật hẹp, cần thiết Robot phun sơn tự động Yaskawa MH165-100 kết hợp với điều khiển DX100 mạnh mẽ cung cấp kết nối internet nhanh loại bỏ nhu cầu PLC HMI tốn Bộ điều khiển có nhiều điều khiển robot phun sơn tự động Yaskawa MH165-100 hỗ trợ tối đa robot / 72 trục Hình 2.2 : Robot phun sơn tự động Yaskawa MH165-100 Hình ảnh chi tiết Robot phun sơn tự động Yaskawa MH165-100 Hình 2.3 : Chi tiết Yaskawa MH165-100 2.2.2 Tại Trung Quốc có robot ARM robot spray paint machine (JX2050-A) Robot ARM sử dụng hệ thống cung cấp quay vòng, Spaying hệ thống điều khiển hệ thống cung cấp dầu Được sử dụng súng phun tự động ASAHI-AGB40 Nhật Bản.Display Panel dịch tiếng Anh theo ngôn ngữ yêu cầu bạn Action Radius = 2050mm, Tốc độ tối đa = 2500mm / s Chuyển động theo trục tự Sử dụng loại sơn UV/ PU/ PE/ AC sơn nước Tốc độ tối đa 2.0M/S Hình 2.4 : robot ARM robot spray paint machine (JX2050-A) 2.2.3 Tại Singapore chế tạo Robot ELID-NTU Otobot phun sơn tự động Một hệ thống robot sáng tạo làm tòa nhà bên ngồi sử dụng vòi phun nước cho sơn sẵn sàng để phục vụ khách hàng Singapore Nó đồng phát triển nhà tiên phong lĩnh vực điều khiển tự động hệ thống không tiếp xúc sinh trắc học ELID Technology International Đại học Công nghệ Nanyang, Singapore (NTU Singapore), đứng thứ tồn cầu Kỹ thuật Cơng nghệ Đại học Thế giới lần Quacquarelli Symonds (QS) theo Chủ đề 2017 Đặt tên OutoBot, tự động hóa chờ cấp sáng chế xây dựng địa phương cải thiện suất tăng cường an toàn nơi làm việc Nó cần nửa số nhân lực để chạy làm việc lâu so với phương pháp thủ công Đối với việc giặt sơn bề mặt tòa nhà, thường có nhóm gồm người hai người mặt đất mái nhà, với ba người làm vẽ tàu gondola Thay vào đó, Outobot đòi hỏi có hai công nhân - người điều hành mặt đất một nhân viên an tồn Nó có cánh tay robot trang bị máy ảnh vòi phun bắn phun nước cao áp để làm bề mặt phun sơn Khơng có hoạ sĩ chất tẩy rửa u cầu phải nằm gondola xây dựng đặc biệt hệ thống Hình 2.5 : ELID-NTU Outobot phun sơn tường Sự đổi ELID tự động hoá tự động dự kiến để đáp ứng yêu cầu Ban Phát triển Nhà (Housing & Development Board - HDB) để tự động hóa việc sơn mặt tiền xây dựng bên ngồi HDB để tăng cường an toàn cho người lao động tăng suất Giám đốc công nghệ ELID Technology International, ông Dennis Lim, người đưa ý tưởng hệ thống robot, nói giải vấn đề suất cho việc sơn tòa nhà phù hợp với tầm nhìn Smart Nation Singapore Ơng Lim giải thích: "Với đội ngũ lao động già nua Singapore, cần phải tìm cách phép nhân viên chúng tơi tiếp tục góp phần có năm tháng phát triển "Sử dụng robot chúng tôi, chúng tơi cơng việc đòi hỏi nhiều lao động chuyển đổi thành cơng việc mà người lao động lớn tuổi dễ dàng thực hiện, đồng thời giảm nguy phải làm việc độ cao", ông Lim nói Giáo sư Chen I-Ming, Giám đốc Trung tâm nghiên cứu robot NTU hướng dẫn phát triển OutoBot, cho biết dự án ví dụ cách thức mà trường đại học sử dụng chuyên môn kỹ thuật để nâng cao suất, đồng thời tăng cường an toàn cho người lao động "Mục đích chúng tơi làm sơn tòa nhà cao tầng dễ dàng hơn, an tồn tiết kiệm chi phí hơn", Giáo sư Chen, giảng viên Trường Kỹ thuật Cơ khí Khơng gian Vũ trường NTU giải thích "Bằng cách sử dụng sơn phun sơn lăn thông thường, robot chúng tơi xác hiệu hơn, giảm thiểu chất thải tiết kiệm sơn." 2.2.4 PictoBot: Robot để phun sơn tường trần cao PictoBot, nhà khoa học Trung tâm nghiên cứu robot Đại học Cơng nghệ Nanyang, phát minh ra, phun sơn nội thất cao 25% so với người Ví dụ, tường 90 m thường 90 phút để hai người đàn ông phun sơn Tuy nhiên, PictoBot, nặng 1,5 nạp đầy đủ sơn 12 pin, làm vòng Sử dụng máy quét quang học máy quét laze, tự động quét môi trường xung quanh điều hướng tường lên đến 10m với cánh tay Hình 2.6 : Robot Pictobot 2.3 Tình hình phát triển nước ta Có nhiều người có ý tưởng từ giảm thiểu sức lao động, giảm thời gian làm việc, tăng mức an toàn lao động công việc, họ nghiên cứu chế tạo robot sơn tường giúp đỡ cho việc sơn nhanh đẹp ứu chế tạo robot sơn tường giúp đỡ cho việc sơn nhanh đẹp 2.3.1 Lê Trung Minh Quân , 17 tuổi chế tạo robot sơn tường năm 2006 Robot sơn tường tự động Lê Trung Minh Quân chế tạo nhận giải đặc biệt Hội thi Sáng tạo toàn quốc vào tháng 9-2006 Liên hiệp Các Hội khoa học kỹ thuật Việt Nam, Quỹ Vifotec phối hợp với Bộ KH-CN Trung ương Đồn tổ chức Tổ chức Sở hữu Trí tuệ tuệ Robot Quân gồm ba phận chủ yếu: phần tự động hóa gồm PLC, biến tần mạch điều khiển để tủ; phần khí thiết bị phụ gồm đường ray, máy khí nén, bơm trợ lực, thùng sơn Khi vận hành robot, người điều khiển cần nhấn nút lập trình thông số tường cần sơn, robot tự động hồn thành cơng việc Khi pit-tơng đẩy ra, cơng tắc hành trình cảm nhận lúc robot chạm tường để mở van bắt đầu sơn Robot phun sơn theo hình zigzag độ mịn cao Để giải vấn đề độ mịn sơn, Quân thiết kế phận lọc thùng sơn Ngồi ra, Qn trang bị thêm máy đánh sơn khơng tạo lắng, bơm trợ lực để phun sơn mịn 10 void tien(){ for (int x=0;x

Ngày đăng: 26/09/2019, 20:49

Từ khóa liên quan

Mục lục

  • Chương 1

  • MỞ ĐẦU

  • 1.1 Đặt vấn đề.

  • 1.2 Nội dung đề tài.

  • 1.3 Tìm hiểu về Robot phun sơn

  • Chương 2

  • TỔNG QUAN

  • 2.1 Lịch sử phát triển của máy phun sơn tự động.

  • 2.2 Tình hình phát triển ở nước ngoài.

    • 2.2.1 Tại nhật bản có robot phun sơn tự động Yaskawa MH165-100

    • 2.2.2 Tại Trung Quốc có robot ARM robot spray paint machine (JX2050-A)

    • 2.2.3 Tại Singapore đã chế tạo ra Robot ELID-NTU Otobot phun sơn tự động.

    • 2.2.4 PictoBot: Robot để phun sơn tường và trần cao .

  • 2.3 Tình hình phát triển ở nước ta hiện nay .

    • 2.3.1 Lê Trung Minh Quân , 17 tuổi chế tạo ra robot sơn tường năm 2006

    • 2.3.2 Máy sơn nhà cao tầng tự động của sinh viên Vương Tất Quang ĐH Bách Khoa Hà Nội .

  • 2.4 Ý nghĩa khoa học và thực tiển

    • 2.4.1 Ý nghĩa khoa học

    • 2.4.2 Ý nghĩa thực tiển

  • 2.5 Kết quả dự kiến đạt được

  • 2.6 Một số linh kiện sử dụng trong đề tài.

    • 2.6.1 Mạch vi điều khiển Arduino UNO R3.

    • 2.6.2 Mạch điều khiển động cơ bước A4988.

    • 2.6.3 Động cơ bước .

    • 2.6.4 Động cơ DC

    • 2.6.5 Máy phun sơn cầm tay Zento.

    • 2.6.6 Nguồn tổ ông 12V 20A

    • 2.6.7 Modul relay 5V, 2 kênh.

    • 2.5.8 Trục vít me

  • Chương 3

  • NỘI DUNG VÀ PHƯƠNG PHÁP NGHIÊN CỨU

  • 3.1 Nội dung thưc hiện.

  • 3.2 Phương pháp và phương tiện nghiên cứu .

    • 3.2.1 Về phương pháp nghiên cứu :

    • 3.2.2 Về phương tiện nghiên cứu .

  • Chương 4

  • KẾT QUẢ VÀ THẢO LUẬN

  • 4.1 Sơ đồ cấu tạo robot sơn tường tự động.

  • 4.2 Nguyên lý hoạt động của robot sơn tường tự động.

  • 4.3 Tính toán , chế tạo máy sơn tường tự động.

    • 4.3.1 Thiết kế bộ phần dịch chuyển theo phương X

    • 4.3.2 Thiết kế bộ phận dịch chuyển theo phương Y

    • 4.3.3 Tính toán bước đi và số xung của trục vít me và động cơ bước.

  • 4.4 Thiết kế chế tạo thành công robot sơn tường tự động.

    • 4.4.1 Bản vẽ solidwork.

    • 4.4.2 Chế tạo thực tế robot sơn tường tự động.

  • 4.5 Khảo nghiệm sơn theo hình zíc zắc.

  • Chương 5

  • KẾT LUẬN VÀ ĐỀ NGHỊ

  • 5.1 Kết luận.

  • 5.2 Đề nghị.

  • TÀI LIỆU THAM KHẢO

  • PHỤ LỤC CODE

  • 1. Code điều khiển theo hướng zíc zắc

  • 2. Code điều khiển theo hướng hình xoắn ốc

  • void setup() {

  • //khai bao chan cua a4988

  • // 1mm tuong duong 400xung

  • //20cm= 200mm=80000xung

  • pinMode(2,OUTPUT);// chân máy phun sơn

  • //---------dongco1----------trai phai----

  • pinMode(6,OUTPUT);//step

  • pinMode(7,OUTPUT);//enb

  • pinMode(8,OUTPUT);//dir

  • digitalWrite(7,HIGH);

  • //-----------dongco2---------len xuong----

  • pinMode(5,OUTPUT);//step

  • pinMode(9,OUTPUT);//enb

  • pinMode(4,OUTPUT);//dir

  • digitalWrite(9,HIGH);

  • //-----------dongco3----------tien lui----

  • pinMode(10,OUTPUT);//step

  • pinMode(12,OUTPUT);//enb

  • pinMode(13,OUTPUT);//dir

  • digitalWrite(12,HIGH);

  • }

  • void quatrai1(){

  • //437.5mm

  • for(long i=0;i<=175000;i++)

  • {

  • //digitalWrite(10,HIGH);

  • digitalWrite(7,LOW);// mo nguon

  • digitalWrite(8,HIGH);//chieu dong co

  • digitalWrite(6,HIGH);//xung

  • delayMicroseconds(50);

  • digitalWrite(6,LOW);//xung

  • delayMicroseconds(30);

  • }

  • }

  • void len1(){

  • //350mm

  • for(int a=0;a<=140000;a++)

  • {

  • //digitalWrite(7,HIGH);

  • digitalWrite(9,LOW);//enb

  • digitalWrite(4,HIGH);//dir

  • digitalWrite(5,HIGH);//xung

  • delayMicroseconds(150);

  • digitalWrite(5,LOW);//xung

  • delayMicroseconds(150);

  • }

  • }

  • void quaphai1(){

  • //437.5mm

  • for(long i=0;i<=175000;i++)

  • {

  • //digitalWrite(10,HIGH);

  • digitalWrite(7,LOW);//enb mo nguon

  • digitalWrite(8,LOW);//dir chieu dong co

  • digitalWrite(6,HIGH);//step xung

  • delayMicroseconds(50);

  • digitalWrite(6,LOW);//xung

  • delayMicroseconds(30);

  • }

  • }

  • void xuong1(){

  • //300mm

  • for(int a=0;a<=120000;a++)

  • {

  • //digitalWrite(7,HIGH);

  • digitalWrite(9,LOW);//enb

  • digitalWrite(4,LOW);//dir

  • digitalWrite(5,HIGH);//xung

  • delayMicroseconds(150);

  • digitalWrite(5,LOW);//xung

  • delayMicroseconds(150);

  • }

  • }

  • void quatrai2(){

  • //387.5mm

  • for(long i=0;i<=155000;i++)

  • {

  • //digitalWrite(10,HIGH);

  • digitalWrite(7,LOW);// mo nguon

  • digitalWrite(8,HIGH);//chieu dong co

  • digitalWrite(6,HIGH);//xung

  • delayMicroseconds(50);

  • digitalWrite(6,LOW);//xung

  • delayMicroseconds(30);

  • }

  • }

  • void len2(){

  • //300mm

  • for(int a=0;a<=120000;a++)

  • {

  • //digitalWrite(7,HIGH);

  • digitalWrite(9,LOW);//enb

  • digitalWrite(4,HIGH);//dir

  • digitalWrite(5,HIGH);//xung

  • delayMicroseconds(150);

  • digitalWrite(5,LOW);//xung

  • delayMicroseconds(150);

  • }

  • }

  • void quaphai2(){

  • //387.5mm

  • for(long i=0;i<=155000;i++)

  • {

  • //digitalWrite(10,HIGH);

  • digitalWrite(7,LOW);//enb mo nguon

  • digitalWrite(8,LOW);//dir chieu dong co

  • digitalWrite(6,HIGH);//step xung

  • delayMicroseconds(50);

  • digitalWrite(6,LOW);//xung

  • delayMicroseconds(30);

  • }

  • }

  • void xuong2(){

  • //250mm

  • for(int a=0;a<=100000;a++)

  • {

  • //digitalWrite(7,HIGH);

  • digitalWrite(9,LOW);//enb

  • digitalWrite(4,LOW);//dir

  • digitalWrite(5,HIGH);//xung

  • delayMicroseconds(150);

  • digitalWrite(5,LOW);//xung

  • delayMicroseconds(150);

  • }

  • }

  • void quatrai3(){

  • //337.5mm

  • for(long i=0;i<=135000;i++)

  • {

  • //digitalWrite(10,HIGH);

  • digitalWrite(7,LOW);// mo nguon

  • digitalWrite(8,HIGH);//chieu dong co

  • digitalWrite(6,HIGH);//xung

  • delayMicroseconds(50);

  • digitalWrite(6,LOW);//xung

  • delayMicroseconds(30);

  • }

  • }

  • void len3(){

  • //250mm

  • for(int a=0;a<=100000;a++)

  • {

  • //digitalWrite(7,HIGH);

  • digitalWrite(9,LOW);//enb

  • digitalWrite(4,HIGH);//dir

  • digitalWrite(5,HIGH);//xung

  • delayMicroseconds(150);

  • digitalWrite(5,LOW);//xung

  • delayMicroseconds(150);

  • }

  • }

  • void quaphai3(){

  • //337.5mm

  • for(long i=0;i<=135000;i++)

  • {

  • //digitalWrite(10,HIGH);

  • digitalWrite(7,LOW);//enb mo nguon

  • digitalWrite(8,LOW);//dir chieu dong co

  • digitalWrite(6,HIGH);//step xung

  • delayMicroseconds(50);

  • digitalWrite(6,LOW);//xung

  • delayMicroseconds(30);

  • }

  • }

  • void xuong3(){

  • //200mm

  • for(int a=0;a<=80000;a++)

  • {

  • //digitalWrite(7,HIGH);

  • digitalWrite(9,LOW);//enb

  • digitalWrite(4,LOW);//dir

  • digitalWrite(5,HIGH);//xung

  • delayMicroseconds(150);

  • digitalWrite(5,LOW);//xung

  • delayMicroseconds(150);

  • }

  • }

  • void quatrai4(){

  • //287.5mm

  • for(long i=0;i<=115000;i++)

  • {

  • //digitalWrite(10,HIGH);

  • digitalWrite(7,LOW);// mo nguon

  • digitalWrite(8,HIGH);//chieu dong co

  • digitalWrite(6,HIGH);//xung

  • delayMicroseconds(50);

  • digitalWrite(6,LOW);//xung

  • delayMicroseconds(30);

  • }

  • }

  • void len4(){

  • //200mm

  • for(int a=0;a<=80000;a++)

  • {

  • //digitalWrite(7,HIGH);

  • digitalWrite(9,LOW);//enb

  • digitalWrite(4,HIGH);//dir

  • digitalWrite(5,HIGH);//xung

  • delayMicroseconds(150);

  • digitalWrite(5,LOW);//xung

  • delayMicroseconds(150);

  • }

  • }

  • void quaphai4(){

  • //287.5

  • for(long i=0;i<=115000;i++)

  • {

  • //digitalWrite(10,HIGH);

  • digitalWrite(7,LOW);//enb mo nguon

  • digitalWrite(8,LOW);//dir chieu dong co

  • digitalWrite(6,HIGH);//step xung

  • delayMicroseconds(50);

  • digitalWrite(6,LOW);//xung

  • delayMicroseconds(30);

  • }

  • }

  • void xuong4(){

  • //150mm

  • for(int a=0;a<=60000;a++)

  • {

  • //digitalWrite(7,HIGH);

  • digitalWrite(9,LOW);//enb

  • digitalWrite(4,LOW);//dir

  • digitalWrite(5,HIGH);//xung

  • delayMicroseconds(150);

  • digitalWrite(5,LOW);//xung

  • delayMicroseconds(150);

  • }

  • }

  • void quatrai5(){

  • //237.5mm

  • for(long i=0;i<=95000;i++)

  • {

  • //digitalWrite(10,HIGH);

  • digitalWrite(7,LOW);// mo nguon

  • digitalWrite(8,HIGH);//chieu dong co

  • digitalWrite(6,HIGH);//xung

  • delayMicroseconds(50);

  • digitalWrite(6,LOW);//xung

  • delayMicroseconds(30);

  • }

  • }

  • void len5(){

  • //150mm

  • for(int a=0;a<=60000;a++)

  • {

  • //digitalWrite(7,HIGH);

  • digitalWrite(9,LOW);//enb

  • digitalWrite(4,HIGH);//dir

  • digitalWrite(5,HIGH);//xung

  • delayMicroseconds(150);

  • digitalWrite(5,LOW);//xung

  • delayMicroseconds(150);

  • }

  • }

  • void quaphai5(){

  • //237.5

  • for(long i=0;i<=95000;i++)

  • {

  • //digitalWrite(10,HIGH);

  • digitalWrite(7,LOW);//enb mo nguon

  • digitalWrite(8,LOW);//dir chieu dong co

  • digitalWrite(6,HIGH);//step xung

  • delayMicroseconds(50);

  • digitalWrite(6,LOW);//xung

  • delayMicroseconds(30);

  • }

  • }

  • void xuong5(){

  • //100mm

  • for(int a=0;a<=40000;a++)

  • {

  • //digitalWrite(7,HIGH);

  • digitalWrite(9,LOW);//enb

  • digitalWrite(4,LOW);//dir

  • digitalWrite(5,HIGH);//xung

  • delayMicroseconds(150);

  • digitalWrite(5,LOW);//xung

  • delayMicroseconds(150);

  • }

  • }

  • void quatrai6(){

  • //187.5mm

  • for(long i=0;i<=75000;i++)

  • {

  • //digitalWrite(10,HIGH);

  • digitalWrite(7,LOW);// mo nguon

  • digitalWrite(8,HIGH);//chieu dong co

  • digitalWrite(6,HIGH);//xung

  • delayMicroseconds(50);

  • digitalWrite(6,LOW);//xung

  • delayMicroseconds(30);

  • }

  • }

  • void len6(){

  • //100mm

  • for(int a=0;a<=40000;a++)

  • {

  • //digitalWrite(7,HIGH);

  • digitalWrite(9,LOW);//enb

  • digitalWrite(4,HIGH);//dir

  • digitalWrite(5,HIGH);//xung

  • delayMicroseconds(150);

  • digitalWrite(5,LOW);//xung

  • delayMicroseconds(150);

  • }

  • }

  • void quaphai6(){

  • //187.5

  • for(long i=0;i<=75000;i++)

  • {

  • //digitalWrite(10,HIGH);

  • digitalWrite(7,LOW);//enb mo nguon

  • digitalWrite(8,LOW);//dir chieu dong co

  • digitalWrite(6,HIGH);//step xung

  • delayMicroseconds(50);

  • digitalWrite(6,LOW);//xung

  • delayMicroseconds(30);

  • }

  • }

  • void xuong6(){

  • //50mm

  • for(int a=0;a<=20000;a++)

  • {

  • //digitalWrite(7,HIGH);

  • digitalWrite(9,LOW);//enb

  • digitalWrite(4,LOW);//dir

  • digitalWrite(5,HIGH);//xung

  • delayMicroseconds(150);

  • digitalWrite(5,LOW);//xung

  • delayMicroseconds(150);

  • }

  • }

  • void tien(){

  • for (int x=0;x<=10000;x++){

  • digitalWrite(12,LOW);

  • digitalWrite(13,LOW);//dir

  • digitalWrite(10,HIGH);

  • delayMicroseconds(100);

  • digitalWrite(10,LOW);

  • delayMicroseconds(100);

  • }

  • }

  • void lui(){

  • for (int x=0;x<=10000;x++){

  • digitalWrite(12,LOW);

  • digitalWrite(13,HIGH);//dir

  • digitalWrite(10,HIGH);

  • delayMicroseconds(100);

  • digitalWrite(10,LOW);

  • delayMicroseconds(100);

  • }

  • }

  • void loop() {

  • tien();

  • digitalWrite(2,0);

  • quatrai1();

  • len1();

  • quaphai1();

  • xuong1();

  • quatrai2();

  • len2();

  • quaphai2();

  • xuong2();

  • quatrai3();

  • len3();

  • quaphai3();

  • xuong3();

  • quatrai4();

  • len4();

  • quaphai4();

  • xuong4();

  • quatrai5();

  • len5();

  • quaphai5();

  • xuong5();

  • quatrai6();

  • len6();

  • quaphai6();

  • xuong6();

  • digitalWrite(7,HIGH);

  • digitalWrite(9,HIGH);

  • digitalWrite(12,HIGH);

  • digitalWrite(2,1);

  • delay(10000);

  • }

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

Tài liệu liên quan