Progress with graph-slam engine