Worked on FSM code for automatic SLAM registration.