DampSpringMass code

none works yet - having trouble with velocity estimation.
2012-11-04 15:42:58 +01:00
parent 82f636dacd
commit dca2a5acd4
4 changed files with 628 additions and 0 deletions
@@ -0,0 +1,28 @@
+//Damp 2 with running average position
+
+#define n 10 //number in buffer
+int x; //position measured
+float xf; // running average on n samples
+int buff[n];
+int index = 0;
+float v, oldavg; // estimate of velocity
+byte c;
+
+void setup(){
+  Serial.begin(9600);
+}
+
+void loop(){
+  buff[index] = analogRead(A0);
+  index++;
+  if(index > n-1) index = 0;
+  int acc = 0;
+  for(int i=0; i<n; i++)acc+=buff[i];
+  float avg = acc/n;
+  v = avg - oldavg;
+  oldavg = avg;
+  if(c++==0)Serial.println(v);
+}
+  
+
+