Made it so if the gyro fails then we dont use it
Fixed gyro(I think)
Merge pull request #177 from PJTNT11/master

sync up
Merge pull request #15 from pstephen43/master

sync up