Fixed overwritten changes and added beginning of timer 4 code to increase gyro query speed