15 unsigned int N = dcs.size();
25 for (
unsigned int i = 0;
i <
N; ++
i) {
34 double S{0}, Sz{0}, Sy{0};
37 std::vector<FitData>
data;
40 for (
const DCOnTrack&
it : dcs) {
44 datum.r = std::abs(
it.r());
49 Sz += datum.w * datum.z;
50 Sy += datum.w * datum.y;
52 data.push_back(std::move(datum));
63 double Syy{0}, Szy{0}, Syyzz{0};
65 for (
unsigned int i = 0;
i <
N; ++
i) {
66 FitData& datum =
data[
i];
74 datum.rw = datum.r * datum.w;
75 datum.ryw = datum.rw * datum.y;
76 datum.rzw = datum.rw * datum.z;
78 Syy += datum.y * datum.y * datum.w;
79 Szy += datum.y * datum.z * datum.w;
80 Syyzz += (datum.y - datum.z) * (datum.y + datum.z) * datum.w;
83 unsigned int count{0};
84 double R{0}, Ry{0}, Rz{0}, Att{0}, Add{
S}, Bt{0}, Bd{0}, Stt{0}, Sd{0};
93 }
else if (
sc.sn == 0.0 &&
sc.cs < 0.0) {
98 double d =
line.y0() +
sc.apply (Zc, -Yc);
100 while (
count < 100) {
103 for (
unsigned int i = 0;
i <
N; ++
i) {
107 FitData& datum =
data[
i];
109 double dist =
sc.apply (-datum.z, datum.y);;
120 Att = Syy +
sc.cs * (2 *
sc.sn * Szy -
sc.cs * Syyzz);
121 Bt = -Szy +
sc.cs * (
sc.sn * Syyzz + 2 *
sc.cs * Szy + Rz) +
sc.sn * Ry;
124 if (
data.capacity() > 100) {
126 result.dcs().reserve(100);
136 sc.sn = std::abs(
sc.sn);
138 if (std::abs(Bt / Att) < 0.001 && std::abs(Bd / Add) < 0.001) {
139 Stt = std::sqrt(1 / Att);
140 Sd = std::sqrt(1 / Add);
150 double yl{0},
chi2{0};
156 result.clusters().clear();
157 result.emptyTubes().clear();
159 unsigned int nhits{0};
163 for (
unsigned int i = 0;
i <
N; ++
i) {
164 FitData& datum =
data[
i];
165 yl =
sc.apply (-datum.z, datum.y) -
d;
166 double dth = -
sc.apply (datum.y, datum.z) * Stt;
167 double errorResiduals = std::hypot(dth, Sd);
168 double residuals = std::abs(yl) - datum.r;
171 chi2 += residuals * residuals * datum.w;
173 result.dcs().emplace_back(dcs[
i]);
174 result.dcs().back().residual(residuals);
175 result.dcs().back().errorTrack(errorResiduals);
179 result.line().set(LocVec2D(Zc -
sc.sn *
d, Yc +
sc.cs *
d), theta);