Diff: main.cpp

Revision:

1:d0d9653a4547

Parent:

0:e77a0edb9878

Child:

2:968338353aef

--- a/main.cpp	Thu Feb 20 02:11:09 2014 +0000
+++ b/main.cpp	Thu Feb 20 18:55:04 2014 +0000
@@ -1,7 +1,8 @@
 #include <mbed.h>
 #include "PololuEncoder.h"
+#include "Pacer.h"
 
-DigitalOut myled(LED1);
+DigitalOut led1(LED1), led2(LED2);
 
 Serial pc(USBTX, USBRX);
 
@@ -9,19 +10,27 @@
 
 PololuEncoderBuffer encoderBuffer;
 PololuEncoder encoder1(p6, p7, &encoderBuffer, ENCODER1);
-//PololuEncoder encoder1(p6, p7, ENCODER1);
 
 int main() {
+    Pacer reportPacer(250000);
+    Pacer blinkPacer(200000);
+    uint32_t eventCount = 0;    
     while(1) {
-        //pc.printf("Encoder: %d\n", encoder1.getCounts());          
         while(encoderBuffer.hasEvents())
         {
             PololuEncoderEvent event = encoderBuffer.readEvent();
-            pc.printf("%x\n", event);
+            eventCount += 1;
+            pc.printf("e %x\n", event);
         }
-        myled = 1;
-        wait(0.1);
-        myled = 0;
-        wait(0.1);
+        if(reportPacer.pace())
+        {
+            led2 = 1;
+            pc.printf("%8x %8x\n", encoder1.getCount(), eventCount);
+            led2 = 0;
+        }
+        if (blinkPacer.pace())
+        {
+            led1 = !led1;
+        }
     }
 }