Revision 2:d7e629ab497f, committed 2016-11-01

Comitter:

LBeen

Date:

Tue Nov 01 14:55:42 2016 +0000

Parent:

1:52a95e4b5662

Commit message:

Ticker op 0.01 seconden, ticker werkt niet

Changed in this revision

--- a/main.cpp	Wed Oct 26 07:41:27 2016 +0000
+++ b/main.cpp	Tue Nov 01 14:55:42 2016 +0000
@@ -24,9 +24,14 @@
 //const float maxVelocity = 8.4;
 //const float MotorGain=8.4;
 
+//STOP KNOP
+InterruptIn button(D3);
+
 
 //Als straks de kalibratie af is, dan moet Spier1 > 0.4 en Spier2 >0.4 nog aangepast worden met boven threshold of niet
 
+Ticker motordraaien;
+
 //Motorvalue is een waarde tussen -1 en 1 waarmee de motor een richting en een snelheid krijgt
 float GetMotorValue() //We nemen aan dat je maar één spier tegelijkertijd kan aanspannen
 {
@@ -129,7 +134,7 @@
             SetMotor2(MV);
             //SetMotor3(0);
             break;
-        case (2):
+        case 2:
             pc.printf("Motor 3\n\r");
             SetMotor1(0);
             SetMotor2(0);
@@ -145,14 +150,22 @@
     i = indrukken%3;
 }
 
+void reset()
+{
+   motordraaien.detach();
+   SetMotor1(0);
+   SetMotor2(0);
+   //SetMotor3(0);
+}
+
 int main()
 {
     //motorpwm.period(1.0/1000.0);
     pc.baud(115200);
     pc.printf("START\n\r");
-    Ticker motordraaien;
-    motordraaien.attach(MeasureAndControl,2);
+    motordraaien.attach(MeasureAndControl,0.01);
     Spier3.fall(count);
+    button.fall(reset);
     while(true){}  
 }