10 #include <tracking/trackFindingCDC/geometry/UncertainParameters.icc.h>
12 #include <tracking/trackFindingCDC/geometry/HelixParameters.h>
14 #include <tracking/trackFindingCDC/numerics/CovarianceMatrixUtil.h>
15 #include <tracking/trackFindingCDC/numerics/ParameterVectorUtil.h>
17 #include <tracking/trackFindingCDC/numerics/Angle.h>
20 using namespace TrackFindingCDC;
31 using namespace NHelixParameterIndices;
32 return getSubParameterVector<PerigeeUtil::ParameterVector, c_Curv>(helixPar);
37 using namespace NHelixParameterIndices;
38 return getSubParameterVector<SZUtil::ParameterVector, c_TanL>(helixPar);
50 using namespace NHelixParameterIndices;
51 return getSubCovarianceMatrix<PerigeeUtil::CovarianceMatrix, c_Curv>(helixCov);
56 using namespace NHelixParameterIndices;
57 return getSubCovarianceMatrix<SZUtil::CovarianceMatrix, c_TanL>(helixCov);
79 using namespace NHelixParameterIndices;
93 avgPar = relAvgPar + refPar;
100 const PerigeeCovariance& fromCov,
101 const PerigeeHelixAmbiguity& fromAmbiguity,
102 const HelixParameters& toPar,
103 const HelixCovariance& toCov,
104 HelixParameters& avgPar,
105 HelixCovariance& avgCov)
107 auto toAmbiguity = JacobianMatrixUtil::identity<5>();
109 using namespace NPerigeeParameterIndices;
110 PerigeeParameters refPar = (fromPar + toPar.head<3>()) / 2.0;
113 HelixParameters refHelixPar =
stack(refPar, toPar.tail<2>());
115 PerigeeParameters relFromPar = fromPar - refPar;
118 HelixParameters relToPar = toPar - refHelixPar;
121 HelixParameters relAvgPar;
133 avgPar = relAvgPar + refHelixPar;
140 const PerigeeCovariance& fromCov,
141 const PerigeeHelixAmbiguity& fromAmbiguity,
142 const PerigeeParameters& toPar,
143 const PerigeeCovariance& toCov,
144 const PerigeeHelixAmbiguity& toAmbiguity,
145 const SZParameters& szParameters,
146 HelixParameters& avgPar,
147 HelixCovariance& avgCov)
149 using namespace NPerigeeParameterIndices;
150 PerigeeParameters refPar = (fromPar + toPar) / 2.0;
153 HelixParameters refHelixPar =
stack(refPar, szParameters);
155 PerigeeParameters relFromPar = fromPar - refPar;
158 PerigeeParameters relToPar = toPar - refPar;
161 HelixParameters relAvgPar;
173 avgPar = relAvgPar + refHelixPar;