18#ifndef GPUCA_GPUCODE_DEVICE
22#ifndef GPUCA_ALIGPUCODE
23#include <fmt/printf.h>
31template <
typename value_T>
46template <
typename value_T>
53 if (gpu::CAMath::Abs(dx) < constants::math::Almost0) {
56 value_t crv = this->getCurvature(bz);
59 if ((gpu::CAMath::Abs(
f1) > constants::math::Almost1) || (gpu::CAMath::Abs(
f2) > constants::math::Almost1)) {
62 value_t r1 = gpu::CAMath::Sqrt((1.f -
f1) * (1.f +
f1));
63 if (gpu::CAMath::Abs(r1) < constants::math::Almost0) {
66 value_t r2 = gpu::CAMath::Sqrt((1.f -
f2) * (1.f +
f2));
67 if (gpu::CAMath::Abs(r2) < constants::math::Almost0) {
70 double r1pr2Inv = 1. / (r1 + r2);
71 double dy2dx = (
f1 +
f2) * r1pr2Inv;
72 bool arcz = gpu::CAMath::Abs(x2r) > 0.05f;
83 auto arg = r1 *
f2 - r2 *
f1;
84 if (gpu::CAMath::Abs(arg) > constants::math::Almost1) {
87 value_t rot = gpu::CAMath::ASin(arg);
90 rot = constants::math::PI - rot;
92 rot = -constants::math::PI - rot;
95 dP[
kZ] = this->getTgl() / crv * rot;
97 dP[
kZ] = dx * (r2 +
f2 * dy2dx) * this->getTgl();
103 this->updateParams(dP);
112 double r2inv = 1. / r2, r1inv = 1. / r1;
113 double dx2r1pr2 = dx * r1pr2Inv;
115 double hh = dx2r1pr2 * r2inv * (1. + r1 * r2 +
f1 *
f2), jj = dx * (dy2dx -
f2 * r2inv);
116 double f02 = hh * r1inv;
117 double f04 = hh * dx2r1pr2 * kb;
118 double f24 = dx * kb;
119 double f12 = this->getTgl() * (f02 *
f2 + jj);
120 double f13 = dx * (r2 +
f2 * dy2dx);
121 double f14 = this->getTgl() * (f04 *
f2 + jj * f24);
124 double b00 = f02 * c20 + f04 * c40, b01 = f12 * c20 + f14 * c40 + f13 * c30;
125 double b02 = f24 * c40;
126 double b10 = f02 * c21 + f04 * c41, b11 = f12 * c21 + f14 * c41 + f13 * c31;
127 double b12 = f24 * c41;
128 double b20 = f02 * c22 + f04 * c42, b21 = f12 * c22 + f14 * c42 + f13 * c32;
129 double b22 = f24 * c42;
130 double b40 = f02 * c42 + f04 * c44, b41 = f12 * c42 + f14 * c44 + f13 * c43;
131 double b42 = f24 * c44;
132 double b30 = f02 * c32 + f04 * c43, b31 = f12 * c32 + f14 * c43 + f13 * c33;
133 double b32 = f24 * c43;
136 double a00 = f02 * b20 + f04 * b40, a01 = f02 * b21 + f04 * b41, a02 = f02 * b22 + f04 * b42;
137 double a11 = f12 * b21 + f14 * b41 + f13 * b31, a12 = f12 * b22 + f14 * b42 + f13 * b32;
138 double a22 = f24 * b42;
141 c00 += b00 + b00 + a00;
142 c10 += b10 + b01 + a01;
143 c20 += b20 + b02 + a02;
146 c11 += b11 + b11 + a11;
147 c21 += b21 + b12 + a12;
150 c22 += b22 + b22 + a22;
160template <
typename value_T>
166 if (this->getAbsCharge() == 0) {
170 if (gpu::CAMath::Abs(dx) < constants::math::Almost0) {
177 if (!linRef1.propagateTo(xk, bz)) {
182 double snpRef0 = linRef0.getSnp(), cspRef0 = gpu::CAMath::Sqrt((1 - snpRef0) * (1 + snpRef0));
183 double snpRef1 = linRef1.getSnp(), cspRef1 = gpu::CAMath::Sqrt((1 - snpRef1) * (1 + snpRef1));
184 double cspRef0Inv = 1 / cspRef0, cspRef1Inv = 1 / cspRef1,
cc = cspRef0 + cspRef1, ccInv = 1 /
cc, dy2dx = (snpRef0 + snpRef1) * ccInv;
185 double dxccInv = dx * ccInv, hh = dxccInv * cspRef1Inv * (1 + cspRef0 * cspRef1 + snpRef0 * snpRef1), jj = dx * (dy2dx - snpRef1 * cspRef1Inv);
187 double f02 = hh * cspRef0Inv;
188 double f04 = hh * dxccInv * kb;
189 double f24 = dx * kb;
190 double f12 = linRef0.getTgl() * (f02 * snpRef1 + jj);
191 double f13 = dx * (cspRef1 + snpRef1 * dy2dx);
192 double f14 = linRef0.getTgl() * (f04 * snpRef1 + jj * f24);
196 for (
int i = 0;
i < 5;
i++) {
197 diff[
i] = this->getParam(
i) - linRef0.getParam(
i);
200 if (gpu::CAMath::Abs(snpUpd) > constants::math::Almost1) {
205 this->setY(linRef1.getY() + diff[
kY] + f02 * diff[
kSnp] + f04 * diff[
kQ2Pt]);
206 this->setZ(linRef1.getZ() + diff[
kZ] + f13 * diff[
kTgl] + f14 * diff[
kQ2Pt]);
207 this->setSnp(snpUpd);
208 this->setTgl(linRef1.getTgl() + diff[
kTgl]);
209 this->setQ2Pt(linRef1.getQ2Pt() + diff[
kQ2Pt]);
217 double b00 = f02 * c20 + f04 * c40, b01 = f12 * c20 + f14 * c40 + f13 * c30;
218 double b02 = f24 * c40;
219 double b10 = f02 * c21 + f04 * c41, b11 = f12 * c21 + f14 * c41 + f13 * c31;
220 double b12 = f24 * c41;
221 double b20 = f02 * c22 + f04 * c42, b21 = f12 * c22 + f14 * c42 + f13 * c32;
222 double b22 = f24 * c42;
223 double b40 = f02 * c42 + f04 * c44, b41 = f12 * c42 + f14 * c44 + f13 * c43;
224 double b42 = f24 * c44;
225 double b30 = f02 * c32 + f04 * c43, b31 = f12 * c32 + f14 * c43 + f13 * c33;
226 double b32 = f24 * c43;
229 double a00 = f02 * b20 + f04 * b40, a01 = f02 * b21 + f04 * b41, a02 = f02 * b22 + f04 * b42;
230 double a11 = f12 * b21 + f14 * b41 + f13 * b31, a12 = f12 * b22 + f14 * b42 + f13 * b32;
231 double a22 = f24 * b42;
234 c00 += b00 + b00 + a00;
235 c10 += b10 + b01 + a01;
236 c20 += b20 + b02 + a02;
239 c11 += b11 + b11 + a11;
240 c21 += b21 + b12 + a12;
243 c22 += b22 + b22 + a22;
253template <
typename value_T>
261template <
typename value_T>
265 if (gpu::CAMath::Abs(this->getSnp()) > constants::math::Almost1) {
266 LOGP(
debug,
"Precondition is not satisfied: |sin(phi)|>1 ! {:f}", this->getSnp());
270 math_utils::detail::bringToPMPi<value_t>(
alpha);
273 math_utils::detail::sincos(
alpha - this->getAlpha(), sa, ca);
274 value_t snp = this->getSnp(), csp = gpu::CAMath::Sqrt((1.f - snp) * (1.f + snp));
277 if ((csp * ca + snp * sa) < 0) {
283 value_t updSnp = snp * ca - csp * sa;
284 if (gpu::CAMath::Abs(updSnp) > constants::math::Almost1) {
285 LOGP(
debug,
"Rotation failed: new snp {:.2f}", updSnp);
289 this->setAlpha(
alpha);
290 this->setX(xold * ca + yold * sa);
291 this->setY(-xold * sa + yold * ca);
292 this->setSnp(updSnp);
294 if (gpu::CAMath::Abs(csp) < constants::math::Almost0) {
295 LOGP(
debug,
"Too small cosine value {:f}", csp);
296 csp = constants::math::Almost0;
299 value_t rr = (ca + snp / csp * sa);
316template <
typename value_T>
321 if (gpu::CAMath::Abs(this->getSnp()) > constants::math::Almost1) {
322 LOGP(
debug,
"Precondition is not satisfied: |sin(phi)|>1 ! {:f}", this->getSnp());
326 math_utils::detail::bringToPMPi<value_t>(
alpha);
331 if (!linRef1.rotateParam(
alpha, ca, sa)) {
336 if (!linRef1.propagateParamTo(trackX, bz)) {
341 value_t snp = this->getSnp(), csp = gpu::CAMath::Sqrt((1.f - snp) * (1.f + snp)), updSnp = snp * ca - csp * sa;
342 if ((csp * ca + snp * sa) < 0 || gpu::CAMath::Abs(updSnp) > constants::math::Almost1) {
346 this->setY(-sa * this->
getX() + ca * this->
getY());
348 this->setSnp(updSnp);
349 this->setAlpha(
alpha);
352 value_t snpRef0 = linRef0.getSnp(), cspRef0 = gpu::CAMath::Sqrt((
value_t(1) - snpRef0) * (
value_t(1) + snpRef0));
353 value_t snpRef1 = linRef1.getSnp(), cspRef1 = ca * cspRef0 + sa * snpRef0;
354 value_t rr = cspRef1 / cspRef0;
376 auto cspRef1Inv =
value_t(1) / cspRef1;
377 auto j3 = -snpRef1 * cspRef1Inv;
378 auto j4 = -linRef1.getTgl() * cspRef1Inv;
379 auto j5 = linRef1.getCurvature(bz);
386 auto hXSigY = cXSigY + cSigX2 * j3;
387 auto hXSigZ = cXSigZ + cSigX2 * j4;
388 auto hXSigSnp = cXSigSnp + cSigX2 * j5;
390 mC[
kSigY2] += j3 * (cXSigY + hXSigY);
391 mC[
kSigZ2] += j4 * (cXSigZ + hXSigZ);
392 mC[
kSigSnpY] += cXSigSnp * j3 + hXSigY * j5;
393 mC[
kSigSnp2] += j5 * (cXSigSnp + hXSigSnp);
398 mC[
kSigZY] += cXSigZ * j3 + hXSigY * j4;
399 mC[
kSigSnpZ] += cXSigSnp * j4 + hXSigZ * j5;
411template <
typename value_T>
415 value_t sn, cs, alp = this->getAlpha();
416 o2::math_utils::detail::sincos(alp, sn, cs);
417 value_t x = this->
getX(),
y = this->
getY(), snp = this->getSnp(), csp = gpu::CAMath::Sqrt((1.f - snp) * (1.f + snp));
418 value_t xv = vtx.getX() * cs + vtx.getY() * sn, yv = -vtx.getX() * sn + vtx.getY() * cs, zv = vtx.getZ();
422 value_t d = gpu::CAMath::Abs(
x * snp -
y * csp);
430 value_t crv = this->getCurvature(
b);
431 value_t tgfv = -(crv *
x - snp) / (crv *
y + csp);
432 sn = tgfv / gpu::CAMath::Sqrt(1.f + tgfv * tgfv);
433 cs = gpu::CAMath::Sqrt((1.f - sn) * (1.f + sn));
434 cs = (gpu::CAMath::Abs(tgfv) > constants::math::Almost0) ? sn / tgfv : constants::math::
Almost1;
436 x = xv * cs + yv * sn;
437 yv = -xv * sn + yv * cs;
441 alp += gpu::CAMath::ASin(sn);
442 if (!tmpT.rotate(alp) || !tmpT.propagateTo(xv,
b)) {
443#if !defined(GPUCA_ALIGPUCODE)
444 LOG(
debug) <<
"failed to propagate to alpha=" << alp <<
" X=" << xv << vtx <<
" | Track is: " << tmpT.asString();
454 o2::math_utils::detail::sincos(alp, sn, cs);
455 auto s2ylocvtx = vtx.getSigmaX2() * sn * sn + vtx.getSigmaY2() * cs * cs - 2. * vtx.getSigmaXY() * cs * sn;
456 dca->set(this->
getY() - yv, this->getZ() - zv, getSigmaY2() + s2ylocvtx, getSigmaZY(), getSigmaZ2() + vtx.getSigmaZ2());
462template <
typename value_T>
467 set(xyz, pxpypz, cv,
charge, sectorAlpha,
pid);
471template <
typename value_T>
484 value_t radPos2 = xyz[0] * xyz[0] + xyz[1] * xyz[1];
486 if (sectorAlpha || radPos2 < 1) {
487 alp = gpu::CAMath::ATan2(pxpypz[1], pxpypz[0]);
489 alp = gpu::CAMath::ATan2(xyz[1], xyz[0]);
492 alp = math_utils::detail::angle2Alpha<value_t>(alp);
496 math_utils::detail::sincos(alp, sn, cs);
498 if (cs * pxpypz[0] + sn * pxpypz[1] < 0) {
499 LOG(
debug) <<
"alpha from phiPos() will invalidate this track parameters, overriding to alpha from phi()";
500 alp = gpu::CAMath::ATan2(pxpypz[1], pxpypz[0]);
502 alp = math_utils::detail::angle2Alpha<value_t>(alp);
504 math_utils::detail::sincos(alp, sn, cs);
507 if (gpu::CAMath::Abs(sn) < 2.f *
kSafe) {
509 alp += alp < constants::math::PIHalf ? 2.f *
kSafe : -2.f *
kSafe;
511 alp += alp > -constants::math::PIHalf ? -2.f *
kSafe : 2.f *
kSafe;
513 math_utils::detail::sincos(alp, sn, cs);
514 }
else if (gpu::CAMath::Abs(cs) < 2.f *
kSafe) {
516 alp += alp > constants::math::PIHalf ? 2.f *
kSafe : -2.f *
kSafe;
518 alp += alp > -constants::math::PIHalf ? 2.f *
kSafe : -2.f *
kSafe;
520 math_utils::detail::sincos(alp, sn, cs);
523 dim3_t ver{xyz[0], xyz[1], xyz[2]};
524 dim3_t mom{pxpypz[0], pxpypz[1], pxpypz[2]};
527 math_utils::detail::rotateZ<value_t>(ver, -alp);
528 math_utils::detail::rotateZ<value_t>(mom, -alp);
530 const value_t pt2 = mom[0] * mom[0] + mom[1] * mom[1];
531 const value_t pt = gpu::CAMath::Sqrt(pt2);
537 this->setSnp(mom[1] * ptI);
538 this->setTgl(mom[2] * ptI);
539 this->setAbsCharge(gpu::CAMath::Abs(
charge));
543 if (gpu::CAMath::Abs(1.f - this->getSnp()) <
kSafe) {
544 this->setSnp(1.f -
kSafe);
545 }
else if (gpu::CAMath::Abs(-1.f - this->getSnp()) <
kSafe) {
546 this->setSnp(-1.f +
kSafe);
551 const value_t pt3I = ptI / pt2;
556 for (
int i = 0;
i < 6; ++
i) {
557 for (
int j = 0;
j <=
i; ++
j) {
558 cLab[
i][
j] = cLab[
j][
i] = cv[
idx++];
570 const value_t dSnpDu = -u *
v * pt3I;
571 const value_t dSnpDv = u * u * pt3I;
572 const value_t dTglDu = -
w * u * pt3I;
575 const value_t dQ2PtDu = -qeff * u * pt3I;
576 const value_t dQ2PtDv = -qeff *
v * pt3I;
578 jac[
kSnp][3] = dSnpDu * cs - dSnpDv * sn;
579 jac[
kSnp][4] = dSnpDu * sn + dSnpDv * cs;
580 jac[
kTgl][3] = dTglDu * cs - dTglDv * sn;
581 jac[
kTgl][4] = dTglDu * sn + dTglDv * cs;
582 jac[
kTgl][5] = dTglDw;
583 jac[
kQ2Pt][3] = dQ2PtDu * cs - dQ2PtDv * sn;
584 jac[
kQ2Pt][4] = dQ2PtDu * sn + dQ2PtDv * cs;
587 for (
int j = 0;
j <=
i; ++
j) {
589 for (
int k = 0; k < 6; ++k) {
590 for (
int l = 0; l < 6; ++l) {
591 cij += jac[
i][k] * cLab[k][l] * jac[
j][l];
594 mC[CovarMap[
i][
j]] = cij;
601template <
typename value_T>
612 if (gpu::CAMath::Abs(dx) < constants::math::Almost0) {
616 if (gpu::CAMath::Abs(dx) > 1e5 || gpu::CAMath::Abs(this->
getY()) > 1e5 || gpu::CAMath::Abs(this->getZ()) > 1e5) {
617 LOG(warning) <<
"Anomalous track, target X:" << xk;
621 value_t crv = (gpu::CAMath::Abs(
b[2]) < constants::math::Almost0) ? 0.f :
this->getCurvature(
b[2]);
622 if (gpu::CAMath::Abs(crv) < constants::math::Almost0) {
623 return propagateTo(xk, 0.);
627 if ((gpu::CAMath::Abs(
f1) > constants::math::Almost1) || (gpu::CAMath::Abs(
f2) > constants::math::Almost1)) {
630 value_t r1 = gpu::CAMath::Sqrt((1.f -
f1) * (1.f +
f1));
631 if (gpu::CAMath::Abs(r1) < constants::math::Almost0) {
634 value_t r2 = gpu::CAMath::Sqrt((1.f -
f2) * (1.f +
f2));
635 if (gpu::CAMath::Abs(r2) < constants::math::Almost0) {
638 double r1pr2Inv = 1. / (r1 + r2), r2inv = 1. / r2, r1inv = 1. / r1;
639 double dy2dx = (
f1 +
f2) * r1pr2Inv, dx2r1pr2 = dx * r1pr2Inv;
640 value_t step = (gpu::CAMath::Abs(x2r) < 0.05f) ? dx * gpu::CAMath::Abs(r2 +
f2 * dy2dx)
641 : 2.f * gpu::CAMath::ASin(0.5f * dx * gpu::CAMath::Sqrt(1.f + dy2dx * dy2dx) * crv) / crv;
642 step *= gpu::CAMath::Sqrt(1.f + this->getTgl() * this->getTgl());
645 std::array<value_t, 9> vecLab{0.f};
646 if (!this->getPosDirGlo(vecLab)) {
657 value_t kb =
b[2] * constants::math::B2C;
658 double hh = dx2r1pr2 * r2inv * (1. + r1 * r2 +
f1 *
f2), jj = dx * (dy2dx -
f2 * r2inv);
659 double f02 = hh * r1inv;
660 double f04 = hh * dx2r1pr2 * kb;
661 double f24 = dx * kb;
662 double f12 = this->getTgl() * (f02 *
f2 + jj);
663 double f13 = dx * (r2 +
f2 * dy2dx);
664 double f14 = this->getTgl() * (f04 *
f2 + jj * f24);
667 double b00 = f02 * c20 + f04 * c40, b01 = f12 * c20 + f14 * c40 + f13 * c30;
668 double b02 = f24 * c40;
669 double b10 = f02 * c21 + f04 * c41, b11 = f12 * c21 + f14 * c41 + f13 * c31;
670 double b12 = f24 * c41;
671 double b20 = f02 * c22 + f04 * c42, b21 = f12 * c22 + f14 * c42 + f13 * c32;
672 double b22 = f24 * c42;
673 double b40 = f02 * c42 + f04 * c44, b41 = f12 * c42 + f14 * c44 + f13 * c43;
674 double b42 = f24 * c44;
675 double b30 = f02 * c32 + f04 * c43, b31 = f12 * c32 + f14 * c43 + f13 * c33;
676 double b32 = f24 * c43;
679 double a00 = f02 * b20 + f04 * b40, a01 = f02 * b21 + f04 * b41, a02 = f02 * b22 + f04 * b42;
680 double a11 = f12 * b21 + f14 * b41 + f13 * b31, a12 = f12 * b22 + f14 * b42 + f13 * b32;
681 double a22 = f24 * b42;
684 c00 += b00 + b00 + a00;
685 c10 += b10 + b01 + a01;
686 c20 += b20 + b02 + a02;
689 c11 += b11 + b11 + a11;
690 c21 += b21 + b12 + a12;
693 c22 += b22 + b22 + a22;
701 value_t bt = gpu::CAMath::Sqrt(bxy2);
702 value_t cosphi = 1.f, sinphi = 0.f;
703 if (bt > constants::math::Almost0) {
707 value_t bb = gpu::CAMath::Sqrt(bxy2 +
b[2] *
b[2]);
708 value_t costet = 1., sintet = 0.;
709 if (
bb > constants::math::Almost0) {
713 std::array<value_t, 7>
vect{costet * cosphi * vecLab[0] + costet * sinphi * vecLab[1] - sintet * vecLab[2],
714 -sinphi * vecLab[0] + cosphi * vecLab[1],
715 sintet * cosphi * vecLab[0] + sintet * sinphi * vecLab[1] + costet * vecLab[2],
716 costet * cosphi * vecLab[3] + costet * sinphi * vecLab[4] - sintet * vecLab[5],
717 -sinphi * vecLab[3] + cosphi * vecLab[4],
718 sintet * cosphi * vecLab[3] + sintet * sinphi * vecLab[4] + costet * vecLab[5],
726 vecLab[0] = cosphi * costet *
vect[0] - sinphi *
vect[1] + cosphi * sintet *
vect[2];
727 vecLab[1] = sinphi * costet *
vect[0] + cosphi *
vect[1] + sinphi * sintet *
vect[2];
728 vecLab[2] = -sintet *
vect[0] + costet *
vect[2];
730 vecLab[3] = cosphi * costet *
vect[3] - sinphi *
vect[4] + cosphi * sintet *
vect[5];
731 vecLab[4] = sinphi * costet *
vect[3] + cosphi *
vect[4] + sinphi * sintet *
vect[5];
732 vecLab[5] = -sintet *
vect[3] + costet *
vect[5];
735 value_t sinalp = -vecLab[7], cosalp = vecLab[8];
736 value_t t = cosalp * vecLab[0] - sinalp * vecLab[1];
737 vecLab[1] = sinalp * vecLab[0] + cosalp * vecLab[1];
739 t = cosalp * vecLab[3] - sinalp * vecLab[4];
740 vecLab[4] = sinalp * vecLab[3] + cosalp * vecLab[4];
744 value_t x = vecLab[0],
y = vecLab[1],
z = vecLab[2];
745 if (gpu::CAMath::Abs(
x - xk) > constants::math::Almost0) {
746 if (gpu::CAMath::Abs(vecLab[3]) < constants::math::Almost0) {
749 auto dxFin = xk - vecLab[0];
751 y += vecLab[4] / vecLab[3] * dxFin;
752 z += vecLab[5] / vecLab[3] * dxFin;
756 t = 1.f / gpu::CAMath::Sqrt(vecLab[3] * vecLab[3] + vecLab[4] * vecLab[4]);
760 this->setSnp(vecLab[4] * t);
761 this->setTgl(vecLab[5] * t);
762 this->setQ2Pt(q * t / vecLab[6]);
768template <
typename value_T>
779 if (gpu::CAMath::Abs(dx) < constants::math::Almost0) {
783 if (gpu::CAMath::Abs(dx) > 1e5 || gpu::CAMath::Abs(this->
getY()) > 1e5 || gpu::CAMath::Abs(this->getZ()) > 1e5) {
784 LOG(warning) <<
"Anomalous track, target X:" << xk;
788 if (gpu::CAMath::Abs(dx) < constants::math::Almost0) {
794 value_t crv = (gpu::CAMath::Abs(
b[2]) < constants::math::Almost0) ? 0.f : linRef0.getCurvature(
b[2]);
795 if (gpu::CAMath::Abs(crv) < constants::math::Almost0) {
796 return propagateTo(xk, linRef0, 0.);
798 value_t kb =
b[2] * constants::math::B2C, x2r = crv * dx;
800 value_t snpRef0 = linRef0.getSnp(), snpRef1 = snpRef0 + x2r;
801 if ((gpu::CAMath::Abs(snpRef0) > constants::math::Almost1) || (gpu::CAMath::Abs(snpRef1) > constants::math::Almost1)) {
804 value_t cspRef0 = gpu::CAMath::Sqrt((1 - snpRef0) * (1 + snpRef0)), cspRef1 = gpu::CAMath::Sqrt((1 - snpRef1) * (1 + snpRef1));
805 if (gpu::CAMath::Abs(cspRef0) < constants::math::Almost0 || gpu::CAMath::Abs(cspRef1) < constants::math::Almost0) {
808 value_t cspRef0Inv =
value_t(1) / cspRef0, cspRef1Inv =
value_t(1) / cspRef1,
cc = cspRef0 + cspRef1, ccInv =
value_t(1) /
cc, dy2dx = (snpRef0 + snpRef1) * ccInv;
809 value_t step = (gpu::CAMath::Abs(crv * dx) < 0.05f) ? dx * (cspRef1 + snpRef1 * dy2dx) : 2. * gpu::CAMath::ASin(0.5 * dx * gpu::CAMath::Sqrt(1.f + dy2dx * dy2dx) * crv) / crv;
810 step *= gpu::CAMath::Sqrt(1.f + linRef0.getTgl() * linRef0.getTgl());
814 std::array<value_t, 9> vecLab{0.f};
815 if (!linRef0.getPosDirGlo(vecLab)) {
821 value_t bt = gpu::CAMath::Sqrt(bxy2);
822 value_t cosphi = 1.f, sinphi = 0.f;
823 if (bt > constants::math::Almost0) {
827 value_t bb = gpu::CAMath::Sqrt(bxy2 +
b[2] *
b[2]);
828 value_t costet = 1., sintet = 0.;
829 if (
bb > constants::math::Almost0) {
833 std::array<value_t, 7>
vect{costet * cosphi * vecLab[0] + costet * sinphi * vecLab[1] - sintet * vecLab[2],
834 -sinphi * vecLab[0] + cosphi * vecLab[1],
835 sintet * cosphi * vecLab[0] + sintet * sinphi * vecLab[1] + costet * vecLab[2],
836 costet * cosphi * vecLab[3] + costet * sinphi * vecLab[4] - sintet * vecLab[5],
837 -sinphi * vecLab[3] + cosphi * vecLab[4],
838 sintet * cosphi * vecLab[3] + sintet * sinphi * vecLab[4] + costet * vecLab[5],
846 vecLab[0] = cosphi * costet *
vect[0] - sinphi *
vect[1] + cosphi * sintet *
vect[2];
847 vecLab[1] = sinphi * costet *
vect[0] + cosphi *
vect[1] + sinphi * sintet *
vect[2];
848 vecLab[2] = -sintet *
vect[0] + costet *
vect[2];
850 vecLab[3] = cosphi * costet *
vect[3] - sinphi *
vect[4] + cosphi * sintet *
vect[5];
851 vecLab[4] = sinphi * costet *
vect[3] + cosphi *
vect[4] + sinphi * sintet *
vect[5];
852 vecLab[5] = -sintet *
vect[3] + costet *
vect[5];
855 value_t sinalp = -vecLab[7], cosalp = vecLab[8];
856 value_t t = cosalp * vecLab[0] - sinalp * vecLab[1];
857 vecLab[1] = sinalp * vecLab[0] + cosalp * vecLab[1];
859 t = cosalp * vecLab[3] - sinalp * vecLab[4];
860 vecLab[4] = sinalp * vecLab[3] + cosalp * vecLab[4];
864 value_t x = vecLab[0],
y = vecLab[1],
z = vecLab[2];
865 if (gpu::CAMath::Abs(
x - xk) > constants::math::Almost0) {
866 if (gpu::CAMath::Abs(vecLab[3]) < constants::math::Almost0) {
869 auto dxFin = xk - vecLab[0];
871 y += vecLab[4] / vecLab[3] * dxFin;
872 z += vecLab[5] / vecLab[3] * dxFin;
876 auto linRef1 = linRef0;
877 t = 1.f / gpu::CAMath::Sqrt(vecLab[3] * vecLab[3] + vecLab[4] * vecLab[4]);
881 linRef1.setSnp(snpRef1 = vecLab[4] * t);
882 linRef1.setTgl(vecLab[5] * t);
883 linRef1.setQ2Pt(q * t / vecLab[6]);
886 cspRef1 = gpu::CAMath::Sqrt((1 - snpRef1) * (1 + snpRef1));
887 cspRef1Inv =
value_t(1) / cspRef1;
888 cc = cspRef0 + cspRef1;
890 dy2dx = (snpRef0 + snpRef1) * ccInv;
891 double dxccInv = dx * ccInv, hh = dxccInv * cspRef1Inv * (1 + cspRef0 * cspRef1 + snpRef0 * snpRef1), jj = dx * (dy2dx - snpRef1 * cspRef1Inv);
892 double f02 = hh * cspRef0Inv;
893 double f04 = hh * dxccInv * kb;
894 double f24 = dx * kb;
895 double f12 = linRef0.getTgl() * (f02 * snpRef1 + jj);
896 double f13 = dx * (cspRef1 + snpRef1 * dy2dx);
897 double f14 = linRef0.getTgl() * (f04 * snpRef1 + jj * f24);
901 for (
int i = 0;
i < 5;
i++) {
902 diff[
i] = this->getParam(
i) - linRef0.getParam(
i);
905 if (gpu::CAMath::Abs(snpUpd) > constants::math::Almost1) {
909 this->setY(linRef1.getY() + diff[
kY] + f02 * diff[
kSnp] + f04 * diff[
kQ2Pt]);
910 this->setZ(linRef1.getZ() + diff[
kZ] + f13 * diff[
kTgl] + f14 * diff[
kQ2Pt]);
911 this->setSnp(snpUpd);
912 this->setTgl(linRef1.getTgl() + diff[
kTgl]);
913 this->setQ2Pt(linRef1.getQ2Pt() + diff[
kQ2Pt]);
924 double b00 = f02 * c20 + f04 * c40, b01 = f12 * c20 + f14 * c40 + f13 * c30;
925 double b02 = f24 * c40;
926 double b10 = f02 * c21 + f04 * c41, b11 = f12 * c21 + f14 * c41 + f13 * c31;
927 double b12 = f24 * c41;
928 double b20 = f02 * c22 + f04 * c42, b21 = f12 * c22 + f14 * c42 + f13 * c32;
929 double b22 = f24 * c42;
930 double b40 = f02 * c42 + f04 * c44, b41 = f12 * c42 + f14 * c44 + f13 * c43;
931 double b42 = f24 * c44;
932 double b30 = f02 * c32 + f04 * c43, b31 = f12 * c32 + f14 * c43 + f13 * c33;
933 double b32 = f24 * c43;
936 double a00 = f02 * b20 + f04 * b40, a01 = f02 * b21 + f04 * b41, a02 = f02 * b22 + f04 * b42;
937 double a11 = f12 * b21 + f14 * b41 + f13 * b31, a12 = f12 * b22 + f14 * b42 + f13 * b32;
938 double a22 = f24 * b42;
941 c00 += b00 + b00 + a00;
942 c10 += b10 + b01 + a01;
943 c20 += b20 + b02 + a02;
946 c11 += b11 + b11 + a11;
947 c21 += b21 + b12 + a12;
950 c22 += b22 + b22 + a22;
960template <
typename value_T>
964 constexpr float MaxCorr = 0.99;
966 for (
int j =
i;
j--;) {
967 auto sig2 = mC[DiagMap[
i]] * mC[DiagMap[
j]];
968 auto& cov = mC[CovarMap[
i][
j]];
969 if (cov * cov >= MaxCorr * sig2) {
970 cov = gpu::CAMath::Sqrt(sig2) * (cov > 0. ? MaxCorr : -MaxCorr);
977template <
typename value_T>
1032template <
typename value_T>
1037 if (s2 > constants::math::Almost0) {
1038 d0 = getSigmaY2() * s2;
1039 d1 = getSigmaZ2() * s2;
1040 d2 = getSigmaSnp2() * s2;
1041 d3 = getSigmaTgl2() * s2;
1042 d4 = getSigma1Pt2() * s2;
1070template <
typename value_T>
1074 auto sdd =
static_cast<double>(getSigmaY2()) +
static_cast<double>(cov[0]);
1075 auto sdz =
static_cast<double>(getSigmaZY()) +
static_cast<double>(cov[1]);
1076 auto szz =
static_cast<double>(getSigmaZ2()) +
static_cast<double>(cov[2]);
1077 auto det = sdd * szz - sdz * sdz;
1079 if (gpu::CAMath::Abs(det) < constants::math::Almost0) {
1080 return constants::math::VeryBig;
1085 auto chi2 = (d * (szz * d - sdz *
z) +
z * (sdd *
z - d * sdz)) / det;
1087#ifndef GPUCA_ALIGPUCODE
1088 LOGP(warning,
"Negative chi2={}, Cluster: {} {} {} Dy:{} Dz:{} | sdd:{} sdz:{} szz:{} det:{}", chi2, cov[0], cov[1], cov[2], d,
z, sdd, sdz, szz, det);
1089 LOGP(warning,
"Track: {}",
asString());
1096template <
typename value_T>
1100 auto sdd =
static_cast<double>(getSigmaY2()) +
static_cast<double>(cov[0]);
1101 auto sdz =
static_cast<double>(getSigmaZY()) +
static_cast<double>(cov[1]);
1102 auto szz =
static_cast<double>(getSigmaZ2()) +
static_cast<double>(cov[2]);
1103 auto det = sdd * szz - sdz * sdz;
1105 if (gpu::CAMath::Abs(det) < constants::math::Almost0) {
1106 return constants::math::VeryBig;
1112 return (d * (szz * d - sdz *
z) +
z * (sdd *
z - d * sdz)) / det;
1116template <
typename value_T>
1120 return getPredictedChi2(rhs, cov);
1124template <
typename value_T>
1128 cov(
kY,
kY) =
static_cast<double>(getSigmaY2()) +
static_cast<double>(
rhs.getSigmaY2());
1129 cov(
kZ,
kY) =
static_cast<double>(getSigmaZY()) +
static_cast<double>(
rhs.getSigmaZY());
1130 cov(
kZ,
kZ) =
static_cast<double>(getSigmaZ2()) +
static_cast<double>(
rhs.getSigmaZ2());
1131 cov(
kSnp,
kY) =
static_cast<double>(getSigmaSnpY()) +
static_cast<double>(
rhs.getSigmaSnpY());
1132 cov(
kSnp,
kZ) =
static_cast<double>(getSigmaSnpZ()) +
static_cast<double>(
rhs.getSigmaSnpZ());
1133 cov(
kSnp,
kSnp) =
static_cast<double>(getSigmaSnp2()) +
static_cast<double>(
rhs.getSigmaSnp2());
1134 cov(
kTgl,
kY) =
static_cast<double>(getSigmaTglY()) +
static_cast<double>(
rhs.getSigmaTglY());
1135 cov(
kTgl,
kZ) =
static_cast<double>(getSigmaTglZ()) +
static_cast<double>(
rhs.getSigmaTglZ());
1136 cov(
kTgl,
kSnp) =
static_cast<double>(getSigmaTglSnp()) +
static_cast<double>(
rhs.getSigmaTglSnp());
1137 cov(
kTgl,
kTgl) =
static_cast<double>(getSigmaTgl2()) +
static_cast<double>(
rhs.getSigmaTgl2());
1138 cov(
kQ2Pt,
kY) =
static_cast<double>(getSigma1PtY()) +
static_cast<double>(
rhs.getSigma1PtY());
1139 cov(
kQ2Pt,
kZ) =
static_cast<double>(getSigma1PtZ()) +
static_cast<double>(
rhs.getSigma1PtZ());
1140 cov(
kQ2Pt,
kSnp) =
static_cast<double>(getSigma1PtSnp()) +
static_cast<double>(
rhs.getSigma1PtSnp());
1141 cov(
kQ2Pt,
kTgl) =
static_cast<double>(getSigma1PtTgl()) +
static_cast<double>(
rhs.getSigma1PtTgl());
1142 cov(
kQ2Pt,
kQ2Pt) =
static_cast<double>(getSigma1Pt2()) +
static_cast<double>(
rhs.getSigma1Pt2());
1146template <
typename value_T>
1153 LOG(error) <<
"The reference Alpha of the tracks differ: " << this->getAlpha() <<
" : " <<
rhs.getAlpha();
1157 LOG(error) <<
"The reference X of the tracks differ: " << this->
getX() <<
" : " <<
rhs.getX();
1160 buildCombinedCovMatrix(rhs, covToSet);
1161 if (!covToSet.Invert()) {
1162 LOG(warning) <<
"Cov.matrix inversion failed: " << covToSet;
1165 double chi2diag = 0., chi2ndiag = 0., diff[
kNParams];
1167 diff[
i] = this->getParam(
i) -
rhs.getParam(
i);
1168 chi2diag += diff[
i] * diff[
i] * covToSet(
i,
i);
1171 for (
int j =
i;
j--;) {
1172 chi2ndiag += diff[
i] * diff[
j] * covToSet(
i,
j);
1175 return chi2diag + 2. * chi2ndiag;
1179template <
typename value_T>
1186 LOG(error) <<
"The reference Alpha of the tracks differ: " << this->getAlpha() <<
" : " <<
rhs.getAlpha();
1190 LOG(error) <<
"The reference X of the tracks differ: " << this->
getX() <<
" : " <<
rhs.getX();
1196 matC0(
kY,
kY) = getSigmaY2();
1197 matC0(
kZ,
kY) = getSigmaZY();
1198 matC0(
kZ,
kZ) = getSigmaZ2();
1199 matC0(
kSnp,
kY) = getSigmaSnpY();
1200 matC0(
kSnp,
kZ) = getSigmaSnpZ();
1201 matC0(
kSnp,
kSnp) = getSigmaSnp2();
1202 matC0(
kTgl,
kY) = getSigmaTglY();
1203 matC0(
kTgl,
kZ) = getSigmaTglZ();
1204 matC0(
kTgl,
kSnp) = getSigmaTglSnp();
1205 matC0(
kTgl,
kTgl) = getSigmaTgl2();
1206 matC0(
kQ2Pt,
kY) = getSigma1PtY();
1207 matC0(
kQ2Pt,
kZ) = getSigma1PtZ();
1211 MatrixD5 matK = matC0 * covInv;
1217 diff[
i] =
rhs.getParam(
i) - this->getParam(
i);
1221 this->updateParam(matK(
i,
j) * diff[
j],
i);
1247template <
typename value_T>
1252 buildCombinedCovMatrix(rhs, covI);
1253 if (!covI.Invert()) {
1254 LOG(warning) <<
"Cov.matrix inversion failed: " << covI;
1257 return update(rhs, covI);
1261template <
typename value_T>
1273 double r00 =
static_cast<double>(cov[0]) +
static_cast<double>(cm00);
1274 double r01 =
static_cast<double>(cov[1]) +
static_cast<double>(cm10);
1275 double r11 =
static_cast<double>(cov[2]) +
static_cast<double>(cm11);
1276 double det = r00 * r11 - r01 * r01;
1278 if (gpu::CAMath::Abs(det) < constants::math::Almost0) {
1281 double detI = 1. / det;
1287 double k00 = cm00 * r00 + cm10 * r01, k01 = cm00 * r01 + cm10 * r11;
1288 double k10 = cm10 * r00 + cm11 * r01, k11 = cm10 * r01 + cm11 * r11;
1289 double k20 = cm20 * r00 + cm21 * r01, k21 = cm20 * r01 + cm21 * r11;
1290 double k30 = cm30 * r00 + cm31 * r01, k31 = cm30 * r01 + cm31 * r11;
1291 double k40 = cm40 * r00 + cm41 * r01, k41 = cm40 * r01 + cm41 * r11;
1294 value_t dsnp = k20 * dy + k21 * dz;
1295 if (gpu::CAMath::Abs(this->getSnp() + dsnp) > constants::math::Almost1) {
1300 value_t(k40 * dy + k41 * dz)};
1301 this->updateParams(dP);
1303 double c01 = cm10, c02 = cm20, c03 = cm30, c04 = cm40;
1304 double c12 = cm21, c13 = cm31, c14 = cm41;
1306 cm00 -= k00 * cm00 + k01 * cm10;
1307 cm10 -= k00 * c01 + k01 * cm11;
1308 cm20 -= k00 * c02 + k01 * c12;
1309 cm30 -= k00 * c03 + k01 * c13;
1310 cm40 -= k00 * c04 + k01 * c14;
1312 cm11 -= k10 * c01 + k11 * cm11;
1313 cm21 -= k10 * c02 + k11 * c12;
1314 cm31 -= k10 * c03 + k11 * c13;
1315 cm41 -= k10 * c04 + k11 * c14;
1317 cm22 -= k20 * c02 + k21 * c12;
1318 cm32 -= k20 * c03 + k21 * c13;
1319 cm42 -= k20 * c04 + k21 * c14;
1321 cm33 -= k30 * c03 + k31 * c13;
1322 cm43 -= k30 * c04 + k31 * c14;
1324 cm44 -= k40 * c04 + k41 * c14;
1332template <
typename value_T>
1337 auto vtLoc = this->getVertexInTrackFrame(vtx);
1338 value_T chi2 = getPredictedChi2(vtLoc.yz, vtLoc.yzerr);
1339 return chi2 < maxChi2 && update(vtLoc.yz, vtLoc.yzerr) ? chi2 : -chi2;
1343template <
typename value_T>
1355 constexpr value_t kMSConst2 = 0.0136f * 0.0136f;
1356 constexpr value_t kMinP = 0.01f;
1358 value_t csp2 = (1.f - this->getSnp()) * (1.f + this->getSnp());
1359 value_t cst2I = (1.f + this->getTgl() * this->getTgl());
1365 auto m = this->getPID().getMass();
1366 int charge2 = this->getAbsCharge() * this->getAbsCharge();
1367 value_t p = this->getP(),
p0 =
p, p02 =
p *
p, e2 = p02 + this->getPID().getMass2(), massInv = 1. /
m,
bg =
p * massInv, dETot = 0.;
1368 value_t e = gpu::CAMath::Sqrt(e2), e0 = e;
1369 if (
m > 0 && xrho != 0.f) {
1371#ifdef _BB_NONCONST_CORR_
1385#ifdef _BB_NONCONST_CORR_
1386 dedxDer = this->getBetheBlochSolidDerivativeApprox(dedx1,
bg);
1393#ifdef _BB_NONCONST_CORR_
1394 if (dedxDer != 0.) {
1398 auto corrC = (gpu::CAMath::Exp(dedxDer) - 1.) / dedxDer;
1404 p = gpu::CAMath::Sqrt(e * e - this->getPID().getMass2());
1410 dedx = this->getdEdxBBOpt(
bg);
1411#ifdef _BB_NONCONST_CORR_
1412 dedxDer = this->getBetheBlochSolidDerivativeApprox(
dedx,
bg);
1416#ifdef _BB_NONCONST_CORR_
1436 value_t cC22(0.f), cC33(0.f), cC43(0.f), cC44(0.f);
1438 value_t beta2 = p02 / e2, theta2 = kMSConst2 / (
beta2 * p02) * gpu::CAMath::Abs(x2x0);
1439 value_t fp34 = this->getTgl();
1442 fp34 *= this->getCharge2Pt();
1444 if (theta2 > constants::math::PI * constants::math::PI) {
1447 value_t t2c2I = theta2 * cst2I;
1448 cC22 = t2c2I * csp2;
1449 cC33 = t2c2I * cst2I;
1450 cC43 = t2c2I * fp34;
1451 cC44 = theta2 * fp34 * fp34;
1460 constexpr value_t knst = 0.0007f;
1461 value_t sigmadE = knst * gpu::CAMath::Sqrt(gpu::CAMath::Abs(dETot)) * e0 / p02 * this->getCharge2Pt();
1462 cC44 += sigmadE * sigmadE;
1469 this->setQ2Pt(this->getQ2Pt() * p0 / p);
1477template <
typename value_T>
1489 constexpr value_t kMSConst2 = 0.0136f * 0.0136f;
1490 constexpr value_t kMinP = 0.01f;
1492 value_t csp2 = (1.f - linRef.getSnp()) * (1.f + linRef.getSnp());
1493 value_t cst2I = (1.f + linRef.getTgl() * linRef.getTgl());
1499 auto pid = linRef.getPID();
1500 auto m =
pid.getMass();
1501 int charge2 = linRef.getAbsCharge() * linRef.getAbsCharge();
1502 value_t p = linRef.getP(),
p0 =
p, p02 =
p *
p, e2 = p02 +
pid.getMass2(), massInv = 1. /
m,
bg =
p * massInv, dETot = 0.;
1503 value_t e = gpu::CAMath::Sqrt(e2), e0 = e;
1504 if (
m > 0 && xrho != 0.f) {
1506#ifdef _BB_NONCONST_CORR_
1520#ifdef _BB_NONCONST_CORR_
1521 dedxDer = this->getBetheBlochSolidDerivativeApprox(dedx1,
bg);
1528#ifdef _BB_NONCONST_CORR_
1529 if (dedxDer != 0.) {
1533 auto corrC = (gpu::CAMath::Exp(dedxDer) - 1.) / dedxDer;
1539 p = gpu::CAMath::Sqrt(e * e -
pid.getMass2());
1545 dedx = this->getdEdxBBOpt(
bg);
1546#ifdef _BB_NONCONST_CORR_
1547 dedxDer = this->getBetheBlochSolidDerivativeApprox(
dedx,
bg);
1551#ifdef _BB_NONCONST_CORR_
1571 value_t cC22(0.f), cC33(0.f), cC43(0.f), cC44(0.f);
1573 value_t beta2 = p02 / e2, theta2 = kMSConst2 / (
beta2 * p02) * gpu::CAMath::Abs(x2x0);
1574 value_t fp34 = linRef.getTgl();
1577 fp34 *= linRef.getCharge2Pt();
1579 if (theta2 > constants::math::PI * constants::math::PI) {
1582 value_t t2c2I = theta2 * cst2I;
1583 cC22 = t2c2I * csp2;
1584 cC33 = t2c2I * cst2I;
1585 cC43 = t2c2I * fp34;
1586 cC44 = theta2 * fp34 * fp34;
1595 constexpr value_t knst = 0.0007f;
1596 value_t sigmadE = knst * gpu::CAMath::Sqrt(gpu::CAMath::Abs(dETot)) * e0 / p02 * linRef.getCharge2Pt();
1597 cC44 += sigmadE * sigmadE;
1604 auto pscale =
p0 /
p;
1605 linRef.setQ2Pt(linRef.getQ2Pt() * pscale);
1606 this->setQ2Pt(this->getQ2Pt() * pscale);
1614template <
typename value_T>
1629 if (gpu::CAMath::Abs(this->getQ2Pt()) <= constants::math::Almost0 || gpu::CAMath::Abs(this->getSnp()) > constants::math::Almost1) {
1630 for (
int i = 0;
i < 21;
i++) {
1636 const value_t pt = this->getPt();
1637 const value_t q2pt = this->getQ2Pt();
1639 o2::math_utils::detail::sincos(this->getAlpha(), sn, cs);
1640 const value_t snp = this->getSnp();
1641 const value_t csp = gpu::CAMath::Sqrt((1.f - snp) * (1.f + snp));
1642 const value_t pXLoc = pt * csp;
1643 const value_t pYLoc = pt * snp;
1644 const value_t pZ = pt * this->getTgl();
1645 const value_t pX = cs * pXLoc - sn * pYLoc;
1646 const value_t pY = sn * pXLoc + cs * pYLoc;
1650 for (
int j = 0;
j <=
i; ++
j) {
1651 cTr[
i][
j] = cTr[
j][
i] = mC[CovarMap[
i][
j]];
1655 double jac[6][5] = {};
1660 const value_t dPxDSnp = -pt * (cs * snp / csp + sn);
1661 const value_t dPyDSnp = pt * (cs - sn * snp / csp);
1662 jac[3][
kSnp] = dPxDSnp;
1663 jac[4][
kSnp] = dPyDSnp;
1666 jac[3][
kQ2Pt] = -pX / q2pt;
1667 jac[4][
kQ2Pt] = -pY / q2pt;
1668 jac[5][
kQ2Pt] = -pZ / q2pt;
1671 for (
int i = 0;
i < 6; ++
i) {
1672 for (
int j = 0;
j <=
i; ++
j) {
1674 for (
int k = 0; k <
kNParams; ++k) {
1675 for (
int l = 0; l <
kNParams; ++l) {
1676 cij += jac[
i][k] * cTr[k][l] * jac[
j][l];
1686#ifndef GPUCA_ALIGPUCODE
1688template <
typename value_T>
1692 fmt::format(
" Cov: [{:+.3e}] [{:+.3e} {:+.3e}] [{:+.3e} {:+.3e} {:+.3e}] [{:+.3e} {:+.3e} {:+.3e} {:+.3e}] [{:+.3e} {:+.3e} {:+.3e} {:+.3e} {:+.3e}]",
1698template <
typename value_T>
1702 fmt::format(
" Cov: [{:x}] [{:x} {:x}] [{:x} {:x} {:x}] [{:x} {:x} {:x} {:x}] [{:x} {:x} {:x} {:x} {:x}]",
1703 reinterpret_cast<const unsigned int&
>(mC[
kSigY2]),
reinterpret_cast<const unsigned int&
>(mC[
kSigZY]),
reinterpret_cast<const unsigned int&
>(mC[
kSigZ2]),
1704 reinterpret_cast<const unsigned int&
>(mC[
kSigSnpY]),
reinterpret_cast<const unsigned int&
>(mC[
kSigSnpZ]),
reinterpret_cast<const unsigned int&
>(mC[
kSigSnp2]),
1705 reinterpret_cast<const unsigned int&
>(mC[
kSigTglY]),
reinterpret_cast<const unsigned int&
>(mC[
kSigTglZ]),
reinterpret_cast<const unsigned int&
>(mC[
kSigTglSnp]),
1706 reinterpret_cast<const unsigned int&
>(mC[
kSigTgl2]),
reinterpret_cast<const unsigned int&
>(mC[
kSigQ2PtY]),
reinterpret_cast<const unsigned int&
>(mC[
kSigQ2PtZ]),
1707 reinterpret_cast<const unsigned int&
>(mC[
kSigQ2PtSnp]),
reinterpret_cast<const unsigned int&
>(mC[
kSigQ2PtTgl]),
reinterpret_cast<const unsigned int&
>(mC[
kSigQ2Pt2]));
1712template <
typename value_T>
1716#ifndef GPUCA_ALIGPUCODE
1717 printf(
"%s\n",
asString().c_str());
1718#elif !defined(GPUCA_GPUCODE_DEVICE) || (!defined(__OPENCL__) && defined(GPUCA_GPU_DEBUG_PRINT))
1721 " Cov: [%+.3e] [%+.3e %+.3e] [%+.3e %+.3e %+.3e] [%+.3e %+.3e %+.3e %+.3e] [%+.3e %+.3e %+.3e %+.3e %+.3e]\n",
1729template <
typename value_T>
1733#ifndef GPUCA_ALIGPUCODE
1734 printf(
"%s\n", asStringHexadecimal().c_str());
1735#elif !defined(GPUCA_GPUCODE_DEVICE) || (!defined(__OPENCL__) && defined(GPUCA_GPU_DEBUG_PRINT))
1738 " Cov: [%x] [%x %x] [%x %x %x] [%x %x %x %x] [%x %x %x %x %x]\n",
1739 gpu::CAMath::Float2UIntReint(mC[
kSigY2]),
1740 gpu::CAMath::Float2UIntReint(mC[
kSigZY]), gpu::CAMath::Float2UIntReint(mC[
kSigZ2]),
1741 gpu::CAMath::Float2UIntReint(mC[
kSigSnpY]), gpu::CAMath::Float2UIntReint(mC[
kSigSnpZ]), gpu::CAMath::Float2UIntReint(mC[
kSigSnp2]),
1742 gpu::CAMath::Float2UIntReint(mC[
kSigTglY]), gpu::CAMath::Float2UIntReint(mC[
kSigTglZ]), gpu::CAMath::Float2UIntReint(mC[
kSigTglSnp]), gpu::CAMath::Float2UIntReint(mC[
kSigTgl2]),
1747#ifndef GPUCA_ALIGPUCODE
1749template <
typename value_T>
1752 auto p = this->getXYZGlo();
1756 t.
setPhi(this->getPhi());
1764 value_T csa, sna, csP, snP, csp = gpu::CAMath::Sqrt((1. - this->getSnp()) * (1. + this->getSnp()));
1765 math_utils::detail::sincos(value_T(this->getAlpha()), sna, csa);
1766 math_utils::detail::sincos(value_T(t.
getPhi()), snP, csP);
1775 auto tgLI = 1 / this->getTgl();
1776 const value_T d1 = -sna;
1777 const value_T
d2 = -csP * tgLI;
1778 const value_T e1 = csa;
1779 const value_T e2 = -snP * tgLI;
1780 const value_T
f1 = 1 / csp;
1782 C(0, 0) = d1 * d1 * getSigmaY2() + 2 * d1 *
d2 * getSigmaZY() +
d2 *
d2 * getSigmaZ2();
1783 C(0, 1) = d1 * e1 * getSigmaY2() + (d1 * e2 +
d2 * e1) * getSigmaZY() +
d2 * e2 * getSigmaZ2();
1784 C(1, 1) = e1 * e1 * getSigmaY2() + 2 * e1 * e2 * getSigmaZY() + e2 * e2 * getSigmaZ2();
1786 C(0, 2) =
f1 * (d1 * getSigmaSnpY() +
d2 * getSigmaSnpZ());
1787 C(1, 2) =
f1 * (e1 * getSigmaSnpY() + e2 * getSigmaSnpZ());
1788 C(2, 2) =
f1 *
f1 * getSigmaSnp2();
1790 C(0, 3) = d1 * getSigmaTglY() +
d2 * getSigmaTglZ();
1791 C(1, 3) = e1 * getSigmaTglY() + e2 * getSigmaTglZ();
1792 C(2, 3) =
f1 * getSigmaTglSnp();
1793 C(3, 3) = getSigmaTgl2();
1795 C(0, 4) = d1 * getSigma1PtY() +
d2 * getSigma1PtZ();
1796 C(1, 4) = e1 * getSigma1PtY() + e2 * getSigma1PtZ();
1797 C(2, 4) =
f1 * getSigma1PtSnp();
1798 C(3, 4) = getSigma1PtTgl();
1799 C(4, 4) = getSigma1Pt2();
1807#if !defined(GPUCA_GPUCODE) || defined(GPUCA_GPUCODE_DEVICE)
1810#ifndef GPUCA_GPUCODE
std::string asString(TDataMember const &dm, char *pointer)
Base forward track model, params only, w/o covariance.
void setCovariances(const SMatrix55Sym &covariances)
void setTanl(Double_t tanl)
void setInvQPt(Double_t invqpt)
void setPhi(Double_t phi)
void setZ(Double_t z)
set Z coordinate (cm)
bool toFwdTrackParCov(TrackParCovFwd &t) const
std::string asString() const
std::string asStringHexadecimal()
std::string asStringHexadecimal()
std::string asString() const
GLfloat GLfloat GLfloat alpha
GLboolean GLboolean GLboolean b
typedef void(APIENTRYP PFNGLCULLFACEPROC)(GLenum mode)
GLubyte GLubyte GLubyte GLubyte w
GLdouble GLdouble GLdouble z
typename trackParam_t::params_t params_t
typename trackParam_t::dim3_t dim3_t
typename trackParam_t::value_t value_t
const TrackingFrameInfo *const const Cluster *const const float const float bz
D const SVectorGPU< T, D > & rhs
double * getX(double *xyDxy, int N)
double * getY(double *xyDxy, int N)
constexpr float kCTgl2max
constexpr int kCovMatSize
constexpr float kCSnp2max
constexpr int kLabCovMatSize
constexpr float DefaultDCACov
value_T std::array< value_T, 7 > & vect
GPUd() value_T BetheBlochSolid(value_T bg
constexpr float kC1Pt2max
constexpr float DefaultDCA
constexpr int MaxELossIter
constexpr float ELoss2EKinThreshInv
a couple of static helper functions to create timestamp values for CCDB queries or override obsolete ...
std::vector< o2::mch::ChannelCode > cc
LOG(info)<< "Compressed in "<< sw.CpuTime()<< " s"