File indexing completed on 2026-11-20 09:26:07
0001
0002
0003
0004
0005
0006
0007
0008
0009 #include "Acts/Vertexing/NumericalTrackLinearizer.hpp"
0010
0011 #include "Acts/MagneticField/MagneticFieldQuery.hpp"
0012 #include "Acts/Propagator/PropagatorOptions.hpp"
0013 #include "Acts/Propagator/detail/DirectionToSurface.hpp"
0014 #include "Acts/Utilities/UnitVectors.hpp"
0015 #include "Acts/Vertexing/LinearizerTrackParameters.hpp"
0016
0017 #include <numbers>
0018
0019 Acts::Result<Acts::LinearizedTrack>
0020 Acts::NumericalTrackLinearizer::linearizeTrack(
0021 const BoundTrackParameters& params, double linPointTime,
0022 const Surface& perigeeSurface, const GeometryContext& gctx,
0023 MagneticFieldQuery& fieldQuery) const {
0024
0025 PropagatorPlainOptions pOptions(gctx, fieldQuery.context());
0026
0027
0028
0029 pOptions.surfaceTolerance = m_cfg.targetTolerance;
0030
0031 pOptions.direction = detail::directionToSurface(
0032 gctx, perigeeSurface, params.position(gctx), params.direction());
0033
0034
0035 auto result =
0036 m_cfg.propagator->propagateToSurface(params, perigeeSurface, pOptions);
0037 if (!result.ok()) {
0038 return result.error();
0039 }
0040
0041
0042 auto endParams = *result;
0043 BoundVector perigeeParams = endParams.parameters();
0044
0045
0046 BoundMatrix parCovarianceAtPCA = endParams.covariance().value();
0047 BoundMatrix weightAtPCA = parCovarianceAtPCA.inverse();
0048
0049
0050
0051
0052
0053
0054
0055
0056 Acts::Vector<eLinSize> paramVec;
0057
0058
0059
0060
0061 Vector4 pca;
0062 Vector3 momentumAtPCA;
0063
0064
0065 {
0066 Vector3 globalCoords = endParams.position(gctx);
0067 double globalTime = endParams.time();
0068 double phi = perigeeParams(BoundIndices::eBoundPhi);
0069 double theta = perigeeParams(BoundIndices::eBoundTheta);
0070 double qOvP = perigeeParams(BoundIndices::eBoundQOverP);
0071
0072 paramVec.head<3>() = globalCoords;
0073 paramVec[eLinTime] = globalTime;
0074 paramVec[eLinPhi] = phi;
0075 paramVec[eLinTheta] = theta;
0076 paramVec[eLinQOverP] = qOvP;
0077 pca.head<3>() = globalCoords;
0078 pca[eTime] = globalTime;
0079 momentumAtPCA << phi, theta, qOvP;
0080 }
0081
0082
0083 Matrix<eBoundSize, eLinSize> completeJacobian =
0084 Matrix<eBoundSize, eLinSize>::Zero(eBoundSize, eLinSize);
0085
0086
0087 BoundVector newPerigeeParams;
0088
0089
0090 if (paramVec(eLinTheta) + m_cfg.delta > std::numbers::pi) {
0091 ACTS_ERROR(
0092 "Wiggled theta outside range, choose a smaller wiggle (i.e., delta)! "
0093 "You might need to decrease targetTolerance as well.");
0094 }
0095
0096
0097
0098
0099 for (unsigned int i = 0; i < eLinSize; i++) {
0100 Acts::Vector<eLinSize> paramVecCopy = paramVec;
0101
0102 paramVecCopy(i) += m_cfg.delta;
0103
0104
0105
0106
0107 Vector3 wiggledDir = makeDirectionFromPhiTheta(paramVecCopy(eLinPhi),
0108 paramVecCopy(eLinTheta));
0109
0110 BoundTrackParameters wiggledCurvilinearParams =
0111 BoundTrackParameters::createCurvilinear(
0112 paramVecCopy.template head<eLinPosSize>(), wiggledDir,
0113 paramVecCopy(eLinQOverP), std::nullopt, ParticleHypothesis::pion());
0114
0115
0116 pOptions.direction = detail::directionToSurface(
0117 gctx, perigeeSurface, paramVecCopy.template head<3>(), wiggledDir);
0118
0119
0120 auto newResult = m_cfg.propagator->propagateToSurface(
0121 wiggledCurvilinearParams, perigeeSurface, pOptions);
0122 if (!newResult.ok()) {
0123 return newResult.error();
0124 }
0125 newPerigeeParams = newResult->parameters();
0126
0127
0128 completeJacobian.array().col(i) =
0129 (newPerigeeParams - perigeeParams) / m_cfg.delta;
0130
0131
0132 completeJacobian(eLinPhi, i) =
0133 Acts::detail::difference_periodic(newPerigeeParams(eLinPhi),
0134 perigeeParams(eLinPhi),
0135 2 * std::numbers::pi) /
0136 m_cfg.delta;
0137 }
0138
0139
0140 Matrix<eBoundSize, eLinPosSize> positionJacobian =
0141 completeJacobian.block<eBoundSize, eLinPosSize>(0, 0);
0142 Matrix<eBoundSize, eLinMomSize> momentumJacobian =
0143 completeJacobian.block<eBoundSize, eLinMomSize>(0, eLinPosSize);
0144
0145
0146 BoundVector constTerm =
0147 perigeeParams - positionJacobian * pca - momentumJacobian * momentumAtPCA;
0148
0149 Vector4 linPoint;
0150 linPoint.head<3>() = perigeeSurface.center(gctx);
0151 linPoint[3] = linPointTime;
0152
0153 return LinearizedTrack(perigeeParams, parCovarianceAtPCA, weightAtPCA,
0154 linPoint, positionJacobian, momentumJacobian, pca,
0155 momentumAtPCA, constTerm);
0156 }