Added  updates made at WPI - and removed I2C gyro code