Cutey Arduino roboten. (5 / 5 steg)
Steg 5:
#include < Servo.h >
Servo myservo;
Servo myservo2;
CONST int pingPin = 50;
CONST int pingPin2 = 52;
void setup() {
Serial.BEGIN(9600);
myservo.attach(10);
myservo2.attach(11);
}
void loop()
{
lång varaktighet, tum, cm;
pinMode (pingPin2, produktionen);
digitalWrite (pingPin2, låg);
delayMicroseconds(2);
digitalWrite (pingPin2, hög);
delayMicroseconds(5);
digitalWrite (pingPin2, låg);
pinMode (pingPin, ingång);
längd = pulseIn (pingPin, hög);
tum = microsecondsToInches(duration);
cm = microsecondsToCentimeters(duration);
om (inches < 5) {
myservo.writeMicroseconds(2000);
myservo2.writeMicroseconds(2000);
}
om (tum > 5) {
myservo.writeMicroseconds(1000);
myservo2.writeMicroseconds(1000);
}
Serial.Print(inches);
Serial.Print ("in");
Serial.Print(cm);
Serial.Print("cm");
Serial.println();
Delay(100);
}
lång microsecondsToInches(long microseconds)
{
återvända mikrosekunder / 74 / 2;
}
lång microsecondsToCentimeters(long microseconds)
{
återvända mikrosekunder / 29 / 2;
}