139 const EventContext& ctx = Gaudi::Hive::currentContext();
159 surfacePhi *= (
m_flatDist->shoot() > 0.5 ) ? -1. : 1.;
160 double startX = startR*
cos(surfacePhi);
161 double startY = startR*
sin(surfacePhi);
166 alphaZ *= (
m_flatDist->shoot() > 0.5 ) ? -1. : 1.;
201 auto estimationParameters =
m_propagator->propagateParameters(ctx,
207 if (!estimationParameters) {
208 ATH_MSG_VERBOSE(
"Estimation of intersection did not work - skip event !" );
209 return StatusCode::SUCCESS;
214 const Amg::Vector3D& estimatedPosition = estimationParameters->position();
216 double estimationX = estimatedPosition.x();
217 double estimationY = estimatedPosition.y();
218 double estimationZ = estimatedPosition.z();
220 double estimationPhi = estimatedPosition.phi();
221 double estimationTheta = estimatedPosition.theta();
226 rotateTrans *= (
m_flatDist->shoot() > 0.5 ) ? -1. : 1.;
232 Amg::Vector3D radialVector(estimatedPosition.x(), estimatedPosition.y(), 0.);
236 Amg::Vector3D surfaceXdirection(surfaceYdirection.cross(surfaceZdirection));
239 surfaceRotation.col(0) = surfaceXdirection;
240 surfaceRotation.col(1) = surfaceYdirection;
241 surfaceRotation.col(2) = surfaceZdirection;
258 std::optional<Trk::TransportJacobian> optTransportJacobian{};
259 AmgMatrix(5,5) testMatrix; testMatrix.setZero();
260 Trk::TransportJacobian currentStepJacobian(testMatrix);
261 double pathLimit = -1.;
269 optTransportJacobian,
273 if (trackParameters && optTransportJacobian){
275 unsigned int recStep = 0;
276 const auto& transportJacobian = (*optTransportJacobian);
282 m_loc1loc1[recStep] = (transportJacobian)(0,0);
283 m_loc1loc2[recStep] = (transportJacobian)(0,1);
284 m_loc1phi[recStep] = (transportJacobian)(0,2);
286 m_loc1qop[recStep] = (transportJacobian)(0,4);
289 m_loc2loc1[recStep] = (transportJacobian)(1,0);
290 m_loc2loc2[recStep] = (transportJacobian)(1,1);
291 m_loc2phi[recStep] = (transportJacobian)(1,2);
293 m_loc2qop[recStep] = (transportJacobian)(1,4);
296 m_philoc1[recStep] = (transportJacobian)(2,0);
297 m_philoc2[recStep] = (transportJacobian)(2,1);
298 m_phiphi[recStep] = (transportJacobian)(2,2);
299 m_phitheta[recStep] = (transportJacobian)(2,3);
300 m_phiqop[recStep] = (transportJacobian)(2,4);
305 m_thetaphi[recStep] = (transportJacobian)(3,2);
307 m_thetaqop[recStep] = (transportJacobian)(3,4);
310 m_qoploc1[recStep] = (transportJacobian)(4,0);
311 m_qoploc2[recStep] = (transportJacobian)(4,1);
312 m_qopphi[recStep] = (transportJacobian)(4,2);
313 m_qoptheta[recStep] = (transportJacobian)(4,3);
314 m_qopqop[recStep] = (transportJacobian)(4,4);
342 auto endLoc1Minus =
m_propagator->propagateParameters(ctx,
350 auto endLoc1Plus =
m_propagator->propagateParameters(ctx,
357 auto endLoc2Minus =
m_propagator->propagateParameters(ctx,
364 auto endLoc2Plus =
m_propagator->propagateParameters(ctx,
371 auto endPhiMinus =
m_propagator->propagateParameters(ctx,
378 auto endPhiPlus =
m_propagator->propagateParameters(ctx,
385 auto endThetaMinus =
m_propagator->propagateParameters(ctx,
392 auto endThetaPlus =
m_propagator->propagateParameters(ctx,
399 auto endQopMinus =
m_propagator->propagateParameters(ctx,
406 auto endQopPlus =
m_propagator->propagateParameters(ctx,
424 const Amg::VectorX& endLoc1MinusPar = endLoc1Minus->parameters();
425 const Amg::VectorX& endLoc1PlusPar = endLoc1Plus->parameters();
427 const Amg::VectorX& endLoc2MinusPar = endLoc2Minus->parameters();
428 const Amg::VectorX& endLoc2PlusPar = endLoc2Plus->parameters();
430 const Amg::VectorX& endPhiMinusPar = endPhiMinus->parameters();
431 const Amg::VectorX& endPhiPlusPar = endPhiPlus->parameters();
433 const Amg::VectorX& endThetaMinusPar = endThetaMinus->parameters();
434 const Amg::VectorX& endThetaPlusPar = endThetaPlus->parameters();
436 const Amg::VectorX& endQopMinusPar = endQopMinus->parameters();
437 const Amg::VectorX& endQopPlusPar = endQopPlus->parameters();
440 Amg::VectorX endLoc1Diff(endLoc1PlusPar-endLoc1MinusPar);
441 Amg::VectorX endLoc2Diff(endLoc2PlusPar-endLoc2MinusPar);
443 Amg::VectorX endThetaDiff(endThetaPlusPar-endThetaMinusPar);
452 m_loc1loc1[recStep] = currentStepJacobian(0,0);
453 m_loc1loc2[recStep] = currentStepJacobian(0,1);
454 m_loc1phi[recStep] = currentStepJacobian(0,2);
456 m_loc1qop[recStep] = currentStepJacobian(0,4);
465 m_loc2loc1[recStep] = currentStepJacobian(1,0);
466 m_loc2loc2[recStep] = currentStepJacobian(1,1);
467 m_loc2phi[recStep] = currentStepJacobian(1,2);
469 m_loc2qop[recStep] = currentStepJacobian(1,4);
478 m_philoc1[recStep] = currentStepJacobian(2,0);
479 m_philoc2[recStep] = currentStepJacobian(2,1);
480 m_phiphi[recStep] = currentStepJacobian(2,2);
481 m_phitheta[recStep] = currentStepJacobian(2,3);
482 m_phiqop[recStep] = currentStepJacobian(2,4);
493 m_thetaphi[recStep] = currentStepJacobian(3,2);
495 m_thetaqop[recStep] = currentStepJacobian(3,4);
504 m_qoploc1[recStep] = currentStepJacobian(4,0);
505 m_qoploc2[recStep] = currentStepJacobian(4,1);
506 m_qopphi[recStep] = currentStepJacobian(4,2);
507 m_qoptheta[recStep] = currentStepJacobian(4,3);
508 m_qopqop[recStep] = currentStepJacobian(4,4);
511 ATH_MSG_DEBUG(
"Current TransportJacobian : " << currentStepJacobian );
581 currentStepJacobian(0,0)=
m_loc1loc1[recStep];
582 currentStepJacobian(0,1)=
m_loc1loc2[recStep];
583 currentStepJacobian(0,2)=
m_loc1phi[recStep];
585 currentStepJacobian(0,4)=
m_loc1qop[recStep];
587 currentStepJacobian(1,0)=
m_loc2loc1[recStep];
588 currentStepJacobian(1,1)=
m_loc2loc2[recStep];
589 currentStepJacobian(1,2)=
m_loc2phi[recStep];
591 currentStepJacobian(1,4)=
m_loc2qop[recStep];
593 currentStepJacobian(2,0)=
m_philoc1[recStep];
594 currentStepJacobian(2,1)=
m_philoc2[recStep];
595 currentStepJacobian(2,2)=
m_phiphi[recStep];
596 currentStepJacobian(2,3)=
m_phitheta[recStep];
597 currentStepJacobian(2,4)=
m_phiqop[recStep];
601 currentStepJacobian(3,2)=
m_thetaphi[recStep];
603 currentStepJacobian(3,4)=
m_thetaqop[recStep];
605 currentStepJacobian(4,0)=
m_qoploc1[recStep];
606 currentStepJacobian(4,1)=
m_qoploc2[recStep];
607 currentStepJacobian(4,2)=
m_qopphi[recStep];
608 currentStepJacobian(4,3)=
m_qoptheta[recStep];
609 currentStepJacobian(4,4)=
m_qopqop[recStep];
613 ATH_MSG_DEBUG(
"Interpolated TransportJacobian : " << currentStepJacobian );
618 TransportJacobian diffMatrix(transportJacobian-currentStepJacobian);
620 ATH_MSG_VERBOSE(
"Absolute Differences of the TransportJacobian : " << diffMatrix );
641 m_phiphi[recStep] = diffMatrix(2,2);
643 m_phiqop[recStep] = diffMatrix(2,4);
655 m_qopphi[recStep] = diffMatrix(4,2);
657 m_qopqop[recStep] = diffMatrix(4,4);
705 m_loc1loc1[recStep] = std::abs((transportJacobian)(0,0)) > 1
e-50 ? diffMatrix(0,0)/((transportJacobian)(0,0)) : 0.;
706 m_loc1loc2[recStep] = std::abs((transportJacobian)(0,1)) > 1
e-50 ? diffMatrix(0,1)/((transportJacobian)(0,1)) : 0.;
707 m_loc1phi[recStep] = std::abs((transportJacobian)(0,2)) > 1
e-50 ? diffMatrix(0,2)/((transportJacobian)(0,2)) : 0.;
708 m_loc1theta[recStep] = std::abs((transportJacobian)(0,3)) > 1
e-50 ? diffMatrix(0,3)/((transportJacobian)(0,3)) : 0.;
709 m_loc1qop[recStep] = std::abs((transportJacobian)(0,4)) > 1
e-50 ? diffMatrix(0,4)/((transportJacobian)(0,4)) : 0.;
712 m_loc2loc1[recStep] = std::abs((transportJacobian)(1,0)) > 1
e-50 ? diffMatrix(1,0)/((transportJacobian)(1,0)) : 0.;
713 m_loc2loc2[recStep] = std::abs((transportJacobian)(1,1)) > 1
e-50 ? diffMatrix(1,1)/((transportJacobian)(1,1)) : 0.;
714 m_loc2phi[recStep] = std::abs((transportJacobian)(1,2)) > 1
e-50 ? diffMatrix(1,2)/((transportJacobian)(1,2)) : 0.;
715 m_loc2theta[recStep] = std::abs((transportJacobian)(1,3)) > 1
e-50 ? diffMatrix(1,3)/((transportJacobian)(1,3)) : 0.;
716 m_loc2qop[recStep] = std::abs((transportJacobian)(1,4)) > 1
e-50 ? diffMatrix(1,4)/((transportJacobian)(1,4)) : 0.;
719 m_philoc1[recStep] = std::abs((transportJacobian)(2,0)) > 1
e-50 ? diffMatrix(2,0)/((transportJacobian)(2,0)) : 0.;
720 m_philoc2[recStep] = std::abs((transportJacobian)(2,1)) > 1
e-50 ? diffMatrix(2,1)/((transportJacobian)(2,1)) : 0.;
721 m_phiphi[recStep] = std::abs((transportJacobian)(2,2)) > 1
e-50 ? diffMatrix(2,2)/((transportJacobian)(2,2)) : 0.;
722 m_phitheta[recStep] = std::abs((transportJacobian)(2,3)) > 1
e-50 ? diffMatrix(2,3)/((transportJacobian)(2,3)) : 0.;
723 m_phiqop[recStep] = std::abs((transportJacobian)(2,4)) > 1
e-50 ? diffMatrix(2,4)/((transportJacobian)(2,4)) : 0.;
726 m_thetaloc1[recStep] = std::abs((transportJacobian)(3,0)) > 1
e-50 ? diffMatrix(3,0)/((transportJacobian)(3,0)) : 0.;
727 m_thetaloc2[recStep] = std::abs((transportJacobian)(3,1)) > 1
e-50 ? diffMatrix(3,1)/((transportJacobian)(3,1)) : 0.;
728 m_thetaphi[recStep] = std::abs((transportJacobian)(3,2)) > 1
e-50 ? diffMatrix(3,2)/((transportJacobian)(3,2)) : 0.;
729 m_thetatheta[recStep] = std::abs((transportJacobian)(3,3)) > 1
e-50 ? diffMatrix(3,3)/((transportJacobian)(3,3)) : 0.;
730 m_thetaqop[recStep] = std::abs((transportJacobian)(3,4)) > 1
e-50 ? diffMatrix(3,4)/((transportJacobian)(3,4)) : 0.;
733 m_qoploc1[recStep] = std::abs((transportJacobian)(4,0)) > 1
e-50 ? diffMatrix(4,0)/((transportJacobian)(4,0)) : 0.;
734 m_qoploc2[recStep] = std::abs((transportJacobian)(4,1)) > 1
e-50 ? diffMatrix(4,1)/((transportJacobian)(4,1)) : 0.;
735 m_qopphi[recStep] = std::abs((transportJacobian)(4,2)) > 1
e-50 ? diffMatrix(4,2)/((transportJacobian)(4,2)) : 0.;
736 m_qoptheta[recStep] = std::abs((transportJacobian)(4,3)) > 1
e-50 ? diffMatrix(4,3)/((transportJacobian)(4,3)) : 0.;
737 m_qopqop[recStep] = std::abs((transportJacobian)(4,4)) > 1
e-50 ? diffMatrix(4,4)/((transportJacobian)(4,4)) : 0.;
784 return StatusCode::SUCCESS;