Rosalyn Sleurink / Mbed 2 deprecated frdm_countdegrees

Test programma voor de encoder

Dependencies:   Encoder MODSERIAL mbed

Files at this revision

API Documentation at this revision

Revision 1:8a78b9be5e0e, committed 2015-09-18

Comitter:
roosalyn
Date:
Fri Sep 18 14:13:33 2015 +0000
Parent:
0:f5c7335c5903
Commit message:
a program to test the encoder and the output to putty; position works, speed doesn't work

Changed in this revision

main.cpp Show annotated file Show diff for this revision Revisions of this file 
--- 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;
         }