40 lines
749 B
C++
40 lines
749 B
C++
//Center
|
|
//uses a variable force (pwm duty)
|
|
//If it feels like a mountain - pushing away from center, then
|
|
//reverse the motor leads
|
|
//or for a quick fix in the code: change if(f < 0) to if (f > 0)
|
|
|
|
#include "Motor.h"
|
|
#include "Music.h"
|
|
|
|
int pos; // position from analogRead
|
|
int force; // computed from pos and k
|
|
int k = 2; // spring constant
|
|
int duty; // pwm duty for Timer1 (range 0 - 1023) 10-bit resolution
|
|
|
|
void setup()
|
|
{
|
|
MotorA.init();
|
|
Music.init();
|
|
|
|
}
|
|
|
|
void loop()
|
|
{
|
|
|
|
pos = analogRead(A0);
|
|
|
|
Music.setFrequency(pos);
|
|
|
|
force = k * (512 - pos);
|
|
//duty = abs(force);
|
|
//duty = min(512, duty);
|
|
|
|
MotorA.torque(force);
|
|
|
|
//if(force < 0) MotorA.direction(FORWARD);
|
|
//else MotorA.direction(BACKWARD);
|
|
|
|
}
|
|
|