75 lines
1.6 KiB
C++
75 lines
1.6 KiB
C++
//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);
|
|
}
|
|
|
|
}
|
|
|