gistfile1.cpp

void Path::Follow(AI &ai){

	float nx, ny;

	if (!ai.casual && index < nodeList.size() && index < 4){
		auto node = (int)nodeList[index];
		ny = node / solver->mapWidth;
		nx = node - ny * solver->mapWidth;

		nx *= PATH_DIVISOR;
		ny *= PATH_DIVISOR;
	}else{
		ai.casual = true;
		nx = target.x;
		ny = target.y;
	}

	float dx = nx - ai.pos.x;
	float dy = ny - ai.pos.y;

	auto attack = atan2(dy, dx);

	ai.vel.x = cos(attack) * ai.speed;
	ai.vel.y = sin(attack) * ai.speed;

	if (std::abs(dx) < 1.0 && std::abs(dy) < 1.0){
		ai.vel.x = 0.0; ai.vel.y = 0.0;
		if (!ai.casual){
			ai.pos.x = nx;  ai.pos.y = ny;
			index++;
		}
	}
}