Update pathfollow.m