double ret = 0;
for (int i = 0; i < x.size(); i++) {
ret +=
- pow (pow (p2 * (x[i][2] - z0) - p3 * (x[i][1] - y0), 2) +
+ std::sqrt(pow (p2 * (x[i][2] - z0) - p3 * (x[i][1] - y0), 2) +
pow (p3 * (x[i][0] - x0) - p1 * (x[i][2] - z0), 2) +
- pow (p1 * (x[i][1] - y0) - p2 * (x[i][0] - x0), 2), 0.5) /
- pow (p1 * p1 + p2 * p2 + p3 * p3, 0.5);
+ pow (p1 * (x[i][1] - y0) - p2 * (x[i][0] - x0), 2)) /
+ std::sqrt(p1 * p1 + p2 * p2 + p3 * p3);
}
return ret;
}