Powerful SLAM engine and debug suite