First iteration of FollowPathAI done

FollowPathAI is not quite where I want it, but this is a start.