Linkit en Ultraljuds avstånd hastighetsmätning enhet (3 / 4 steg)
Steg 3: kod
Koden kan hittas nedan.
För att ladda upp programmet måste du installera en plugin Linkit tillsammans med arduino IDE. Du hittar instruktioner på hur man gör det i den officiella hemsidan. Du kan också hämta IDE med Linkit en plugin pre-installerat från GitHub.
#include
/*
Testade med HY-SRF05, HC-SR04
Förutsatt att en rumstemperatur på 20 grader Celsius
Krets:
* VVC anslutning av sensor kopplad till + 5V
* GND anslutning av sensor kopplad till marken
* TRIG anslutning av sensor kopplad till digital stift 12
* EKO anslutning av sensor kopplad till digital stift 13
*/
CONST int TRIG_PIN = 8;
CONST int ECHO_PIN = 9;
void setup() {
initiera seriell kommunikation:
Serial.BEGIN(9600);
pinMode(TRIG_PIN,OUTPUT);
pinMode(ECHO_PIN,INPUT);
}
void loop()
{
lång varaktighet, distanceCm, distanceIn;
Ge en kort låg puls förhand för att säkerställa en ren hög puls:
digitalWrite (TRIG_PIN, låg);
delayMicroseconds(2);
digitalWrite (TRIG_PIN, hög);
delayMicroseconds(10);
digitalWrite (TRIG_PIN, låg);
längd = pulseIn(ECHO_PIN,HIGH);
konvertera tiden till ett avstånd
distanceCm = varaktighet / 29,1 / 2;
distanceIn = varaktighet / 74 / 2;
om (distanceCm < = 0 || distanceCm > 600) {
Serial.println ("out of range");
}
annat {
Serial.Print(distanceIn);
Serial.Print ("in");
Serial.Print(distanceCm);
Serial.Print("cm");
Serial.println();
}
Delay(1000);
}