Added gyro code

Needs more work!