
Test programma voor de encoder
Dependencies: Encoder MODSERIAL mbed
Diff: main.cpp
- Revision:
- 1:8a78b9be5e0e
- Parent:
- 0:f5c7335c5903
--- a/main.cpp Fri Sep 18 13:48:47 2015 +0000 +++ b/main.cpp Fri Sep 18 14:13:33 2015 +0000 @@ -6,6 +6,7 @@ DigitalOut motor2direction(D4); //D4 en D5 zijn motor 2 (op het motorshield) PwmOut motor2speed(D5); MODSERIAL pc(USBTX,USBRX); +int round = 4200; //4200 is gelijk aan 360 graden!!!! :D int main() { @@ -15,9 +16,9 @@ motor2speed = 0.2f; while (true) { - pc.printf("pos: %d, speed: %f\r\n", encoder1.getPosition(), encoder1.getSpeed()); + pc.printf("pos: %d, speed: %.20f\r\n", encoder1.getPosition(), encoder1.getSpeed()); - if (encoder1.getPosition()>42000){ //4200 is gelijk aan 360 graden!!!! :D + if (encoder1.getPosition()>10*round){ motor2speed=0.0; }