Implement the gyro coordinate transformation code for gyro intergrate (b-frame -> i-frame)