Added selector in NavigationStation
Started work on maneuver framework
Got a basic test case of course planning working.