Sooner Competitive Robotics / Mbed 2 deprecated IEEE_14_Freescale

Dependencies:   mbed

Fork of IEEE_14_Freescale by IEEE 2014 Mbed

Revision:
27:688409727452
Parent:
26:ade7c813538f
Child:
28:c7e8d2db03f5
--- a/main.cpp	Fri Mar 14 00:38:51 2014 +0000
+++ b/main.cpp	Fri Mar 14 02:13:10 2014 +0000
@@ -192,7 +192,8 @@
                 //DBGPRINT("ifac = %f\r\n",bot.ifac);
                 break;
             case 'u':
-                response=bot.BTLink.sendCmd(0x02,testdata,5);
+                bot.pollForRigs();
+                /*response=bot.BTLink.sendCmd(0x02,testdata,5);
                 dataTimer.start();
                 dataTimer.reset();
                 while(!(gotAck=bot.BTLink.getAck(response)) && dataTimer.read_ms()<500);
@@ -213,6 +214,7 @@
                 while(!(gotAck=bot.BTLink.getAck(response)) && dataTimer.read_ms()<500);
                 dataTimer.stop();
                 DBGPRINT("BackToNormal=%d, %d, %d [%d]\n\r",response,bot.BTLink.bufSize(), gotAck, dataTimer.read_ms());
+                */
                 //bot.BTLink.getData(0x02, responseData);
                 //while(!bot.BTLink.getAck(response));
                 //bot.dfac*=2;