   Serial.begin(9600);
   ST.drive(0);
   ST.turn(0);
+  
+  delay(3000);
+  
+  // Connect to Sphero
+  bluetooth.beginCMD();
+  bluetooth.connect();
+  bluetooth.endCMD();
   
   // Indicator LED
   sphero.setBackLED(0xFF);

  // Init Heading to 0
  sphero.setHeading(0x00);
  
  // Get Pitch @ 5Hz
  sphero.setStreamingData(10, 1, SPHERO_IMU_PITCH | SPHERO_IMU_YAW);
}


/************************************************
 Written by Cruz Monrreal II
 Created on 08-19-2012
 Modified on 11-11-2012
 
 Updates can be found here:
  https://github.com/cmonr/Arduino-Sphero-Library
************************************************/

#include <Bluetooth.h>
#include <Sphero.h>
#include <SabertoothSimplified.h>

Bluetooth bluetooth;
Sphero sphero;
SabertoothSimplified ST;

