Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #define trigPin 2
- #define echoPin 3
- void setup() {
- Serial.begin (9600);
- pinMode(trigPin, OUTPUT); //Pin, do którego podłączymy trig jako wyjście
- pinMode(echoPin, INPUT); //a echo, jako wejście
- pinMode(7, OUTPUT); //Wyjście dla buzzera
- pinMode(8, OUTPUT);
- pinMode(9, OUTPUT);
- pinMode(10, OUTPUT);
- pinMode(11, OUTPUT);
- }
- void loop() {
- zakres(0, 10);
- zakres2(10, 20);
- zakres3(20, 30);
- zakres4(30, 40);
- zakres5(40, 50);
- delay(100);
- }
- int zmierzOdleglosc() {
- long czas, dystans;
- digitalWrite(trigPin, LOW);
- delayMicroseconds(2);
- digitalWrite(trigPin, HIGH);
- delayMicroseconds(10);
- digitalWrite(trigPin, LOW);
- czas = pulseIn(echoPin, HIGH);
- dystans = czas / 58;
- return dystans;
- }
- void zakres(int a, int b) {
- int jakDaleko = zmierzOdleglosc();
- if ((jakDaleko > a) && (jakDaleko < b))
- digitalWrite(7, HIGH); //Włączamy buzzer
- }
- void zakres2(int a, int b) {
- int jakDaleko = zmierzOdleglosc();
- if ((jakDaleko > a) && (jakDaleko <b ))
- digitalWrite(8, HIGH);
- }
- void zakres3(int a, int b) {
- int jakDaleko = zmierzOdleglosc();
- if ((jakDaleko > a) && (jakDaleko < b))
- digitalWrite(9, HIGH);
- }
- void zakres4(int a, int b) {
- int jakDaleko = zmierzOdleglosc();
- if ((jakDaleko > a) && (jakDaleko < b))
- digitalWrite(10, HIGH);
- }
- void zakres5(int a, int b) {
- int jakDaleko = zmierzOdleglosc();
- if ((jakDaleko > a) && (jakDaleko < b))
- digitalWrite(11, HIGH);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement