Avståndet controller för justerbar bordshöjd (5 / 5 steg)
Steg 5: Kod Arduino
< p > / * < br > kraft tabell controler av Joakim Christoffersson
Baserat på HC-SR04 Ping avstånd sensor trollmaker.com/article3/arduino-and-hc-sr04-ultrasonic-sensor
* / < /p >< p > #define trigPin 13
#define echoPin 12
#define ner 10
#define upp 11 < /p >< p > void setup() {
Serial.BEGIN (9600);
pinMode (trigPin, produktionen);
pinMode (echoPin, ingång);
pinMode (ned, produktion);
pinMode (upp, produktion);
} < /p >< p > void loop() {
int varaktighet, avstånd;
digitalWrite (trigPin, låg);
delayMicroseconds(10);
digitalWrite (trigPin, hög);
längd = pulseIn (echoPin, hög);
avståndet = (längd/2) / 29,1;
om (avstånd < 12) {
lägre bord
Serial.println("down");
digitalWrite(down,HIGH);
digitalWrite(up,LOW);
}
annars om (avstånd > 12 & & avstånd < 50) {
höja tabell
Serial.println("up");
digitalWrite(up,HIGH);
digitalWrite(down,LOW);
}
annat {
digitalWrite(up,LOW);
digitalWrite(down,LOW);
}
om (avstånd > = 300 || avstånd < = 0) {
Serial.println ("out of range");
}
annat {
Serial.Print(Distance);
Serial.println ("cm");
}
Delay(250);
} < /p >