Basic Route and RoutePlanner classes

Set up basic classes with simple route finding algorithm