Added OI functions

Also changed the gyro sensitivity function