Fixed gyro again (last fix actually broke it)

Changed timer reading system, last one did not work (integer division
again).