Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- int trigPin = 9;
- int echoPin =10;
- int buzer = 11;
- int g1led = 2;
- int g2led = 3;
- int y1led = 4;
- int y2led = 5;
- int r1led = 6;
- int r2led = 7;
- long czas;
- int dystans;
- void linijka(int dg1, int dg2, int dy1, int dy2, int dr1, int dr2){
- digitalWrite(g1led, dg1);
- digitalWrite(g2led, dg2);
- digitalWrite(y1led, dy1);
- digitalWrite(y2led, dy2);
- digitalWrite(r1led, dr1);
- digitalWrite(r2led, dr2);
- }
- void setup() {
- digitalWrite(buzer, LOW);
- pinMode(buzer,OUTPUT);
- pinMode(trigPin,OUTPUT);
- pinMode(echoPin,INPUT);
- pinMode(g1led,OUTPUT);
- pinMode(g2led,OUTPUT);
- pinMode(y1led,OUTPUT);
- pinMode(y2led,OUTPUT);
- pinMode(r1led,OUTPUT);
- pinMode(r2led,OUTPUT);
- Serial.begin(9600);
- }
- void loop() {
- Serial.println(dystans);
- digitalWrite(trigPin, LOW);
- delay(2);
- digitalWrite(trigPin, HIGH);
- delay(10);
- digitalWrite(trigPin, LOW);
- czas=pulseIn(echoPin, HIGH);
- dystans=czas*0.034/2;
- if(dystans>60)
- linijka(0,0,0,0,0,0);
- if(dystans<=60 && dystans>50)
- linijka(1,0,0,0,0,0);
- if(dystans<=50 && dystans>40)
- linijka(1,1,0,0,0,0);
- if(dystans<=40 && dystans>30)
- linijka(1,1,1,0,0,0);
- if(dystans<=30 && dystans>20)
- {
- linijka(1,1,1,1,0,0);
- digitalWrite(buzer, HIGH);
- delay(200);
- digitalWrite(buzer, LOW);
- delay(200);
- }
- if(dystans<=20 && dystans>10){
- linijka(1,1,1,1,1,0);
- digitalWrite(buzer, HIGH);
- delay(100);
- digitalWrite(buzer, LOW);
- delay(100);
- }
- if(dystans<=10 && dystans>0){
- linijka(1,1,1,1,1,1);
- digitalWrite(buzer, HIGH);
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement