Autofocus fixed

Turns out the stage sequence was the issue. Now I wipe and reprogram
every time.