path following functionality added
correct start point