Gyro code updates

Tons of information added and I got the gyro angles working properly.