Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #define trigPin 12
- #define echoPin 11
- #define RED 4
- #define YELLOW 3
- #define GREEN 2
- 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(GREEN, OUTPUT);
- digitalWrite(GREEN, LOW);
- pinMode(YELLOW, OUTPUT);
- digitalWrite(YELLOW, LOW);
- pinMode(RED, OUTPUT);
- digitalWrite(RED, LOW);
- Serial.begin(9600);
- }
- void loop() {
- Serial.println(proximity());
- controlLED(proximity());
- delay(250);
- }
- int proximity() {
- long czas, dystans;
- digitalWrite(trigPin, LOW);
- delayMicroseconds(2);
- digitalWrite(trigPin, HIGH);
- delayMicroseconds(10);
- digitalWrite(trigPin, LOW);
- return pulseIn(echoPin, HIGH);
- }
- void controlLED(int a) {
- if (a <= 300) {
- digitalWrite(GREEN, HIGH);
- digitalWrite(YELLOW, LOW);
- digitalWrite(RED, LOW);
- }else if(a>300 && a<=700){
- digitalWrite(YELLOW, HIGH);
- digitalWrite(GREEN, LOW);
- digitalWrite(RED, LOW);
- }else{
- digitalWrite(RED, HIGH);
- digitalWrite(GREEN, LOW);
- digitalWrite(YELLOW, LOW);
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement