ValerioCietto / Arduino-Repo

scratch from arduino ide
1 stars 2 forks source link

Filtro per servo #3

Open SonnyZanfardino opened 9 years ago

SonnyZanfardino commented 9 years ago

include

Servo myservo;

int previousValue; //ultimo misuramento int currentValue; //valore corrente int expectedValue;

int flexSensor = 0;

int noise = 10; //se il prossimo rilevamento è cambia meno di 10, viene scartato int noise1 = 350; //se il prossimo rilevamento è cambia più di 350, viene scartato void setup() { pinMode(flexSensor, INPUT); previousValue = analogRead(flexSensor); currentValue = previousValue; expectedValue = previousValue;

myservo.attach(9);

Serial.begin(9600); }

void loop() { Serial.flush();
delay(500);

currentValue = analogRead(flexSensor);
if( abs(currentValue-previousValue) < noise) //abs è la funzione modulo abs(-5) == 5 {
previousValue=currentValue;
} else { Serial.print("current value: "); Serial.println(currentValue); currentValue = map(currentValue, 300, 1023, 0, 180); myservo.write(currentValue); delay(100); } if( abs(currentValue-previousValue) > noise1) //abs è la funzione modulo abs(-5) == 5 {
previousValue=currentValue;
} else { Serial.print("current value: "); Serial.println(currentValue); currentValue = map(currentValue, 300, 1023, 0, 180); myservo.write(currentValue); delay(100); } }

ValerioCietto commented 9 years ago

http://www.instructables.com/id/DIY-Bend-Sensor-Using-only-Velostat-and-Masking-T/