Adds waypoint plugin and test