Path following scripts

Scripts for path following