Servo kontroll med en Flex/Bend Sensor (3 / 7 steg)
Steg 3: med alla dina kablar på plats, nu för koden!
Följande kod är inställt att läsa flex sensorn mellan vila och en 90 graders böj och sedan rotera servo bladet därmed.
Servo kontrollkod av The TuqsCat
#include servo myservo; skapa objekt för att styra en servo servo
int val; variabel att läsa värdet från det analoga stiftet
void setup() {
initiera seriell kommunikation
Serial.BEGIN(9600);
myservo.attach(8); tillmäter objektet servo servo på stift 8}
void loop() {
int sensor, grader;
Läs spänningen från spänningsavdelare (sensor plus resistor)
sensor = analogRead(A1);
två första siffrorna är sensorn värdena för rak (540) och bent (790)
de andra två numren är grad avläsningarna vi ska mappa som till (0-90 grader)
grader = karta (sensor, 540, 790, 0, 90);
Observera att ovanstående nummer är idealiska, din sensor värden varierar
att förbättra noggrannheten, köra programmet, notera din sensor analoga värden
När den är rak och böjd, och sätt in dessa värden i funktionen ovan.
myservo.write(Degrees); / / anger servo skalad värde
Delay(5); väntar på servo att komma dit
debug endast för användning
skriva ut resultatet
Serial.Print ("analog ingång:");
Serial.Print(sensor,dec);
Serial.Print ("grader:");
Serial.println(Degrees,dec);
Delay(5); / / paus innan du tar nästa läsning
}