// FSR met servo. Sorteren op basis van gewicht.
#include <Servo.h>
Servo servo; // de servo heet servo
int pos = 0; // De positie van de servo (tussen 0 en 180).
int fsrPin = 0; //FSR en 10Kohm verbonden met analoog 0
int fsrWaarde; // meting van analoge pin 0
void setup(void) {
servo.attach(9); // servo verbonden met pin 9
Serial.begin(9600); // start de serial monitor
}
void loop(void) {
fsrWaarde = analogRead(0);
Serial.print("Analoge waarde = ");
Serial.print(fsrWaarde); // druk de analoge waarde af
if (fsrWaarde < 10) {
Serial.println(" - Weger leeg");
pos=90;
servo.write(pos); // ga naar positie 90 graden
}
else if (fsrWaarde < 200) {
Serial.println(" - Licht voorwerp");
pos=5;
servo.write(pos); // ga naar positie 5 graden
}
else if (fsrWaarde < 500) {
Serial.println(" - Zwaar voorwerp");
pos=175;
servo.write(pos); // ga naar positie 175 graden
}
else if (fsrWaarde >= 500) {
Serial.println(" - Te zwaar voorwerp");
pos=90;
servo.write(pos); // ga naar positie 90 graden
}
delay(1000);
}