|
| 1 | +/** TRACCC library, part of the ACTS project (R&D line) |
| 2 | + * |
| 3 | + * (c) 2025 CERN for the benefit of the ACTS project |
| 4 | + * |
| 5 | + * Mozilla Public License Version 2.0 |
| 6 | + */ |
| 7 | + |
| 8 | +#pragma once |
| 9 | + |
| 10 | +namespace traccc::edm { |
| 11 | + |
| 12 | +template <detray::concepts::algebra algebra_t, std::integral size_t, size_t D> |
| 13 | +TRACCC_HOST_DEVICE void get_measurement_local( |
| 14 | + const measurement& meas, detray::dmatrix<algebra_t, D, 1>& pos) { |
| 15 | + |
| 16 | + static_assert(((D == 1u) || (D == 2u)), |
| 17 | + "The measurement dimension must be 1 or 2"); |
| 18 | + |
| 19 | + assert((meas.subs.get_indices()[0] == e_bound_loc0) || |
| 20 | + (meas.subs.get_indices()[0] == e_bound_loc1)); |
| 21 | + |
| 22 | + const point2& local = meas.local; |
| 23 | + |
| 24 | + switch (meas.subs.get_indices()[0]) { |
| 25 | + case e_bound_loc0: |
| 26 | + getter::element(pos, 0, 0) = local[0]; |
| 27 | + if constexpr (D == 2u) { |
| 28 | + getter::element(pos, 1, 0) = local[1]; |
| 29 | + } |
| 30 | + break; |
| 31 | + case e_bound_loc1: |
| 32 | + getter::element(pos, 0, 0) = local[1]; |
| 33 | + if constexpr (D == 2u) { |
| 34 | + getter::element(pos, 1, 0) = local[0]; |
| 35 | + } |
| 36 | + break; |
| 37 | + default: |
| 38 | +#if defined(__GNUC__) |
| 39 | + __builtin_unreachable(); |
| 40 | +#endif |
| 41 | + } |
| 42 | +} |
| 43 | + |
| 44 | +template <detray::concepts::algebra algebra_t, std::integral size_t, size_t D> |
| 45 | +TRACCC_HOST_DEVICE void get_measurement_covariance( |
| 46 | + const measurement& meas, detray::dmatrix<algebra_t, D, D>& cov) { |
| 47 | + |
| 48 | + static_assert(((D == 1u) || (D == 2u)), |
| 49 | + "The measurement dimension must be 1 or 2"); |
| 50 | + |
| 51 | + assert((meas.subs.get_indices()[0] == e_bound_loc0) || |
| 52 | + (meas.subs.get_indices()[0] == e_bound_loc1)); |
| 53 | + |
| 54 | + const variance2& variance = meas.variance; |
| 55 | + |
| 56 | + switch (meas.subs.get_indices()[0]) { |
| 57 | + case e_bound_loc0: |
| 58 | + getter::element(cov, 0, 0) = variance[0]; |
| 59 | + if constexpr (D == 2u) { |
| 60 | + getter::element(cov, 0, 1) = 0.f; |
| 61 | + getter::element(cov, 1, 0) = 0.f; |
| 62 | + getter::element(cov, 1, 1) = variance[1]; |
| 63 | + } |
| 64 | + break; |
| 65 | + case e_bound_loc1: |
| 66 | + getter::element(cov, 0, 0) = variance[1]; |
| 67 | + if constexpr (D == 2u) { |
| 68 | + getter::element(cov, 0, 1) = 0.f; |
| 69 | + getter::element(cov, 1, 0) = 0.f; |
| 70 | + getter::element(cov, 1, 1) = variance[0]; |
| 71 | + } |
| 72 | + break; |
| 73 | + default: |
| 74 | +#if defined(__GNUC__) |
| 75 | + __builtin_unreachable(); |
| 76 | +#endif |
| 77 | + } |
| 78 | +} |
| 79 | + |
| 80 | +} // namespace traccc::edm |
0 commit comments