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,56 @@
+// CenterAB - both motors
+// Freqequency1 B->Frequency2
+//CenterA at xB, CenterB at xA?
+//feels like "Slave"
+//position on A0, pwm:D9, dir:D8,D7
+//CenterB
+//position on A3, pwm:D10, dir:D11,D12
+
+
+#include <Motor.h>
+#include <Music.h>
+#define BIT_DEPTH 8
+#define NUM_OSCILLATORS 2
+
+int duty, count, fout;
+int xA, xB, foutA, foutB;
+
+void setup(){
+  Serial.begin(9600);
+  MotorA.init();
+  MotorB.init();
+  Music.init();
+  Music.setWaveform1(0);//8bit
+  Music.setWaveform2(0);
+  Music.setGain1(1.0f);
+  Music.setGain2(1.0f);
+}
+
+void loop(){
+   
+  xA = analogRead(A0);
+  Music.setFrequency1(map (xA, 0, 1023, 40, 2000)); 
+  
+  xB = analogRead(A3);
+  Music.setFrequency2(map (xB, 0, 1023, 40, 2000)); 
+  
+  foutA = -6*(xA-xB); // this will peak at x=1024/6
+  MotorA.torque(foutA);  // 1/4 or 1/2 ?
+
+  foutB = -6*(xB-xA); // this will peak at x=1024/6
+  MotorB.torque(foutB);  // 1/4 or 1/2 ?
+
+  Music.setGain(float(abs(xA-xB))/1024.0f);
+    // print every 1000 cycles
+  if(count++>=0){
+    count=-500;
+    Serial.print(xA,DEC);
+    Serial.print(" ");
+    Serial.print(foutA,DEC);
+    Serial.print(" ");
+    Serial.print(xB,DEC);
+    Serial.print(" ");
+    Serial.println(foutB,DEC);
+  }
+
+}