2012-11-04 15:42:58 +01:00
|
|
|
//Damp - measure velocity then f=Bv
|
|
|
|
|
#import <Motor.h>
|
2012-12-07 08:15:45 -08:00
|
|
|
int x; //position measured - then filtered
|
2012-11-04 15:42:58 +01:00
|
|
|
float v, f, t, xold; //velocity, force, time delta
|
|
|
|
|
byte c; //for debug print every 256th loop
|
|
|
|
|
|
|
|
|
|
void setup(){
|
|
|
|
|
Serial.begin(9600);
|
|
|
|
|
xold = analogRead(A0);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void loop(){
|
|
|
|
|
x = analogRead(A0);
|
2012-11-05 11:30:21 +01:00
|
|
|
v = x - xold; //lag v, too?
|
2012-11-04 15:42:58 +01:00
|
|
|
xold += 0.1*(x-xold); //slide xold with lag
|
|
|
|
|
|
|
|
|
|
if(c++==0){
|
|
|
|
|
//Serial.print(xold);
|
|
|
|
|
//Serial.print(" ");
|
|
|
|
|
Serial.println(100*v);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|