Fixed bugged out guys, added code for pathfollowing