96GPUTRDTracker_t<TRDTRK, PROP>::GPUTRDTracker_t() : mR(nullptr), mIsInitialized(false), mGenerateSpacePoints(false), mProcessPerTimeFrame(false), mNAngleHistogramBins(25), mAngleHistogramRange(50), mMemoryPermanent(-1), mMemoryTracklets(-1), mMemoryTracks(-1), mNMaxCollisions(0), mNMaxTracks(0), mNMaxSpacePoints(0), mTracks(nullptr), mTrackAttribs(nullptr), mNCandidates(1), mNTracks(0), mNEvents(0), mMaxBackendThreads(100), mTrackletIndexArray(nullptr), mFT0TriggeredBC(nullptr), mNFT0BC(0), mHypothesis(nullptr), mCandidates(nullptr), mSpacePoints(nullptr), mGeo(nullptr), mRecoParam(nullptr), mDebugOutput(false), mMaxEta(0.84f), mRoadZ(18.f), mTPCVdrift(2.58f), mTPCTDriftOffset(0.f), mDebug(new
GPUTRDTrackerDebug<TRDTRK>())
103template <
class TRDTRK,
class PROP>
112template <
class TRDTRK,
class PROP>
118 mRecoParam = GetConstantMem()->calibObjects.trdRecoParam;
120 mDebug->ExpandVectors();
121 mIsInitialized =
true;
124template <
class TRDTRK,
class PROP>
130 mGeo = (
const GPUTRDGeometry*)GetConstantMem()->calibObjects.trdGeometry;
132 GPUFatal(
"TRD geometry must be provided externally");
135 float x0[kNLayers] = {300.2f, 312.8f, 325.4f, 338.0f, 350.6f, 363.2f};
136 auto* matrix = mGeo->GetClusterMatrix(0);
137 float loc[3] = {mGeo->AnodePos(), 0.f, 0.f};
138 float glb[3] = {0.f, 0.f, 0.f};
139 for (int32_t iDet = 0; iDet < kNChambers; ++iDet) {
140 matrix = mGeo->GetClusterMatrix(iDet);
142 mR[iDet] =
x0[mGeo->GetLayer(iDet)];
145 matrix->LocalToMaster(loc, glb);
150template <
class TRDTRK,
class PROP>
159template <
class TRDTRK,
class PROP>
167 for (uint32_t iColl = 0; iColl < GetConstantMem()->ioPtrs.nTRDTriggerRecords; ++iColl) {
168 if (GetConstantMem()->ioPtrs.trdTrigRecMask && GetConstantMem()->ioPtrs.trdTrigRecMask[iColl] == 0) {
173 int32_t idxOffset = 0;
174 if (mProcessPerTimeFrame) {
175 idxOffset = GetConstantMem()->ioPtrs.trdTrackletIdxFirst[iColl];
176 nTrklts = (iColl < GetConstantMem()->ioPtrs.nTRDTriggerRecords - 1) ? GetConstantMem()->ioPtrs.trdTrackletIdxFirst[iColl + 1] - GetConstantMem()->ioPtrs.trdTrackletIdxFirst[iColl] : GetConstantMem()->ioPtrs.nTRDTracklets - GetConstantMem()->ioPtrs.trdTrackletIdxFirst[iColl];
178 nTrklts = GetConstantMem()->ioPtrs.nTRDTracklets;
181 int32_t* trkltIndexArray = &mTrackletIndexArray[iColl * (kNChambers + 1) + 1];
182 trkltIndexArray[-1] = 0;
185 int32_t trkltCounter = 0;
186 for (int32_t iTrklt = 0; iTrklt < nTrklts; ++iTrklt) {
187 if (
tracklets[iTrklt].GetDetector() > currDet) {
188 nextDet =
tracklets[iTrklt].GetDetector();
189 for (int32_t iDet = currDet; iDet < nextDet; ++iDet) {
190 trkltIndexArray[iDet] = trkltCounter;
196 for (int32_t iDet = currDet; iDet <= kNChambers; ++iDet) {
197 trkltIndexArray[iDet] = trkltCounter;
199 if (mGenerateSpacePoints) {
200 if (!CalculateSpacePoints(iColl)) {
201 GPUError(
"Space points for at least one chamber could not be calculated (for interaction %i)", iColl);
206 if (mGenerateSpacePoints) {
212template <
class TRDTRK,
class PROP>
218 if (!mIsInitialized) {
221 GPUError(
"Cannot change mNCandidates after initialization");
225template <
class TRDTRK,
class PROP>
231 GPUInfo(
"##############################################################");
232 GPUInfo(
"Current settings for GPU TRD tracker:");
233 GPUInfo(
" maxChi2(%.2f), chi2Penalty(%.2f), nCandidates(%i), maxMissingLayers(%i)", Param().
rec.trd.maxChi2, Param().
rec.trd.penaltyChi2, mNCandidates, Param().
rec.trd.stopTrkAfterNMissLy);
234 GPUInfo(
" ptCut = %.2f GeV, abs(eta) < %.2f", Param().
rec.trd.minTrackPt, mMaxEta);
235 GPUInfo(
"##############################################################");
238template <
class TRDTRK,
class PROP>
241 mDebug->CreateStreamer();
249 return &Param().polynomialField;
252template <
class TRDTRK,
class PROP>
255 return GetConstantMem()->calibObjects.o2Propagator;
258template <
class TRDTRK,
class PROP>
261 if (!trk.CheckNumericalQuality()) {
264 if (CAMath::Abs(trk.getEta()) > mMaxEta) {
267 if (trk.getPt() < Param().
rec.trd.minTrackPt) {
273template <
class TRDTRK,
class PROP>
274GPUd() int32_t
GPUTRDTracker_t<TRDTRK, PROP>::LoadTrack(const TRDTRK& trk, uint32_t tpcTrackId,
bool checkTrack, HelperTrackAttributes* attribs)
276 if (mNTracks >= mNMaxTracks) {
278 GPUError(
"Error: Track dropped (no memory available) -> must not happen");
282 if (checkTrack && !CheckTrackTRDCandidate(trk)) {
285 mTracks[mNTracks] = trk;
286 mTracks[mNTracks].setRefGlobalTrackIdRaw(tpcTrackId);
288 mTrackAttribs[mNTracks] = *attribs;
294template <
class TRDTRK,
class PROP>
300 GPUInfo(
"There are in total %i tracklets loaded", GetConstantMem()->ioPtrs.nTRDTracklets);
301 GPUInfo(
"There are %i tracks loaded. mNMaxTracks(%i)", mNTracks, mNMaxTracks);
302 for (int32_t
i = 0;
i < mNTracks; ++
i) {
303 auto* trk = &(mTracks[
i]);
304 GPUInfo(
"track %i: x=%f, alpha=%f, nTracklets=%i, pt=%f, time=%f",
i, trk->getX(), trk->getAlpha(), trk->getNtracklets(), trk->getPt(), mTrackAttribs[
i].mTime);
308template <
class TRDTRK,
class PROP>
309GPUd() int32_t
GPUTRDTracker_t<TRDTRK, PROP>::GetCollisionIDs(int32_t iTrk, int32_t* collisionIds)
const
319 for (uint32_t iColl = 0; iColl < GetConstantMem()->ioPtrs.nTRDTriggerRecords; ++iColl) {
320 if (GetConstantMem()->ioPtrs.trdTrigRecMask && GetConstantMem()->ioPtrs.trdTrigRecMask[iColl] == 0) {
323 if (GetConstantMem()->ioPtrs.trdTriggerTimes[iColl] > mTrackAttribs[iTrk].GetTimeMin() && GetConstantMem()->ioPtrs.trdTriggerTimes[iColl] < mTrackAttribs[iTrk].GetTimeMax()) {
325 GPUError(
"Found too many collision candidates for track with tMin(%f) and tMax(%f)", mTrackAttribs[iTrk].GetTimeMin(), mTrackAttribs[iTrk].GetTimeMax());
328 collisionIds[nColls++] = iColl;
334template <
class TRDTRK,
class PROP>
340 int32_t collisionIds[20] = {0};
341 int32_t nCollisionIds = 1;
342 if (mProcessPerTimeFrame) {
343 nCollisionIds = GetCollisionIDs(iTrk, collisionIds);
344 if (nCollisionIds == 0) {
346 GPUInfo(
"Did not find TRD data for track %i with t=%f. tMin(%f), tMax(%f)", iTrk, mTrackAttribs[iTrk].mTime, mTrackAttribs[iTrk].GetTimeMin(), mTrackAttribs[iTrk].GetTimeMax());
352 PROP prop(getPropagatorParam());
353 mTracks[iTrk].setChi2(Param().
rec.trd.penaltyChi2);
355 auto trkStart = mTracks[iTrk];
356 for (int32_t iColl = 0; iColl < nCollisionIds; ++iColl) {
358 auto trkCopy = trkStart;
359 prop.setTrack(&trkCopy);
360 prop.setFitInProjections(
true);
361 if (!FollowProlongation(&prop, &trkCopy, iTrk, threadId, collisionIds[iColl])) {
365 if (trkCopy.getReducedChi2() < mTracks[iTrk].getReducedChi2()) {
366 mTracks[iTrk] = trkCopy;
371template <
class TRDTRK,
class PROP>
380 int32_t idxOffset = iCollision * (kNChambers + 1);
384 for (int32_t iDet = 0; iDet < kNChambers; ++iDet) {
385 int32_t iFirstTrackletInDet = mTrackletIndexArray[idxOffset + iDet];
386 int32_t iFirstTrackletInNextDet = mTrackletIndexArray[idxOffset + iDet + 1];
387 int32_t nTrackletsInDet = iFirstTrackletInNextDet - iFirstTrackletInDet;
388 if (nTrackletsInDet == 0) {
391 if (!mGeo->ChamberInGeometry(iDet)) {
392 GPUError(
"Found TRD tracklets in chamber %i which is not included in the geometry", iDet);
395 auto* matrix = mGeo->GetClusterMatrix(iDet);
397 GPUError(
"No cluster matrix available for chamber %i. Skipping it...", iDet);
403 int32_t trkltIdxOffset = (mProcessPerTimeFrame) ? GetConstantMem()->ioPtrs.trdTrackletIdxFirst[iCollision] : 0;
404 int32_t trkltIdxStart = trkltIdxOffset + iFirstTrackletInDet;
405 for (int32_t trkltIdx = trkltIdxStart; trkltIdx < trkltIdxStart + nTrackletsInDet; ++trkltIdx) {
406 int32_t trkltZbin =
tracklets[trkltIdx].GetZbin();
407 float xTrkltDet[3] = {0.f};
408 float xTrkltSec[3] = {0.f};
409 xTrkltDet[0] = mGeo->AnodePos() + sRadialOffset;
410 xTrkltDet[1] =
tracklets[trkltIdx].GetY();
411 xTrkltDet[2] = pp->GetRowPos(trkltZbin) - pp->GetRowSize(trkltZbin) / 2.f - pp->GetRowPos(pp->GetNrows() / 2);
413 matrix->LocalToMaster(xTrkltDet, xTrkltSec);
414 mSpacePoints[trkltIdx].setX(xTrkltSec[0]);
415 mSpacePoints[trkltIdx].setY(xTrkltSec[1]);
416 mSpacePoints[trkltIdx].setZ(xTrkltSec[2]);
417 mSpacePoints[trkltIdx].setDy(
tracklets[trkltIdx].GetdY());
425template <
class TRDTRK,
class PROP>
426GPUd() bool
GPUTRDTracker_t<TRDTRK, PROP>::FollowProlongation(PROP* prop, TRDTRK* t, int32_t iTrk, int32_t threadId, int32_t collisionId)
436 GPUInfo(
"Start track following for track %i at x=%f with pt=%f", t->getRefGlobalTrackIdRaw(), t->getX(), t->getPt());
442 int32_t nIdxBCMin = -1;
443 int32_t nIdxBCMax = -1;
445 for (int32_t iBC = 0; iBC < mNFT0BC; iBC++) {
447 if (nIdxBCMin == -1 && deltaBC > mRecoParam->getPileUpRangeBefore()) {
450 if (deltaBC >= mRecoParam->getPileUpRangeAfter()) {
454 if (iBC == mNFT0BC - 1) {
456 if (nIdxBCMin == -1) {
458 nIdxBCMin = nIdxBCMax;
463 float zShiftTrk = 0.f;
464 if (mProcessPerTimeFrame) {
465 zShiftTrk = (mTrackAttribs[iTrk].mTime - GetConstantMem()->ioPtrs.trdTriggerTimes[collisionId]) * mTPCVdrift * mTrackAttribs[iTrk].mSide;
473 const GPUTRDSpacePoint* spacePoints = GetConstantMem()->ioPtrs.trdSpacePoints;
475#ifdef ENABLE_GPUTRDDEBUG
476 TRDTRK trackNoUp(*t);
479 int32_t candidateIdxOffset = threadId * 2 * mNCandidates;
480 int32_t hypothesisIdxOffset = threadId * mNCandidates;
481 int32_t trkltIdxOffset = collisionId * (kNChambers + 1);
482 int32_t glbTrkltIdxOffset = (mProcessPerTimeFrame) ? GetConstantMem()->ioPtrs.trdTrackletIdxFirst[collisionId] : 0;
485 if (mNCandidates > 1) {
487 mCandidates[candidateIdxOffset] = *t;
490 int32_t nCandidates = 1;
491 int32_t nCurrHypothesis = 0;
496 const int32_t nMaxChambersToSearch = 4;
498 mDebug->SetGeneralInfo(mNEvents, mNTracks, iTrk, t->getPt());
500 for (int32_t iLayer = 0; iLayer < kNLayers; ++iLayer) {
503 int32_t currIdx = candidateIdxOffset + iLayer % 2;
504 int32_t nextIdx = candidateIdxOffset + (iLayer + 1) % 2;
505 pad = mGeo->GetPadPlane(iLayer, 0);
506 float tilt = CAMath::Tan(CAMath::Pi() / 180.f * pad->GetTiltingAngle());
507 const float zMaxTRD = pad->GetRow0();
514 for (int32_t iCandidate = 0; iCandidate < nCandidates; iCandidate++) {
516 int32_t det[nMaxChambersToSearch] = {-1, -1, -1, -1};
518 if (mNCandidates > 1) {
519 trkWork = &mCandidates[2 * iCandidate + currIdx];
520 prop->setTrack(trkWork);
523 if (trkWork->getIsStopped()) {
524 Hypothesis hypo(trkWork->getNlayersFindable(), iCandidate, -1, trkWork->getChi2());
525 InsertHypothesis(hypo, nCurrHypothesis, hypothesisIdxOffset);
531 if (!prop->propagateToX(mR[2 * kNLayers + iLayer], .8f, 2.f)) {
533 GPUInfo(
"Track propagation failed for track %i candidate %i in layer %i (pt=%f, x=%f, mR[layer]=%f)", iTrk, iCandidate, iLayer, trkWork->getPt(), trkWork->getX(), mR[2 * kNLayers + iLayer]);
539 if (!AdjustSector(prop, trkWork)) {
541 GPUInfo(
"Adjusting sector failed for track %i candidate %i in layer %i", iTrk, iCandidate, iLayer);
547 if (IsGeoFindable(trkWork, iLayer, prop->getAlpha(), zShiftTrk)) {
548 trkWork->setIsFindable(iLayer);
552 roadY = 7.f * CAMath::Sqrt(trkWork->getSigmaY2() + 0.1f * 0.1f) + Param().rec.trd.extraRoadY;
554 roadZ = mRoadZ + Param().rec.trd.extraRoadZ;
556 if (CAMath::Abs(trkWork->getZ() + zShiftTrk) - roadZ >= zMaxTRD) {
558 GPUInfo(
"Track out of TRD acceptance with z=%f in layer %i (eta=%f)", trkWork->getZ() + zShiftTrk, iLayer, trkWork->getEta());
564 FindChambersInRoad(trkWork, roadY, roadZ, iLayer, det, zMaxTRD, prop->getAlpha(), zShiftTrk);
567 mDebug->SetTrackParameter(*trkWork, iLayer);
570 for (int32_t iDet = 0; iDet < nMaxChambersToSearch; iDet++) {
571 int32_t currDet = det[iDet];
575 pad = mGeo->GetPadPlane(currDet);
576 int32_t currSec = mGeo->GetSector(currDet);
577 if (currSec != GetSector(prop->getAlpha())) {
578 if (!prop->rotate(GetAlphaOfSector(currSec))) {
580 GPUWarning(
"Track could not be rotated in tracklet coordinate system");
585 if (currSec != GetSector(prop->getAlpha())) {
586 GPUError(
"Track is in sector %i and sector %i is searched for tracklets", GetSector(prop->getAlpha()), currSec);
590 if (!prop->propagateToX(mR[currDet], .8f, .2f)) {
592 GPUWarning(
"Track parameter for track %i, x=%f at chamber %i x=%f in layer %i cannot be retrieved", iTrk, trkWork->getX(), currDet, mR[currDet], iLayer);
596 for (int32_t trkltIdx = glbTrkltIdxOffset + mTrackletIndexArray[trkltIdxOffset + currDet]; trkltIdx < glbTrkltIdxOffset + mTrackletIndexArray[trkltIdxOffset + currDet + 1]; ++trkltIdx) {
597 if (CAMath::Abs(trkWork->getY() - spacePoints[trkltIdx].getY()) > roadY || CAMath::Abs(trkWork->getZ() + zShiftTrk - spacePoints[trkltIdx].getZ()) > roadZ) {
603 prop->getPropagatedYZ(spacePoints[trkltIdx].
getX(), projY, projZ);
605 float tiltCorr = tilt * (spacePoints[trkltIdx].getZ() - projZ);
606 float dyTiltCorr = tilt * trkWork->getTgl() * mGeo->GetCdrHght();
607 float lPad = pad->GetRowSize(
tracklets[trkltIdx].GetZbin());
608 if (!((CAMath::Abs(spacePoints[trkltIdx].getZ() - projZ) < lPad) && (trkWork->getSigmaZ2() < (lPad * lPad / 12.f)))) {
616 float yCorrPileUp = 0.f;
617 float yAddErrPileUp2 = 0.f;
618 if (nIdxBCMax - nIdxBCMin >= 2) {
622 float sumCorr2 = 0.f;
625 float slopeFactor =
tracklets[trkltIdx].GetSlopeFloat() * mGeo->GetPadPlaneWidthIPad(
tracklets[trkltIdx].GetDetector()) / 4.f;
626 for (int32_t iBC = nIdxBCMin; iBC < nIdxBCMax; iBC++) {
628 float probBC = mRecoParam->getPileUpProbTracklet(deltaBC,
true, (
tracklets[trkltIdx].GetQ0() != 0), (
tracklets[trkltIdx].GetQ1() != 0));
629 sumCorr += probBC * slopeFactor * deltaBC;
630 sumCorr2 += probBC * slopeFactor * deltaBC * slopeFactor * deltaBC;
632 if (probBC > maxProb) {
634 yCorrPileUp = -slopeFactor * deltaBC;
637 if (sumProb > 1e-6f) {
638 yAddErrPileUp2 = sumCorr2 / sumProb - 2 * yCorrPileUp * sumCorr / sumProb + yCorrPileUp * yCorrPileUp;
642 int nTrackletsChamber = mTrackletIndexArray[trkltIdxOffset + currDet + 1] - mTrackletIndexArray[trkltIdxOffset + currDet];
643 float angularPull = GetAngularPull(spacePoints[trkltIdx].getDy() + dyTiltCorr, trkWork->getSnp(), nTrackletsChamber);
646 float zPosCorr = spacePoints[trkltIdx].getZ() + mRecoParam->getZCorrCoeffNRC() * trkWork->getTgl();
647 float yPosCorr = spacePoints[trkltIdx].getY() - tiltCorr + yCorrPileUp;
648 zPosCorr -= zShiftTrk;
649 float deltaY = yPosCorr - projY;
650 float deltaZ = zPosCorr - projZ;
652 float trkltPosTmpYZ[2] = {yPosCorr, zPosCorr};
653 float trkltCovTmp[3] = {0.f};
654 if ((CAMath::Abs(deltaY) < roadY) && (CAMath::Abs(deltaZ) < roadZ)) {
656 RecalcTrkltCov(tilt, trkWork->getSnp(), pad->GetRowSize(
tracklets[trkltIdx].GetZbin()), (Param().
rec.trd.useAngularPull == 2 ? angularPull : 0.f), nTrackletsChamber, trkltCovTmp);
657 trkltCovTmp[0] += yAddErrPileUp2;
658 float chi2 = prop->getPredictedChi2(trkltPosTmpYZ, trkltCovTmp);
659 if (Param().
rec.trd.addDeflectionInChi2 && (trkWork->getSnp() < 1.f - 1e-6f) && (trkWork->getSnp() > -1.f + 1e-6f)) {
661 float trkltCovTmpWithDy[6] = {trkltCovTmp[0], trkltCovTmp[1], trkltCovTmp[2], 0.f, 0.f, 0.f};
662 RecalcTrkltCovDy(tilt, trkWork->getSnp(), (Param().
rec.trd.useAngularPull == 2 ? angularPull : 0.f), nTrackletsChamber, trkltCovTmpWithDy);
663 trkltCovTmpWithDy[0] += trkWork->getSigmaY2();
664 trkltCovTmpWithDy[1] += trkWork->getSigmaZY();
665 trkltCovTmpWithDy[2] += trkWork->getSigmaZ2();
668 if (InvertCov(trkltCovTmpWithDy)) {
669 float deltaDy = spacePoints[trkltIdx].getDy() + dyTiltCorr - mRecoParam->convertAngleToDy(trkWork->getSnp());
670 chi2 = deltaY * trkltCovTmpWithDy[0] * deltaY + 2 * deltaY * trkltCovTmpWithDy[1] * deltaZ + 2 * deltaY * trkltCovTmpWithDy[3] * deltaDy + deltaZ * trkltCovTmpWithDy[2] * deltaZ + 2 * deltaZ * trkltCovTmpWithDy[4] * deltaDy + deltaDy * trkltCovTmpWithDy[5] * deltaDy;
674 if ((chi2 > Param().
rec.trd.maxChi2) || (Param().
rec.trd.applyDeflectionCut && CAMath::Abs(angularPull) > 4)) {
677 Hypothesis hypo(trkWork->getNlayersFindable(), iCandidate, trkltIdx, trkWork->getChi2() + chi2);
678 InsertHypothesis(hypo, nCurrHypothesis, hypothesisIdxOffset);
684 Hypothesis hypoNoUpdate(trkWork->getNlayersFindable(), iCandidate, -1, trkWork->getChi2() + Param().
rec.trd.penaltyChi2);
685 InsertHypothesis(hypoNoUpdate, nCurrHypothesis, hypothesisIdxOffset);
689 mDebug->SetChi2Update(mHypothesis[0 + hypothesisIdxOffset].mChi2 - t->getChi2(), iLayer);
690 mDebug->SetRoad(roadY, roadZ, iLayer);
691 bool wasTrackStored =
false;
699 for (int32_t iUpdate = 0; iUpdate < nCurrHypothesis && iUpdate < mNCandidates; iUpdate++) {
700 if (mHypothesis[iUpdate + hypothesisIdxOffset].mCandidateId == -1) {
707 nCandidates = iUpdate + 1;
708 if (mNCandidates > 1) {
709 mCandidates[2 * iUpdate + nextIdx] = mCandidates[2 * mHypothesis[iUpdate + hypothesisIdxOffset].mCandidateId + currIdx];
710 trkWork = &mCandidates[2 * iUpdate + nextIdx];
712 if (mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId == -1) {
714 if (trkWork->getIsFindable(iLayer)) {
715 if (trkWork->getNmissingConsecLayers(iLayer) > Param().
rec.trd.stopTrkAfterNMissLy) {
716 trkWork->setIsStopped();
718 trkWork->setChi2(trkWork->getChi2() + Param().
rec.trd.penaltyChi2);
720 if (iUpdate == 0 && mNCandidates > 1) {
721 *t = mCandidates[2 * iUpdate + nextIdx];
726 if (mNCandidates > 1) {
727 prop->setTrack(trkWork);
729 int32_t trkltSec = mGeo->GetSector(
tracklets[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].GetDetector());
730 if (trkltSec != GetSector(prop->getAlpha())) {
732 prop->rotate(GetAlphaOfSector(trkltSec));
734 if (!prop->propagateToX(spacePoints[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].getX(), .8f, 2.f)) {
736 GPUWarning(
"Final track propagation for track %i update %i in layer %i failed", iTrk, iUpdate, iLayer);
738 trkWork->setChi2(trkWork->getChi2() + Param().
rec.trd.penaltyChi2);
739 if (trkWork->getIsFindable(iLayer)) {
740 if (trkWork->getNmissingConsecLayers(iLayer) >= Param().
rec.trd.stopTrkAfterNMissLy) {
741 trkWork->setIsStopped();
744 if (iUpdate == 0 && mNCandidates > 1) {
745 *t = mCandidates[2 * iUpdate + nextIdx];
750 pad = mGeo->GetPadPlane(
tracklets[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].GetDetector());
751 float tiltCorrUp = tilt * (spacePoints[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].getZ() - trkWork->getZ());
752 float dyTiltCorr = tilt * trkWork->getTgl() * mGeo->GetCdrHght();
753 float zPosCorrUp = spacePoints[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].getZ() + mRecoParam->getZCorrCoeffNRC() * trkWork->getTgl();
754 zPosCorrUp -= zShiftTrk;
755 float padLength = pad->GetRowSize(
tracklets[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].GetZbin());
756 if (!((trkWork->getSigmaZ2() < (padLength * padLength / 12.f)) && (CAMath::Abs(spacePoints[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].getZ() - trkWork->getZ()) < padLength))) {
764 float yCorrPileUp = 0.f;
765 float yAddErrPileUp2 = 0.f;
766 if (nIdxBCMax - nIdxBCMin >= 2) {
770 float sumCorr2 = 0.f;
773 float slopeFactor =
tracklets[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].GetSlopeFloat() * mGeo->GetPadPlaneWidthIPad(
tracklets[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].GetDetector()) / 4.f;
774 for (int32_t iBC = nIdxBCMin; iBC < nIdxBCMax; iBC++) {
776 float probBC = mRecoParam->getPileUpProbTracklet(deltaBC,
true, (
tracklets[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].GetQ0() != 0), (
tracklets[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].GetQ1() != 0));
777 sumCorr += probBC * slopeFactor * deltaBC;
778 sumCorr2 += probBC * slopeFactor * deltaBC * slopeFactor * deltaBC;
780 if (probBC > maxProb) {
782 yCorrPileUp = -slopeFactor * deltaBC;
785 if (sumProb > 1e-6f) {
786 yAddErrPileUp2 = sumCorr2 / sumProb - 2 * yCorrPileUp * sumCorr / sumProb + yCorrPileUp * yCorrPileUp;
790 const auto currDet =
tracklets[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].GetDetector();
791 int nTrackletsChamber = mTrackletIndexArray[trkltIdxOffset + currDet + 1] - mTrackletIndexArray[trkltIdxOffset + currDet];
793 float trkltPosUp[2] = {spacePoints[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].getY() - tiltCorrUp + yCorrPileUp, zPosCorrUp};
794 float trkltCovUp[3] = {0.f};
795 float angularPull = GetAngularPull(spacePoints[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].getDy() + dyTiltCorr, trkWork->getSnp(), nTrackletsChamber);
796 RecalcTrkltCov(tilt, trkWork->getSnp(), pad->GetRowSize(
tracklets[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].GetZbin()), ((Param().
rec.trd.useAngularPull != 0) ? angularPull : 0.f), nTrackletsChamber, trkltCovUp);
797 trkltCovUp[0] += yAddErrPileUp2;
799#ifdef ENABLE_GPUTRDDEBUG
800 prop->setTrack(&trackNoUp);
801 prop->rotate(GetAlphaOfSector(trkltSec));
803 prop->propagateToX(mR[
tracklets[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].GetDetector()], .8f, 2.f);
804 prop->setTrack(trkWork);
807 if (!wasTrackStored) {
808#ifdef ENABLE_GPUTRDDEBUG
809 mDebug->SetTrackParameterNoUp(trackNoUp, iLayer);
811 mDebug->SetTrackParameter(*trkWork, iLayer);
812 mDebug->SetRawTrackletPosition(spacePoints[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].
getX(), spacePoints[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].
getY(), spacePoints[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].getZ(), iLayer);
813 mDebug->SetCorrectedTrackletPosition(trkltPosUp, iLayer);
814 mDebug->SetTrackletCovariance(trkltCovUp, iLayer);
815 mDebug->SetTrackletProperties(spacePoints[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].getDy(),
tracklets[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].GetDetector(), iLayer);
816 wasTrackStored =
true;
819 if (!prop->update(trkltPosUp, trkltCovUp)) {
821 GPUWarning(
"Failed to update track %i with space point in layer %i", iTrk, iLayer);
823 trkWork->setChi2(trkWork->getChi2() + Param().
rec.trd.penaltyChi2);
824 if (trkWork->getIsFindable(iLayer)) {
825 if (trkWork->getNmissingConsecLayers(iLayer) >= Param().
rec.trd.stopTrkAfterNMissLy) {
826 trkWork->setIsStopped();
829 if (iUpdate == 0 && mNCandidates > 1) {
830 *t = mCandidates[2 * iUpdate + nextIdx];
834 if (!trkWork->CheckNumericalQuality()) {
836 GPUInfo(
"Track %i has invalid covariance matrix. Aborting track following\n", iTrk);
840 trkWork->addTracklet(iLayer, mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId);
841 trkWork->setChi2(mHypothesis[iUpdate + hypothesisIdxOffset].mChi2);
842 trkWork->setIsFindable(iLayer);
843 trkWork->setCollisionId(collisionId);
845 float projZEntry, projYEntry;
847 prop->getPropagatedYZ(trkWork->getX() - mGeo->GetCdrHght(), projYEntry, projZEntry);
853 const auto padrowEntry = pad->GetPadRowNumber(projZEntry);
854 const auto padrowExit = pad->GetPadRowNumber(trkWork->getZ());
855 if (padrowEntry != padrowExit) {
856 trkWork->setIsCrossingNeighbor(iLayer);
857 trkWork->setHasPadrowCrossing();
861 for (int32_t trkltIdx = glbTrkltIdxOffset + mTrackletIndexArray[trkltIdxOffset + currDet]; trkltIdx < glbTrkltIdxOffset + mTrackletIndexArray[trkltIdxOffset + currDet + 1]; ++trkltIdx) {
863 if (mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId == trkltIdx) {
866 if (CAMath::Abs(
tracklets[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].GetZbin() -
tracklets[trkltIdx].GetZbin()) == 1 &&
867 CAMath::Abs(
tracklets[mHypothesis[iUpdate + hypothesisIdxOffset].mTrackletId].GetY() -
tracklets[trkltIdx].GetY()) < 1) {
868 trkWork->setIsCrossingNeighbor(iLayer);
869 trkWork->setHasNeighbor();
873 if (iUpdate == 0 && mNCandidates > 1) {
874 *t = mCandidates[2 * iUpdate + nextIdx];
881 GPUInfo(
"Track %i cannot be followed. Stopped in layer %i", iTrk, iLayer);
892 mDebug->SetTrack(*t);
896 GPUInfo(
"Ended track following for track %i at x=%f with pt=%f. Attached %i tracklets", t->getRefGlobalTrackIdRaw(), t->getX(), t->getPt(), t->getNtracklets());
898 if (nCurrHypothesis > 1) {
899 if (CAMath::Abs(mHypothesis[hypothesisIdxOffset + 1].GetReducedChi2() - mHypothesis[hypothesisIdxOffset].GetReducedChi2()) < Param().
rec.trd.chi2SeparationCut) {
906template <
class TRDTRK,
class PROP>
907GPUd()
void GPUTRDTracker_t<TRDTRK, PROP>::InsertHypothesis(Hypothesis hypo, int32_t& nCurrHypothesis, int32_t idxOffset)
913 if (nCurrHypothesis == 0) {
915 mHypothesis[idxOffset] = hypo;
917 }
else if (nCurrHypothesis > 0 && nCurrHypothesis < mNCandidates) {
919 for (int32_t
i = idxOffset;
i < nCurrHypothesis + idxOffset; ++
i) {
920 if (hypo.GetReducedChi2() < mHypothesis[
i].GetReducedChi2()) {
921 for (int32_t k = nCurrHypothesis + idxOffset; k >
i; --k) {
922 mHypothesis[k] = mHypothesis[k - 1];
924 mHypothesis[
i] = hypo;
929 mHypothesis[nCurrHypothesis + idxOffset] = hypo;
934 int32_t
i = nCurrHypothesis + idxOffset - 1;
935 for (;
i >= idxOffset; --
i) {
936 if (mHypothesis[
i].GetReducedChi2() < hypo.GetReducedChi2()) {
940 if (
i < (nCurrHypothesis + idxOffset - 1)) {
942 for (int32_t k = nCurrHypothesis + idxOffset - 1; k >
i + 1; --k) {
943 mHypothesis[k] = mHypothesis[k - 1];
945 mHypothesis[
i + 1] = hypo;
950template <
class TRDTRK,
class PROP>
961 int32_t sector = GetSector(
alpha);
963 return mGeo->GetDetector(
layer,
stack, sector);
966template <
class TRDTRK,
class PROP>
974 float alpha = mGeo->GetAlpha();
975 float xTmp = t->getX();
977 float yMax = t->getX() * CAMath::Tan(0.5f *
alpha);
978 float alphaCurr = t->getAlpha();
980 if (CAMath::Abs(
y) > 2.f *
yMax) {
982 GPUInfo(
"AdjustSector: Track %i with pT = %f crossing two sector boundaries at x = %f", t->getRefGlobalTrackIdRaw(), t->getPt(), t->getX());
988 while (CAMath::Abs(
y) >
yMax) {
992 int32_t sign = (
y > 0) ? 1 : -1;
993 float alphaNew = alphaCurr +
alpha * sign;
994 if (alphaNew > CAMath::Pi()) {
995 alphaNew -= 2 * CAMath::Pi();
996 }
else if (alphaNew < -CAMath::Pi()) {
997 alphaNew += 2 * CAMath::Pi();
999 if (!prop->rotate(alphaNew)) {
1002 if (!prop->propagateToX(xTmp, .8f, 2.f)) {
1011template <
class TRDTRK,
class PROP>
1018 alpha += 2.f * CAMath::Pi();
1019 }
else if (
alpha >= 2.f * CAMath::Pi()) {
1020 alpha -= 2.f * CAMath::Pi();
1022 return (int32_t)(
alpha * (float)kNSectors / (2.f * CAMath::Pi()));
1025template <
class TRDTRK,
class PROP>
1031 float alpha = 2.0f * CAMath::Pi() / (float)kNSectors * ((
float)sec + 0.5f);
1032 if (
alpha > CAMath::Pi()) {
1033 alpha -= 2 * CAMath::Pi();
1038template <
class TRDTRK,
class PROP>
1039GPUd()
void GPUTRDTracker_t<TRDTRK, PROP>::RecalcTrkltCov(const
float tilt, const
float snp, const
float rowSize, const
float pull, const
int occupancy,
float (&cov)[3])
1045 float t2 = tilt * tilt;
1046 float c2 = 1.f / (1.f + t2);
1047 float sy2 = mRecoParam->getRPhiRes(snp, CAMath::Abs(pull), occupancy);
1048 float sz2 = rowSize * rowSize / 12.f;
1049 cov[0] = c2 * (sy2 + t2 * sz2);
1050 cov[1] = c2 * tilt * (sz2 - sy2);
1051 cov[2] = c2 * (t2 * sy2 + sz2);
1054template <
class TRDTRK,
class PROP>
1055GPUd()
void GPUTRDTracker_t<TRDTRK, PROP>::RecalcTrkltCovDy(const
float tilt, const
float snp, const
float pull, const
int occupancy,
float (&cov)[6])
1057 float t2 = tilt * tilt;
1058 float c2 = 1.f / (1.f + t2);
1059 float sy2 = mRecoParam->getRPhiRes(snp, CAMath::Abs(pull), occupancy);
1060 float sdy2 = mRecoParam->getDyRes(snp, occupancy);
1061 cov[3] = mRecoParam->getCorrYDy() * CAMath::Sqrt(sdy2 * c2);
1062 cov[4] = -tilt * mRecoParam->getCorrYDy() * CAMath::Sqrt(sdy2 * c2);
1066template <
class TRDTRK,
class PROP>
1071 float c00 = cov[2] * cov[5] - cov[4] * cov[4];
1072 float c01 = cov[4] * cov[3] - cov[1] * cov[5];
1073 float c02 = cov[1] * cov[4] - cov[2] * cov[3];
1074 float c11 = cov[5] * cov[0] - cov[3] * cov[3];
1075 float c12 = cov[3] * cov[1] - cov[4] * cov[0];
1076 float c22 = cov[0] * cov[2] - cov[1] * cov[1];
1078 float t0 = CAMath::Abs(cov[0]);
1079 float t1 = CAMath::Abs(cov[1]);
1080 float t2 = CAMath::Abs(cov[3]);
1088 det = c12 * c01 - c11 * c02;
1091 det = c11 * c22 - c12 * c12;
1093 }
else if (t2 >=
t1) {
1095 det = c12 * c01 - c11 * c02;
1098 det = c02 * c12 - c01 * c22;
1101 if (det == 0 || tmp == 0) {
1105 float s = tmp / det;
1117template <
class TRDTRK,
class PROP>
1118GPUd() float
GPUTRDTracker_t<TRDTRK, PROP>::GetAngularPull(
float dYtracklet,
float snp,
int occupancy)
const
1120 float dYtrack = mRecoParam->convertAngleToDy(snp);
1121 float dYresolution = mRecoParam->getDyRes(snp, occupancy);
1122 if (dYresolution < 1e-6f) {
1125 return (dYtracklet - dYtrack) / CAMath::Sqrt(dYresolution);
1128template <
class TRDTRK,
class PROP>
1132 int32_t trkltIdxOffset = collisionId * (kNChambers + 1);
1133 int nTrackletsChamber = mTrackletIndexArray[trkltIdxOffset + detector + 1] - mTrackletIndexArray[trkltIdxOffset + detector];
1134 return nTrackletsChamber;
1137template <
class TRDTRK,
class PROP>
1138GPUd()
void GPUTRDTracker_t<TRDTRK, PROP>::FindChambersInRoad(const TRDTRK* t, const
float roadY, const
float roadZ, const int32_t iLayer, int32_t* det, const
float zMax, const
float alpha, const
float zShiftTrk)
const
1146 const float yMax = CAMath::Abs(mGeo->GetCol0(iLayer));
1147 float zTrk = t->getZ() + zShiftTrk;
1149 int32_t currStack = mGeo->GetStack(zTrk, iLayer);
1150 int32_t currSec = GetSector(
alpha);
1155 if (currStack > -1) {
1157 currDet = mGeo->GetDetector(iLayer, currStack, currSec);
1158 det[nDets++] = currDet;
1160 int32_t lastPadRow = mGeo->GetRowMax(iLayer, currStack, 0);
1161 float zCenter = pp->GetRowPos(lastPadRow / 2);
1162 if ((zTrk + roadZ) > pp->GetRow0() || (zTrk - roadZ) < pp->GetRowEnd()) {
1163 int32_t addStack = zTrk > zCenter ? currStack - 1 : currStack + 1;
1164 if (addStack < kNStacks && addStack > -1) {
1165 det[nDets++] = mGeo->GetDetector(iLayer, addStack, currSec);
1169 if (CAMath::Abs(zTrk) >
zMax) {
1172 currDet = mGeo->GetDetector(iLayer, 0, currSec);
1174 currDet = mGeo->GetDetector(iLayer, kNStacks - 1, currSec);
1176 det[nDets++] = currDet;
1177 currStack = mGeo->GetStack(currDet);
1181 currDet = GetDetectorNumber(zTrk + 4.0f,
alpha, iLayer);
1182 if (currDet != -1) {
1183 det[nDets++] = currDet;
1185 currDet = GetDetectorNumber(zTrk - 4.0f,
alpha, iLayer);
1186 if (currDet != -1) {
1187 det[nDets++] = currDet;
1192 if ((CAMath::Abs(t->getY()) + roadY) >
yMax) {
1193 const int32_t nStacksToSearch = nDets;
1195 if (t->getY() > 0) {
1196 newSec = (currSec + 1) % kNSectors;
1198 newSec = (currSec > 0) ? currSec - 1 : kNSectors - 1;
1200 for (int32_t idx = 0;
idx < nStacksToSearch; ++
idx) {
1201 currStack = mGeo->GetStack(det[idx]);
1202 det[nDets++] = mGeo->GetDetector(iLayer, currStack, newSec);
1206 for (int32_t iDet = 0; iDet < nDets; iDet++) {
1207 if (!mGeo->ChamberInGeometry(det[iDet])) {
1213template <
class TRDTRK,
class PROP>
1214GPUd() bool
GPUTRDTracker_t<TRDTRK, PROP>::IsGeoFindable(const TRDTRK* t, const int32_t
layer, const
float alpha, const
float zShiftTrk)
const
1221 float zTrk = t->getZ() + zShiftTrk;
1223 int32_t det = GetDetectorNumber(zTrk,
alpha,
layer);
1231 if (!mGeo->ChamberInGeometry(det)) {
1236 float yMax = pp->GetColEnd();
1237 float zMax = pp->GetRow0();
1238 float zMin = pp->GetRowEnd();
1244 if (
yMax - CAMath::Abs(t->getY()) < epsY) {
1248 if (!((zTrk >
zMin + epsZ) && (zTrk <
zMax - epsZ))) {
1255#ifndef GPUCA_GPUCODE