37 indices[k] =
index + k;
42 transform->transformPosAndErrors(where, outPoint);
44 errorProp->transformPosAndErrors(where, tmp);
51 double epsilon)
const {
53 derivative(0, 0) =
lin->getCoefficient(1, 0, 0);
60 derivative(1, 0) =
lin->getCoefficient(0, 1, 0);
61 derivative(0, 1) =
lin->getCoefficient(1, 0, 1);
62 derivative(1, 1) =
lin->getCoefficient(0, 1, 1);
68 transform->paramDerivatives(where, &H(0, 0), &H(0, 1));
87 assert((&H(1, 0) - &H(0, 0)) == 1);
91 double epsilon)
const {
94 derivative(0, 0) =
lin->getCoefficient(1, 0, 0);
101 derivative(1, 0) =
lin->getCoefficient(0, 1, 0);
102 derivative(0, 1) =
lin->getCoefficient(1, 0, 1);
103 derivative(1, 1) =
lin->getCoefficient(0, 1, 1);
104 derivative = preDer * derivative;
111 transform->transformPosAndErrors(mid, outPoint);
113 errorProp->transformPosAndErrors(mid, tmp);
114 outPoint.
vx = tmp.
vx;
115 outPoint.
vy = tmp.
vy;
117 transform->paramDerivatives(mid, &H(0, 0), &H(0, 1));
123 transform->transformPosAndErrors(mid, outPoint);
125 errorProp->transformPosAndErrors(mid, tmp);
126 outPoint.
vx = tmp.
vx;
127 outPoint.
vy = tmp.
vy;
135 actualResult = (*fittedPoly) * _centerAndScale;