Motion examples and tests

2012-11-05 11:30:21 +01:00
parent 3596727aed
commit 38ee24b847
6 changed files with 2378 additions and 1 deletions
@@ -0,0 +1,24 @@
+//Damp Euler
+
+#define n 10 //number in buffer "window size"
+// finite difference with n samples between x(i)
+int x[n]; //last n samples of position
+int index = 0;
+float v; // estimate of velocity
+byte c;
+
+void setup(){
+  Serial.begin(9600);
+  for(int i=0; i<n; i++) x[i]=analogRead(A0);
+}
+
+void loop(){
+  x[index] = analogRead(A0); //position measured
+  v = (x[index] - x[index++%n])/n;
+  if(index > n-1) index = 0;
+  v = buff[index] - buff[(index-n)%n];
+  if(c++==0)Serial.println(v);
+}
+  
+
+