More work on the SLAM registration FSM.