Modified topological so that it is possible to add nodes to map read from bag

Still need to implement functionality to do node merging etc.