Fixed many little bugs with the GUI. Fixed the trajectory bug (get-wpb was at fault). Fixed the SBA* variants to disable the use of goal_vertex if not valid.