ich hab keinen eigenen um es so auszudrücken.
http://www.itee.uq.edu.au/~milford/Mapping/Mapping.html
oder die camera als maussensor verwenden dadurch die odometrie machen und das bild für die karte nutzen. verbunden mit einen radar system ir oder ultraschall sollte da was vernünftiges rauskommen.