Servo bediening met een Flex/Bend Sensor (3 / 7 stap)

Stap 3: met al uw draden in plaats, nu voor de code!

De volgende code is ingesteld om te lezen van de flex-sensor tussen rest staat en een bocht van 90 graden en draait u de servo-blade dienovereenkomstig.

Servo-controlecode door The TuqsCat

#include servo myservo; maken van servo-object om te bepalen van een servo

int val; variabele te lezen van de waarde van de analoge pin

VOID Setup {}

initialiseren van seriële communicatie

Serial.begin(9600);

myservo.attach(8); hecht de servo op pin 8 aan de servo-object}

void loop {}

int sensor, graden;

Lees de spanning van de scheidingslijn van de spanning (sensor plus weerstand)

sensor = analogRead(A1);

de eerste twee nummers zijn de sensor-waardes voor straight (540) en gebogen (790)

de laatste twee nummers zijn de lezingen van de mate we die zal toewijzen aan (0 tot en met 90 graden)

graden = kaart (sensor, 540, 790, 0, 90);

Merk op dat de bovenstaande getallen zijn ideaal, hangt van uw sensor-waardes

verbeteren van de nauwkeurigheid, het programma te draaien, Let op analoge van uw sensor-waardes

Wanneer het is rechte en gebogen, en die waarden in de bovenstaande functie invoegen.

myservo.write(Degrees); / / stelt u de positie van de servo volgens de geschaalde waarde

delay(5); wacht tot de servo om er te komen

debug alleen voor gebruik

Print het resultaat

Serial.Print ("analoge ingang:");

Serial.Print(sensor,DEC);

Serial.Print ("graden:");

Serial.println(Degrees,DEC);

delay(5); / / pauzeren alvorens de volgende lezing

}