Unfinished commit. More logic for mapping out junctions and sonar from that but change in representation unfinished. Navigation logic non-existent.