215 CADEBUG(int32_t ii; printf(
"\nRefitting track\n"));
216 typename internal::refitTrackTypes<S>::propagator prop;
218 float TrackParCovChi2 = 0.f;
219 convertTrack<S, T, typename internal::refitTrackTypes<S>::propagator>(trk,
trkX, prop, &TrackParCovChi2);
222 if constexpr (std::is_same_v<T, GPUTPCGMMergedTrack>) {
225 int32_t
leg = mPtrackHits[
trkX.FirstClusterRef() +
trkX.NClusters() - 1].leg;
226 for (int32_t
i =
trkX.NClusters() - 2;
i > 0;
i--) {
227 if (mPtrackHits[
trkX.FirstClusterRef() +
i].leg !=
leg) {
233 tOffset =
trkX.GetParam().GetTZOffset();
234 }
else if constexpr (std::is_same_v<T, TrackTPC>) {
236 tOffset =
trkX.getTime0();
237 }
else if constexpr (std::is_same_v<T, TrackParCovWithArgs>) {
239 tOffset =
trkX.time0;
241 static_assert(
"Invalid template");
243 if constexpr (std::is_same_v<S, GPUTPCGMTrackParam>) {
244 CADEBUG(printf(
"\t%21sInit Alpha %8.3f , X %8.3f - Y %8.3f, Z %8.3f - QPt %7.2f (%7.2f), SP %5.2f (%5.2f) --- Cov sY %8.3f sZ %8.3f sSP %8.3f sPt %8.3f\n",
"", prop.GetAlpha(), trk.GetX(), trk.Par()[0], trk.Par()[1], trk.Par()[4], prop.GetQPt0(), trk.Par()[2], prop.GetSinPhi0(), sqrtf(trk.Cov()[0]), sqrtf(trk.Cov()[2]), sqrtf(trk.Cov()[5]), sqrtf(trk.Cov()[14])));
247 int32_t direction = outward ? -1 : 1;
251 uint8_t sector = 255,
row = 255;
252 int32_t lastSector = -1, currentSector = -1, currentRow = -1;
253 int16_t clusterState = 0, nextState = 0;
255 float sumInvSqrtCharge = 0.f;
256 int32_t nAvgCharge = 0;
258 for (int32_t
i =
start;
i != stop;
i += cl ? 0 : direction) {
260 float time = 0.f, invCharge = 0.f, invSqrtCharge = 0.f;
265 if constexpr (std::is_same_v<T, GPUTPCGMMergedTrack>) {
266 const auto& hit = mPtrackHits[
trkX.FirstClusterRef() +
i];
267 cl = &mPclusterNative->clustersLinear[hit.num];
270 if (
i + direction != stop) {
278 nextState = mPclusterState[hit.num];
279 }
else if constexpr (std::is_same_v<T, TrackTPC>) {
280 cl = &
trkX.getCluster(mPtrackHitReferences,
i, *mPclusterNative, sector,
row);
281 nextState = mPclusterState[cl - mPclusterNative->clustersLinear];
282 }
else if constexpr (std::is_same_v<T, TrackParCovWithArgs>) {
283 cl = &TrackTPC::getCluster(mPtrackHitReferences,
i, *mPclusterNative, sector,
row,
trkX.clusRef);
284 nextState = mPclusterState[cl - mPclusterNative->clustersLinear];
286 static_assert(
"Invalid template");
289 if (
clusters == 0 || (
row == currentRow && sector == currentSector)) {
296 mPfastTransformHelper->Transform(sector,
row, cl->getPad(), cl->getTime(),
x,
y,
z, tOffset);
297 CADEBUG(printf(
"\tHit %3d/%3d Row %3d: Cluster Alpha %8.3f %3d, X %8.3f - Y %8.3f, Z %8.3f - State %d\n", ii,
count,
row, mPparam->Alpha(sector), (int32_t)sector,
x,
y,
z, (int32_t)nextState));
299 currentSector = sector;
301 clusterState = nextState;
302 time = cl->getTime();
303 invSqrtCharge = CAMath::InvSqrt(cl->
qMax);
304 invCharge = (1.f / cl->
qMax);
307 mPfastTransformHelper->Transform(sector,
row, cl->getPad(), cl->getTime(), xx, yy, zz, tOffset);
308 CADEBUG(printf(
"\tHit %3d/%3d Row %3d: Cluster Alpha %8.3f %3d, X %8.3f - Y %8.3f, Z %8.3f - State %d\n", ii,
count,
row, mPparam->Alpha(sector), (int32_t)sector, xx, yy, zz, (int32_t)nextState));
313 clusterState |= nextState;
317 if (
i + direction != stop) {
330 CADEBUG(printf(
"\tMerged Hit Row %3d: Cluster Alpha %8.3f %3d, X %8.3f - Y %8.3f, Z %8.3f - State %d\n",
row, mPparam->Alpha(sector), (int32_t)sector,
x,
y,
z, (int32_t)clusterState));
333 float invAvgCharge = (sumInvSqrtCharge += invSqrtCharge) / ++nAvgCharge;
334 invAvgCharge *= invAvgCharge;
336 if constexpr (std::is_same_v<S, GPUTPCGMTrackParam>) {
337 if (prop.PropagateToXAlpha(
x, mPparam->Alpha(currentSector), !outward)) {
342 trk.ResetCovariance();
343 }
else if (lastSector != -1 && (lastSector < 18) != (sector < 18)) {
344 if (mPparam->rec.tpc.addErrorsCECrossing) {
345 if (mPparam->rec.tpc.addErrorsCECrossing >= 2) {
346 trk.AddCovDiagErrorsWithCorrelations(mPparam->rec.tpc.errorsCECrossing);
348 trk.AddCovDiagErrors(mPparam->rec.tpc.errorsCECrossing);
350 }
else if (trk.Cov()[2] < 0.5f) {
354 CADEBUG(printf(
"\t%21sPropaga Alpha %8.3f , X %8.3f - Y %8.3f, Z %8.3f - QPt %7.2f (%7.2f), SP %5.2f (%5.2f) --- Res %8.3f %8.3f --- Cov sY %8.3f sZ %8.3f sSP %8.3f sPt %8.3f - YPt %8.3f\n",
"", prop.GetAlpha(),
x, trk.Par()[0], trk.Par()[1], trk.Par()[4], prop.GetQPt0(), trk.Par()[2], prop.GetSinPhi0(), trk.Par()[0] -
y, trk.Par()[1] -
z, sqrtf(trk.Cov()[0]), sqrtf(trk.Cov()[2]), sqrtf(trk.Cov()[5]), sqrtf(trk.Cov()[14]), trk.Cov()[10]));
356 if (prop.Update(
y,
z,
row, *mPparam, clusterState, 0,
nullptr,
true, sector,
time, invAvgCharge, invCharge)) {
360 trk.ConstrainSinPhi();
361 CADEBUG(printf(
"\t%21sFit Alpha %8.3f , X %8.3f - Y %8.3f, Z %8.3f - QPt %7.2f (%7.2f), SP %5.2f (%5.2f), DzDs %5.2f %16s --- Cov sY %8.3f sZ %8.3f sSP %8.3f sPt %8.3f - YPt %8.3f\n",
"", prop.GetAlpha(),
x, trk.Par()[0], trk.Par()[1], trk.Par()[4], prop.GetQPt0(), trk.Par()[2], prop.GetSinPhi0(), trk.Par()[3],
"", sqrtf(trk.Cov()[0]), sqrtf(trk.Cov()[2]), sqrtf(trk.Cov()[5]), sqrtf(trk.Cov()[14]), trk.Cov()[10]));
362 }
else if constexpr (std::is_same_v<S, TrackParCov>) {
363 if (!trk.rotate(mPparam->Alpha(currentSector))) {
371 if (lastSector != -1 && (lastSector < 18) != (sector < 18)) {
372 if (mPparam->rec.tpc.addErrorsCECrossing) {
373 trk.updateCov(mPparam->rec.tpc.errorsCECrossing, mPparam->rec.tpc.addErrorsCECrossing >= 2);
374 }
else if (trk.getCov()[2] < 0.5f) {
379 trk.resetCovariance();
380 float bzkG = prop->getNominalBz(), qptB5Scale = CAMath::Abs(bzkG) > 0.1f ? CAMath::Abs(bzkG) / 5.006680f : 1.f;
381 float q2pt2 = trk.getQ2Pt() * trk.getQ2Pt(), q2pt2Wgh = q2pt2 * qptB5Scale * qptB5Scale;
382 float err2 = (100.f + q2pt2Wgh) / (1.f + q2pt2Wgh) * q2pt2;
383 trk.setCov(err2, 14);
384 TrackParCovChi2 = 0.f;
386 CADEBUG(printf(
"\t%21sPropaga Alpha %8.3f , X %8.3f - Y %8.3f, Z %8.3f - QPt %7.2f (%7.2f), SP %5.2f (%5.2f) --- Res %8.3f %8.3f --- Cov sY %8.3f sZ %8.3f sSP %8.3f sPt %8.3f - YPt %8.3f\n",
"", trk.getAlpha(),
x, trk.getParams()[0], trk.getParams()[1], trk.getParams()[4], trk.getParams()[4], trk.getParams()[2], trk.getParams()[2], trk.getParams()[0] -
y, trk.getParams()[1] -
z, sqrtf(trk.getCov()[0]), sqrtf(trk.getCov()[2]), sqrtf(trk.getCov()[5]), sqrtf(trk.getCov()[14]), trk.getCov()[10]));
389 GPUTPCGMPropagator::GetErr2(
c[0],
c[2], *mPparam, getPar(trk)[2], getPar(trk)[3],
z,
x,
y, currentRow, clusterState, sector,
time, invAvgCharge, invCharge,
false);
390 TrackParCovChi2 += trk.getPredictedChi2(p,
c);
391 if (!trk.update(p,
c)) {
395 CADEBUG(printf(
"\t%21sFit Alpha %8.3f , X %8.3f - Y %8.3f, Z %8.3f - QPt %7.2f (%7.2f), SP %5.2f (%5.2f), DzDs %5.2f %16s --- Cov sY %8.3f sZ %8.3f sSP %8.3f sPt %8.3f - YPt %8.3f\n",
"", trk.getAlpha(),
x, trk.getParams()[0], trk.getParams()[1], trk.getParams()[4], trk.getParams()[4], trk.getParams()[2], trk.getParams()[2], trk.getParams()[3],
"", sqrtf(trk.getCov()[0]), sqrtf(trk.getCov()[2]), sqrtf(trk.getCov()[5]), sqrtf(trk.getCov()[14]), trk.getCov()[10]));
397 static_assert(
"Invalid template");
402 if constexpr (std::is_same_v<S, GPUTPCGMTrackParam>) {
403 float alpha = prop.GetAlpha();
404 trk.MoveToReference(prop, *mPparam,
alpha);
405 trk.NormalizeAlpha(
alpha);
406 prop.SetAlpha(
alpha);
407 }
else if constexpr (std::is_same_v<S, TrackParCov>) {
408 static constexpr float kDeg2Rad = M_PI / 180.f;
409 static constexpr float kSectAngle = 2 * M_PI / 18.f;
410 if (mPparam->rec.tpc.trackReferenceX <= 500) {
411 if (prop->PropagateToXBxByBz(trk, mPparam->rec.tpc.trackReferenceX)) {
412 if (CAMath::Abs(trk.getY()) > trk.getX() * CAMath::Tan(kSectAngle / 2.f)) {
413 float newAlpha = trk.getAlpha() + CAMath::Round(CAMath::ATan2(trk.getY(), trk.getX()) / kDeg2Rad / 20.f) * kSectAngle;
414 GPUTPCGMTrackParam::NormalizeAlpha(newAlpha);
415 trk.rotate(newAlpha) && prop->PropagateToXBxByBz(trk, mPparam->rec.tpc.trackReferenceX);
420 static_assert(
"Invalid template");
423 convertTrack<T, S, typename internal::refitTrackTypes<S>::propagator>(
trkX, trk, prop, &TrackParCovChi2);