added waypoint system and proper path finding