Diff: main.cpp

Revision:

3:070376242d2d

Parent:

1:97221820a967

--- a/main.cpp	Sun Apr 19 04:31:51 2015 +0000
+++ b/main.cpp	Sun Oct 29 07:06:42 2017 +0000
@@ -1,48 +1,31 @@
 #include "mbed.h"
 #include "Pixy.h"
 
-Pixy pixyL(Pixy::SPI, p11, p12, p13);
-Pixy pixyR(Pixy::SPI, p5, p6, p7);
+Pixy pixy(Pixy::SPI, PB_5, PB_4, PB_3);
 Serial pc(USBTX, USBRX);
 
-
 int main() {
-    pc.baud(115200);
-    pixyL.setSerialOutput(&pc);
-    pixyR.setSerialOutput(&pc);
+    pixy.setSerialOutput(&pc);
     pc.printf("Hello World!\n\r");
     while (1) {
+        wait(0.5);
         static int i = 0;
         int j;
         uint16_t blocks;
   
-        blocks = pixyL.getBlocks();
+        blocks = pixy.getBlocks();
   
         if (blocks) {
             i++;
-    
-                //pc.printf("Detected %d:\n\r", blocks);
-                //pc.printf("\n\r");
+                
+                pc.printf("Detected %d:\n\r", blocks);
+                pc.printf("\n\r");
                 for (j = 0; j < blocks; j++) {
-                 //   pc.printf("  block %d: \n\r", j);
-                    pixyL.blocks[j].print(pc);
+                    pc.printf("  block %d: \n\r", j);
+                    //pixy.blocks[j].print(pc);
+                    pc.printf("%d cm\n\r",pixy.blocks[j].width/6);
                 }
             
         }
-        
-        blocks = pixyR.getBlocks();
-  
-        if (blocks) {
-            i++;
-    
-                //pc.printf("Detected %d:\n\r", blocks);
-                //pc.printf("\n\r");
-                for (j = 0; j < blocks; j++) {
-                 //   pc.printf("  block %d: \n\r", j);
-                    pixyR.blocks[j].print(pc);
-                }
-            
-        }
-        pc.printf("\n\r");
     }  
 }
\ No newline at end of file