Calibrated gyro and added quick complementary filter to imu.