fix errors

diff --git a/src/org/usfirst/frc/team3501/robot/Robot.java b/src/org/usfirst/frc/team3501/robot/Robot.java
index b03afeb48b1c709fbfa2b6c95ff065e44683dec7..e852b752a1a71246717d909a859ca92f9de28d2e 100644 (file)
--- a/src/org/usfirst/frc/team3501/robot/Robot.java
+++ b/src/org/usfirst/frc/team3501/robot/Robot.java
@@ -36,6 +36,7 @@ public class Robot extends IterativeRobot {
 
   @Override
   public void autonomousInit() {
+
   }
 
   @Override

diff --git a/src/org/usfirst/frc/team3501/robot/utils/BNO055.java b/src/org/usfirst/frc/team3501/robot/utils/BNO055.java
index b6640fed99571c98db0e88f5dcb3bde641035327..f6aadcdc3bb2d55743711d8ba9d65e3f278c0574 100644 (file)
--- a/src/org/usfirst/frc/team3501/robot/utils/BNO055.java
+++ b/src/org/usfirst/frc/team3501/robot/utils/BNO055.java
@@ -339,10 +339,12 @@ public class BNO055 {
    */
   public static BNO055 getInstance(opmode_t mode, vector_type_t vectorType,
       I2C.Port port, byte address) {
+
     if (instance == null) {
-      System.out.println("gyro called");
+
       instance = new BNO055(port, address);
     }
+
     requestedMode = mode;
     requestedVectorType = vectorType;
     return instance;
@@ -377,7 +379,6 @@ public class BNO055 {
       // blocking manner. This sequence of events follows the process
       // defined in the original adafruit source as closely as possible.
       // XXX: It's likely some of these delays can be optimized out.
-      System.out.println("State: " + state);
       switch (state) {
       case 0:
         // Wait for the sensor to be present
@@ -450,6 +451,7 @@ public class BNO055 {
         break;
       case 8:
         if (currentTime >= nextTime) {
+
           nextTime = Timer.getFPGATimestamp() + 1.05;
           state++;
         }
@@ -760,6 +762,7 @@ public class BNO055 {
    */
   public double getHeading() {
     double reading = (xyz[0] + turns * 360);
+
     if (zeroReferenceConst == 0)
       return (xyz[0] + turns * 360);