Originally published in SLAM 149