IMU tested, Sync step added