Localize the buggy: with up to .5 meters of error

It is ok if it this is done off line but it should be easy to port to an online system