Added route menu and ability to add waypoints