|
@@ -46,23 +46,23 @@ int finish_incremental_LSF(struct linear_fit_data *lsf) {
|
46
|
46
|
if (N == 0.0)
|
47
|
47
|
return 1;
|
48
|
48
|
|
49
|
|
- lsf->xbar /= N;
|
50
|
|
- lsf->ybar /= N;
|
51
|
|
- lsf->zbar /= N;
|
52
|
|
- lsf->x2bar = lsf->x2bar / N - sq(lsf->xbar);
|
53
|
|
- lsf->y2bar = lsf->y2bar / N - sq(lsf->ybar);
|
54
|
|
- lsf->z2bar = lsf->z2bar / N - sq(lsf->zbar);
|
55
|
|
- lsf->xybar = lsf->xybar / N - lsf->xbar * lsf->ybar;
|
56
|
|
- lsf->yzbar = lsf->yzbar / N - lsf->ybar * lsf->zbar;
|
57
|
|
- lsf->xzbar = lsf->xzbar / N - lsf->xbar * lsf->zbar;
|
58
|
|
- const float DD = lsf->x2bar * lsf->y2bar - sq(lsf->xybar);
|
|
49
|
+ const float RN = 1.0f / N,
|
|
50
|
+ xbar = lsf->xbar * RN,
|
|
51
|
+ ybar = lsf->ybar * RN,
|
|
52
|
+ zbar = lsf->zbar * RN,
|
|
53
|
+ x2bar = lsf->x2bar * RN - sq(xbar),
|
|
54
|
+ y2bar = lsf->y2bar * RN - sq(ybar),
|
|
55
|
+ xybar = lsf->xybar * RN - xbar * ybar,
|
|
56
|
+ yzbar = lsf->yzbar * RN - ybar * zbar,
|
|
57
|
+ xzbar = lsf->xzbar * RN - xbar * zbar,
|
|
58
|
+ DD = x2bar * y2bar - sq(xybar);
|
59
|
59
|
|
60
|
60
|
if (ABS(DD) <= 1e-10 * (lsf->max_absx + lsf->max_absy))
|
61
|
61
|
return 1;
|
62
|
62
|
|
63
|
|
- lsf->A = (lsf->yzbar * lsf->xybar - lsf->xzbar * lsf->y2bar) / DD;
|
64
|
|
- lsf->B = (lsf->xzbar * lsf->xybar - lsf->yzbar * lsf->x2bar) / DD;
|
65
|
|
- lsf->D = -(lsf->zbar + lsf->A * lsf->xbar + lsf->B * lsf->ybar);
|
|
63
|
+ lsf->A = (yzbar * xybar - xzbar * y2bar) / DD;
|
|
64
|
+ lsf->B = (xzbar * xybar - yzbar * x2bar) / DD;
|
|
65
|
+ lsf->D = -(zbar + lsf->A * xbar + lsf->B * ybar);
|
66
|
66
|
return 0;
|
67
|
67
|
}
|
68
|
68
|
|