TEI Studio

2013-02-10 07:11:56 +01:00
parent bae5b3d412
commit 9c4ffb6e7b
82 changed files with 0 additions and 8254 deletions
@@ -0,0 +1,74 @@
+//plucks - four bumps
+//three notes (400,500,600hz)
+//can't get Music.setGain1, etc to work only Music.setGain() starts all of them.
+
+#include <Music.h>
+#include <Motor.h>
+
+int x, xold, xt, F; // input position x, output force F
+int K = 10; // slope constant
+byte count; //for print count-down
+
+void setup(){
+  Music.init();
+  Music.setFrequency1(200);
+  Music.setFrequency2(250);
+  Music.setFrequency3(300);
+  
+  
+  MotorA.init();
+  
+  Serial.begin(9600);
+  x = analogRead(A0); // initialize x
+}
+
+void loop(){
+  xold = x;
+  x =  analogRead(A0);
+
+// did xold - x include 125, 375, 625, 875?  or x%250 = 125
+
+if (((xold <= 125) && (x > 125)) || ((xold >= 125) && (x < 125))){
+  Music.setGain1(1.0f);
+  //Music.setFrequency(200);
+}
+if (((xold <= 375) && (x > 375)) || ((xold >= 375) && (x < 375))){
+  Music.setGain2(1.0f);
+  //Music.setFrequency(250);
+}
+if (((xold <= 625) && (x > 625)) || ((xold >= 625) && (x < 625))){
+  Music.setGain3(1.0f);
+  //Music.setFrequency(300);
+}
+if (((xold <= 875) && (x > 875)) || ((xold >= 875) && (x < 875))){
+  Music.setGain1(1.0f);
+  //Music.setFrequency(400);
+  }
+  else{
+    Music.setGain1(0.995f*Music.getGain1Float());
+    Music.setGain2(0.995f*Music.getGain2Float());
+    Music.setGain3(0.995f*Music.getGain3Float());
+  }
+  
+
+
+  xt = x % 250; //same force for each 250 ranage
+  F = 0;
+  if (xt > 60) F = - K * (xt - 60);
+  if (xt > 80) F = - K * (100 - xt);
+  if (xt > 120) F =  K * (140 - xt);
+  if (xt > 140) F = 0;
+  MotorA.torque(F);
+  
+ 
+ // print every 256 cycles
+  if(count++==0){
+    Serial.print(x);
+    Serial.print(" ");
+    Serial.print(xt);
+    Serial.print(" ");
+    Serial.println(F);
+  }
+
+}
+