4 directional EMG control of the XY table. Made during my bachelor end assignment.
Dependencies: C12832_lcd HIDScope mbed-dsp mbed
Diff: main.cpp
- Revision:
- 9:649229691351
- Parent:
- 7:b6d7dce49505
- Child:
- 10:7f94cd65c910
diff -r b6d7dce49505 -r 649229691351 main.cpp --- a/main.cpp Fri Apr 24 09:29:40 2015 +0000 +++ b/main.cpp Tue Apr 28 08:48:31 2015 +0000 @@ -10,15 +10,20 @@ int main() { - + float setpoint = 10000; + float step_freq = 1; MS1 = 1; MS2 = 0; MS3 = 0; -Step.period(1.0/1000); // 1 kHz, vanaf 2,5 kHz doet de motor het niet meer. -Step.write(0.5); // Duty cycle van 50% + Step.period(1./step_freq); // 1 kHz, vanaf 2,5 kHz doet de motor het niet meer. + Step.write(0.5); // Duty cycle van 50% + Dir = 1; // Dir 1 is naar boven, Dir 0 naar onder. while (1) { - Dir = 1; // Dir 1 is naar boven, Dir 0 naar onder. + float new_step_freq; + new_step_freq = (0.0001*setpoint) + (0.9999*step_freq); + step_freq = new_step_freq; + Step.period(1.0/step_freq); + wait(0.01); } - } \ No newline at end of file