float A1[] = {0,0,-5}; float B1[] = {0,0, 5}; float B2[] = {0,0,0}; float v = 1000000; for(int i=0; i<1; i++){ B2[0] = 15*cos(2*PI*i/5); B2[1] = 15*sin(2*PI*i/5); double d = distanceToTriangle(A1,B1,B2,x); v = min(sqrt(d), v); } return 5.0 - v;