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