Float error

Updated gyro compensation code. Had float issue