float MAX_SPEED = 1.0f;
float RADIUS = 3.0f;

float Distance (vector3 &v1, vector3 &v2)
{
	vector3 v;

	v.x = v2.x - v1.x;
	v.y = v2.y - v1.y;
	v.z = v2.z - v1.z;

	return sqrtf (v.x * v.x + v.y * v.y + v.z * v.z);
}

void Normalize (vector3 &v)
{
	float m = sqrtf (v.x * v.x + v.y * v.y + v.z * v.z);

	if (m)
	{
		m = 1.0f / m;

		v.x *= m;
		v.y *= m;
		v.z *= m;
	}
}


void AI_Update (vector3 &Target, float dTime)
{
	float D = Distance (m_Position, Target);

	if (D <= RADIUS)
		return;

	vector3 Dir;

	Dir.x = Target.x - m_Position.x;
	Dir.y = Target.y - m_Position.y;
	Dir.z = Target.z - m_Position.z;

	Normalize (Dir);
	
	Dir.x *= -1;
	Dir.y *= -1;
	Dir.z *= -1;

	float Length = RADIUS - D;

	float MaxSpeed = MAX_SPEED * dTime;

	if (Length > MaxSpeed)
		Length = MaxSpeed;

	m_Position.x += Dir.x * Length;
	m_Position.y += Dir.y * Length;
	m_Position.z += Dir.z * Length;

	printf ("%f %f %f\n", m_Position.x, m_Position.y, m_Position.z);
}