Please read the journal version of this paper:
http://robotics.stanford.edu/~mitul/papers/SLC+ar06.pdf