Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- int in1 = 4;
- int in2 = 5;
- int in3 = 6;
- int in4 = 7;
- int s1 = A0;
- int s2 = A1;
- int s3 = A2;
- int s4 = A3;
- int s5 = A4;
- int s6 = A5;
- int esquerda_sensor1 = 0;
- int direita_sensor = 0;
- int esquerda_sensor = 0;
- int direita_sensor1 = 0;
- int esquerda_sensor2 = 0;
- int direita_sensor2 = 0;
- void moto_andar() {
- digitalWrite(in1, HIGH);
- digitalWrite(in2, LOW);
- digitalWrite(in3, HIGH);
- digitalWrite(in4, LOW);
- delay(100);
- }
- void moto_direita() {
- digitalWrite(in1, HIGH);
- digitalWrite(in2, LOW);
- digitalWrite(in3, HIGH);
- digitalWrite(in4, HIGH);
- delay(100);
- }
- void moto_esquerda() {
- digitalWrite(in3, HIGH);
- digitalWrite(in4, LOW);
- digitalWrite(in1, HIGH);
- digitalWrite(in2, HIGH);
- delay(100);
- }
- void moto_stop() {
- digitalWrite(in3, HIGH);
- digitalWrite(in4, HIGH);
- digitalWrite(in1, HIGH);
- digitalWrite(in2, HIGH);
- delay(100);
- }
- void setup () {
- pinMode(s1, INPUT);
- pinMode(s2, INPUT);
- pinMode(s3, INPUT);
- pinMode(s4, INPUT);
- pinMode(s5, INPUT);
- pinMode(s6, INPUT);
- pinMode(in1, OUTPUT);
- pinMode(in2, OUTPUT);
- pinMode(in3, OUTPUT);
- pinMode(in4, OUTPUT);
- }
- void loop() {
- esquerda_sensor = digitalRead(s1);
- direita_sensor = digitalRead(s2);
- direita_sensor1 = digitalRead(s3);
- esquerda_sensor1 = digitalRead(s4);
- direita_sensor2 = digitalRead(s5);
- esquerda_sensor2 = digitalRead(s6);
- if(esquerda_sensor && direita_sensor)
- {
- moto_andar();
- moto_stop();
- }
- if(!esquerda_sensor && direita_sensor )
- {
- moto_direita();
- moto_stop();
- }
- if(esquerda_sensor && !direita_sensor)
- {
- moto_esquerda();
- moto_stop();
- }
- if(!esquerda_sensor && !direita_sensor)
- {
- moto_stop();
- }
- if(esquerda_sensor1 && direita_sensor1)
- {
- moto_andar();
- moto_stop();
- }
- if(!esquerda_sensor1 && direita_sensor1)
- {
- moto_direita();
- moto_stop();
- }
- if(esquerda_sensor1 && !direita_sensor1)
- {
- moto_esquerda();
- moto_stop();
- }
- if(!esquerda_sensor1 && !direita_sensor1)
- {
- moto_stop();
- }
- if(esquerda_sensor2 && direita_sensor2)
- {
- moto_andar();
- moto_stop();
- }
- if(!esquerda_sensor2 && direita_sensor2)
- {
- moto_direita();
- moto_stop();
- }
- if(esquerda_sensor2 && !direita_sensor2)
- {
- moto_esquerda();
- moto_stop();
- }
- if(!esquerda_sensor2 && !direita_sensor2)
- {
- moto_stop();
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement