ITTT Arduino Yun Schoolproject (3 / 4 steg)
Steg 3: kod
Arduino styrelsen att ansluta till din dator/laptop. Öppna Arduino IDE och Lägg till följande kod i en ny skiss-fil:
Lägger till Servo bibliotek
#include
Definierar Tirg och Echo stift av sensorn och vilken makt pin kommer de vara kopplad const int trigPin = 10; CONST int echoPin = 11;
Variabler för längd och avstånd lång varaktighet; int avstånd;
Servo myServo; Koden till controle servo motor void setup() {pinMode (trigPin, produktionen); / / anger trigPin som en utgång pinMode (echoPin, ingång); / / sätter echoPin som en Input Serial.begin(9600); myServo.attach(12); / / definierar på vilka power stift servomotor är kopplad}
void loop() {/ / roterar servomotor från 15 till 165 grader för (int jag = 15; jag < = 165; i ++) {myServo.write(i); delay(30); avstånd = calculateDistance(); / / anropar en funktion för att beräkna avståndet mätt av Ultraljuds-sensorn för varje grad Serial.print(i); / / skickar den nuvarande graden till den seriella Port Serial.print(","); / / skickar tillägg tecken bredvid det föregående värdet behövs senare i bearbetning IDE för indexering Serial.print(distance); / / skickar värdet avstånd till den seriella Port Serial.print("."); / / skickar tillägg karaktär alldeles intill det föregående värdet behövs senare i bearbetning IDE för indexering} / / upprepar föregående raderna när rotera tillbaka från 165 till 15 grader för (int jag = 165; jag > 15; i--) {myServo.write(i); delay(30); avstånd = calculateDistance(); Serial.Print(i); Serial.Print(","); Serial.Print(Distance); Serial.Print("."); } }
Funktion för att beräkna avståndet mätt av sensor int calculateDistance() {digitalWrite (trigPin, låg); delayMicroseconds(2); / / sätter trigPin på höga statliga för 10 micro sekunder digitalWrite (trigPin, hög), delayMicroseconds(10), digitalWrite (trigPin, låg), längd = pulseIn (echoPin, hög); / / returnerar ljudvågen reser tid i mikrosekunder genom att läsa echoPin avståndet = varaktighet * 0,034 / 2; return avstånd;}
Ladda upp denna kod till din Arduino. Servomotor bör att flytta just nu.