Addedd option to remove Waypoints visualization

Added option display_wpt: bool to choose remove the waypoints visualization