Arduino servo kontroll med hjälp av ultraljud sensor (3 / 3 steg)
Steg 3: kod
Detta är en kort kod och endast 20% av vad jag har i åtanke att genomföra med detta inbäddade system.
men jag hoppas det kan hjälpa någon som är ny i servo kontroll och är i behov av en snabb instruktion.
Jag hoppas det inte är till komplicerade. så vad som egentligen händer är att min ultraljud givare är monterad på min servo och står inför en 90 graders vinkel när det kommer över ett hinder kommer mindre än eller lika med 20cm i denna riktning servo rotera åt höger. kom också ihåg att om 0 ger dig ett helt varv till vänster då full rätt rotation av den servon är 180. Tack och njut. :)
#include / / include servo bibliotek
#define trigpin 5 / / set trigpin
#define echopin 6 / / set echopin
Servo myservo; / / förklara servo namn typ servo
int längd, avståndet; //declare variabel för unltrasonic sensor
void setup() {
Serial.BEGIN(9600);
pinMode (trigpin, produktionen);
pinMode (echopin, ingång);
myservo.attach(2); / / bifoga din servo
myservo.writeMicroseconds(1500);
sätta din installation kod här, om du vill köra en gång:
}
void loop() {
myservo.write(90); / alltid sätta servo till 90 att placera det i mitten
Ultrasonic kod
digitalWrite(trigpin,HIGH);
_delay_ms(500);
digitalWrite (trigpin, låg);
duration=pulseIn(echopin,High);
avstånd =(duration/2)/29,1;
om (avstånd < = 20) / / om ultraljud sensorn upptäcker ett hinder är mindre än 20cm i 90 graders vinkel.
{
myservo.write(0); servo roterar i full fart till höger
Delay(600);
}
annat
{
myservo.write(90); / / annat servo stannar i 90 graders vinkel.
Delay(600);
}
Serial.Print("cm"); skriva ut avstånd enheten cm
Serial.println (distans), //distance
sätta din huvudsakliga kod här, för att köra flera gånger:
}