  * @return {void}
  */
 void setup() {
-  Serial.begin(115200);
+  Serial.begin(38400);
   while (!Serial);  // Wait for the connection to be established?
 
   // Run MPU initializations
   Serial.println(F("i2cSetup"));
   i2cSetup();
-  Serial.println(F("MPU6050Connect"));
-  MPU6050Connect(0);
-  MPU6050Connect(1);
+  Serial.println(F("MPU6050 Connection Routine"));
+  MPU6050Connect();
   Serial.println(F("Setup complete"));
 
   pinMode(LED_PIN, OUTPUT);


// Standard included arduino servo library
#include "Servo.h"

// Initialize gyro instance
// TODO:  Update this to initialize two gyros with +VDC/Ground arguments
MPU6050 mpuStatic(0x68);
MPU6050 mpuDynam(0x69);

// Initialize servo instances
Servo yawServo;
Servo pitchServo;


// Comment to turn off Serial printing
#define DEBUG  

  yawServo.attach(9);
  pitchServo.attach(10);

  // Center the servo start positions
  yawServo.write(90);
  pitchServo.write(90);
}
