FireJet,
The first thing you need to do is move the Process_Gyro_Data() into the Autonomous_Spin, Disabled_Spin and Teleop_Spin functions. This will allow a Gyro data to be processed all the time, not just during that 26.2 milliseconds loop.
Remember, Get_Gyro_Angle returns a
long value. You need to typecast it to an
int for your printf statement. Something like this.
Code:
tmpangle = int Get_Gyro_Angle();
printf("Gyro Angle %d\n\r", tmpangle);