Jordan Brack / SmartWheelsPublic

SmartWheels self-driving race car. Designed for NXP Cup. Uses FRDM-KL25Z, area-scan camera, and simple image processing to detect and navigate any NXP spec track.

Dependencies:   TSI USBDevice mbed-dev

Fork of SmartWheels by haofan Zheng

Diff: main.cpp

Revision:
32:5badeff825dc
Parent:
29:f87d8790f57d
Child:
36:7e747e19f660
--- a/main.cpp	Thu Mar 02 04:26:33 2017 +0000
+++ b/main.cpp	Thu Mar 02 23:56:42 2017 +0000
@@ -34,8 +34,9 @@
     bool isRegRead = false;
     
     //motor.setLeftSpeed(0.2);
-    
+    //ardu_cam_print_debug();
     ardu_cam_init();
+    //ardu_cam_print_debug();
     
     float tempCount = 0;
     //timer.reset();
@@ -63,11 +64,12 @@
         }
         
         
-        if(!isRegRead && g_core.GetUSBServer().GetStatus() == SER_STAT_RUNNING)
+        if(!isRegRead && g_core.GetUSBServer().GetStatus() == SER_STAT_RUNNING && timer.read() > 2.5f && ardu_cam_get_fifo_length() > 0)
         {
-            OV7725RegBuf * regBuf = new OV7725RegBuf(g_core);
-            regBuf->ReadRegisters();
-            delete regBuf;
+            //OV7725RegBuf * regBuf = new OV7725RegBuf(g_core);
+            //regBuf->ReadRegisters();
+            //delete regBuf;
+            ardu_cam_print_debug();
             isRegRead = true;
         }