Add gyro code untested