Use offset error directly instead of omega from gyro directly.