TRL SLAM--A full-nelson slam