Made the waypoint_selector but without a launch file.
Removed an unnecessary subscriber in strategy_planner that used to
subscribe if target has been reached.