Bill Examples

M&MStudioBV
2013-02-05 19:01:35 +01:00
parent a7408c519a
commit 336b2b45ab
42 changed files with 2036 additions and 0 deletions
@@ -0,0 +1,55 @@
+// Pluck over-lap
+// BV 3 Feb 13
+// one pluck at x=512
+
+int x, fout, count;
+float f;
+float w = 50; //width of pluck
+float h = 500; //height of pluck
+float slope = h/w;
+boolean forward = true;
+
+#include <Motor.h>
+
+void setup(){
+  MotorA.init();
+  MotorB.init();
+  Serial.begin(9600);
+}
+
+void loop(){
+  //x = analogRead(A0) - 512;
+  x = analogRead(A3) - 512;
+  if (forward){
+    if (x<=0) f = 0;
+    if (x>0 && x<w) f = - slope*x;
+    if (x>w){
+      f = 0;
+      forward = false;
+      Serial.println("pluck forward");
+    }
+  }
+  else
+  {
+    if (x>0) f = 0;
+    if (x<0 && x>-w) f = - slope*x;
+    if (x < -w){
+      f = 0;
+      forward = true;
+      Serial.println("pluck back");
+    }
+  }
+  fout = int(f);
+  //MotorA.torque(fout);
+  MotorB.torque(fout);
+  if(count++>=0){
+    count=-1000; // wait 1000 loops before print
+    Serial.print(x,DEC);
+    Serial.print(" ");
+    Serial.println(fout,DEC);
+  }
+}
+    
+    
+
+