implemented add waypoints in GUI + bug fixes