THIẾT BỊ VÀO THIẾT BỊ RA

Stt TB DC MT Stt TB DC MT
1 CTXP 3
2 CTXT 4
3 N_UT 5
4 D_XT 6
5 D_XP 7

int CTXP = 3;//khai báo địa chỉ

int CTXT = 4;

int N_UT = 5;

int D_XT = 6;

int D_XP = 7;

void setup() {

pinMode(CTXP,INPUT_PULLUP);//chọn chức năng IO

pinMode(CTXT,INPUT_PULLUP);

pinMode(N_UT,INPUT_PULLUP);

pinMode(D_XP,OUTPUT);

pinMode(D_XT,OUTPUT);

digitalWrite(D_XT,HIGH);//tắt xi nhanh trái

digitalWrite(D_XP,HIGH);//tắt xi nhanh phái

void loop() {

while(digitalRead(CTXP)==0)//trong khi CT XP bật

digitalWrite(D_XP,LOW);//bật

delay(100);

digitalWrite(D_XP,HIGH);//tắt

delay(100);

while(digitalRead(CTXT)==0)//trong khi CT XT bật

digitalWrite(D_XT,LOW);//bật
 delay(100);

digitalWrite(D_XT,HIGH);//tắt

delay(100);

while(digitalRead(N_UT)==0)//bấm nút ưu tiên

digitalWrite(D_XP,LOW);//bật

digitalWrite(D_XT,LOW);//bật

delay(100);

digitalWrite(D_XP,HIGH);//tắt

digitalWrite(D_XT,HIGH);//tắt

delay(100);