Stap 5: De code
#include < NewPing.h >
#define TRIGGER_PIN 12 / / Arduino pin gebonden aan pin op de ultrasone sensor te activeren.
#define ECHO_PIN 11 / / Arduino pin gebonden aan echo pin op de ultrasone sensor.
#define MAX_DISTANCE 200 / / maximale afstand die wij wilt pingen voor (in centimeters). Maximale sensor afstand wordt begroot op 400-500cm.
NewPing sonar (TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE);
int protonoumero;
int deyteronoumero;
int tritonoumero;
int tetartonoumero;
int tetrapsifios = 0;
VOID Setup {}
pinMode(2,OUTPUT);
pinMode(3,OUTPUT);
pinMode(4,OUTPUT);
pinMode(5,OUTPUT);
pinMode(6,OUTPUT);
pinMode(7,OUTPUT);
pinMode(8,OUTPUT);
pinMode(9,OUTPUT);
pinMode(13,OUTPUT);
}
void loop {}
unsigned int ons = sonar.ping();
tetrapsifios =(uS / US_ROUNDTRIP_CM);
Als (tetrapsifios < = 9) {}
digitalWrite(13,1);
delay(10);
Als (tetrapsifios < = 5) {}
vertraging(20);
}
tetartonoumero = tetrapsifios;
tritonoumero = 0;
deyteronoumero = 0;
protonoumero = 0;
}
Als (tetrapsifios > 9 & & tetrapsifios < = 99) {}
tritonoumero = tetrapsifios/10;
tetartonoumero=tetrapsifios-(tritonoumero*10);
deyteronoumero = 0; protonoumero = 0;
}
Als (tetrapsifios > 99 & & tetrapsifios < = 999) {}
deyteronoumero = tetrapsifios/100;
tritonoumero=((tetrapsifios-(deyteronoumero*100))/10);
tetartonoumero=(tetrapsifios-(deyteronoumero*100))-(tritonoumero*10);
protonoumero = 0; }
Als (tetrapsifios > 999) {tetartonoumero = 0; tritonoumero = 0; deyteronoumero = 0; protonoumero = 0;} voor (int t = 0; t < 10; t) {}
digitalWrite(13,0);
digitalWrite(8,1);
digitalWrite(7,0);
digitalWrite(6,0);
digitalWrite(5,0);
anama(tetartonoumero);
delay(5);
digitalWrite(8,0);
digitalWrite(7,1);
digitalWrite(6,0);
digitalWrite(5,0);
anama(tritonoumero);
delay(5);
digitalWrite(8,0);
digitalWrite(7,0);
digitalWrite(6,1);
digitalWrite(5,0);
anama(deyteronoumero);
delay(5);
digitalWrite(8,0);
digitalWrite(7,0);
digitalWrite(6,0);
digitalWrite(5,1);
anama(protonoumero);
delay(5);
t = t + 1;
}
}
VOID anama (int noumero) {}
schakelaar (noumero) {}
Case 0:
digitalWrite(2,0);
digitalWrite(3,0);
digitalWrite(4,0);
digitalWrite(9,0);
breken;
Case 1:
digitalWrite(2,1);
digitalWrite(3,0);
digitalWrite(4,0);
digitalWrite(9,0);
breken;
Case 2:
digitalWrite(2,0);
digitalWrite(3,1);
digitalWrite(4,0);
digitalWrite(9,0);
breken;
Case 3:
digitalWrite(2,1);
digitalWrite(3,1);
digitalWrite(4,0);
digitalWrite(9,0);
breken;
Case 4:
digitalWrite(2,0);
digitalWrite(3,0);
digitalWrite(4,1);
digitalWrite(9,0);
breken;
Case 5:
digitalWrite(2,1);
digitalWrite(3,0);
digitalWrite(4,1);
digitalWrite(9,0);
breken;
Case 6:
digitalWrite(2,0);
digitalWrite(3,1);
digitalWrite(4,1);
digitalWrite(9,0);
breken;
Case 7:
digitalWrite(2,1);
digitalWrite(3,1);
digitalWrite(4,1);
digitalWrite(9,0);
breken;
zaak 8:
digitalWrite(2,0);
digitalWrite(3,0);
digitalWrite(4,0);
digitalWrite(9,1);
breken;
Case 9:
digitalWrite(2,1);
digitalWrite(3,0);
digitalWrite(4,0);
digitalWrite(9,1);
breken;
}
}