CHƯƠNG 4 : THIẾT KẾ HỆ THỐNG ĐIỀU KHIỂN
4.7. Xử lý tín hiệu trong ardruino
Trường hợp 1: Khi nhận tín hiệu từ chân DIR Z = 0, DIR A = 0, DIR B = 0 thì
lị xo xy lanh sẽ tác động Z1, Z2 chạy lên, van đóng mở của B1 và B2 sẽ ngăn khơng có dung dịch từ đầu nguyên liệu thoát ra.
if((digitalRead(Z)==0) &&(digitalRead(A)==0) &&(digitalRead(B)==0)) { digitalWrite(Z_1,0); digitalWrite(Z_2,0); digitalWrite(B_1,0); digitalWrite(B_2,0); }
Trường hợp 2: Khi nhận tín hiệu từ chân DIR Z = 1, DIR A = 0, DIR B = 0 thì
lị xo xy lanh sẽ tác động Z1 chạy xuống, Z2 khơng hoạt động, van đóng mở của B1 và B2 sẽ ngăn khơng có dung dịch từ đầu ngun liệu thốt ra.
if((digitalRead(Z)==1) &&(digitalRead(A)==0) &&(digitalRead(B)==0)) {
digitalWrite(Z_1,1); digitalWrite(Z_2,0); digitalWrite(B_1,0);
digitalWrite(B_2,0); }
Trường hợp 3: Khi nhận tín hiệu từ chân DIR Z = 1, DIR A = 1, DIR B = 0 thì
lị xo xy lanh sẽ tác động Z1 chạy xuống, Z2 khơng hoạt động, van đóng mở của B1 mở ra cho dung dịch thoát ra và B2 sẽ ngăn khơng có dung dịch từ đầu ngun liệu thốt ra.
if((digitalRead(Z)==1) &&(digitalRead(A)==1) &&(digitalRead(B)==0)) { digitalWrite(Z_1,1); digitalWrite(Z_2,0); digitalWrite(B_1,1); digitalWrite(B_2,0); }
Trường hợp 4: Khi nhận tín hiệu từ chân DIR Z = 0, DIR A = 1, DIR B = 0 thì
lị xo xy lanh sẽ tác động Z2 chạy xuống, Z1 không hoạt động, van đóng mở của B1 và B2 sẽ ngăn khơng có dung dịch từ đầu nguyên liệu thoát ra.
if((digitalRead(Z)==0) &&(digitalRead(A)==1) &&(digitalRead(B)==0)) { digitalWrite(Z_1,0); digitalWrite(Z_2,1); digitalWrite(B_1,0); digitalWrite(B_2,0); }
Trường hợp 5: Khi nhận tín hiệu từ chân DIR Z = 0, DIR A = 1, DIR B = 1 thì
lị xo xy lanh sẽ tác động Z1 chạy xuống, Z2 khơng hoạt động, van đóng mở của B1 mở ra cho dung dịch thoát ra và B2 sẽ ngăn khơng có dung dịch từ đầu ngun liệu thoát ra.
if((digitalRead(Z)==0) &&(digitalRead(A)==1) &&(digitalRead(B)==1)) { digitalWrite(Z_1,0); digitalWrite(Z_2,1); digitalWrite(B_1,0); digitalWrite(B_2,1); }
Hình 4.8: Mơ phỏng vận hành trên Cimco
Trước khi vận hành, luôn phải về home của khuôn trước khi chạy Gcode, đầu tiên xử lý các tín hiệu Z, A, B về mức âm, chân DIR có giá trị bằng 0V, các relay kích Z1, Z2, B1, B2 sẽ tắt.
G1 Z-1. A-1. B-1. F300.
Tiếp theo điều khiển đến vị trí bơm và điều khiển cụm bơm 1 đưa Z xuống và mở van bơm.
G0 X0. Y0.
G0 X-114.393 Y-50.857 G1 Z1. A1. F300.
Gcode reset các biến Z, A, B để Z nâng lên và đóng van bơm. G1 Z-1. A-1. B-1. F300.