Diff: main.cpp

Revision:

15:6453cd351452

Parent:

14:3844d1dacece

Child:

16:3649eb1a056d

--- a/main.cpp	Wed Mar 11 14:00:37 2015 +0000
+++ b/main.cpp	Thu Mar 12 18:44:57 2015 +0000
@@ -29,7 +29,7 @@
 
 //DigitalOut led(LED1);
 
-
+Serial HC06(PTD3,PTD2); //TX,RX
 //Serial pc(USBTX, USBRX);
 
 //Timer MeasureTimer; //Timer used for measurement
@@ -56,6 +56,14 @@
     //pc.printf("sensorsCheckSum is %i",sensorsCheckSum);
 }
 
+void printBluetooth() { //for debugging
+    HC06.printf("%i  %i               %i %i",sensorArray[NUMBER_SENSORS_REGULAR-1]->state,sensorArray[NUMBER_SENSORS_REGULAR-2]->state,sensorArray[1]->state,sensorArray[0]->state);
+    HC06.printf("%i  %i               %i %i",sensorArray[NUMBER_SENSORS_REGULAR-3]->state,sensorArray[NUMBER_SENSORS_REGULAR-4]->state,sensorArray[3]->state,sensorArray[2]->state);
+    //HC06.printf("%i      %i/n%i      %i,sensorArray[NUMBER_SENSORS_REGULAR]->state,sensorArray[NUMBER_SENSORS_REGULAR+1]->state,sensorArray[NUMBER_SENSORS_REGULAR+2]->state,sensorArray[NUMBER_SENSORS_REGULAR+3]->state);        
+    //HC06.printf("%f                      %f",motor.getLeftSpeed(),motor.getRightSpeed());
+    HC06.printf("/n/n");
+}
+
 int main() {
     
     
@@ -77,13 +85,20 @@
  //   setup_counter(1000, 0);
   //  float frequency = measure_frequency(CHANNEL_1);
     
-    driveMode = REGULAR; //initialise drivemode
+    driveMode = REGULAR; //initialise drivemoder
     sensor_initialise(); // initialise sensor values
     wait(1); //give time to set up the system
     
     sensorTimer.start(); // start timer for sensors
-    shoot (0.3);
     
+    HC06.baud(9600);
+    HC06.printf("Press 'r'\n");
+    pc.printf("we start");
+   
+    //HC06.printf("AT");
+    //HC06.printf("AT+PIN5555");
+    
+
    // pc.printf("Start...");
 //    
 //