Switch
Dependencies: MODSERIAL QEI mbed
Diff: main.cpp
- Revision:
- 2:d7e629ab497f
- Parent:
- 1:52a95e4b5662
--- 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){} }