Added old code for gyro, adjustments needed