Linefollow update

Final version of the code before testing starts.