Modified radial plan to account for the filter function in libnabo, and
selecting points only on one side of the trajectory.

Adapted TaskFollowShoreRP accordinly