Cool path finding system but sometimes it does still pass through walls