Real time mapping and navigation