Moved 'RESET' commands to after IMU burst complete