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