Diff: main.cpp

Revision:

9:649229691351

Parent:

7:b6d7dce49505

Child:

10:7f94cd65c910

--- 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