Initial rough implementation of node based navigation