44 const std::array<DiscretePhi0, 2>& phi0Vec = houghBox.getBounds<DiscretePhi0>();
45 const std::array<ContinuousTanL, 2>& tanL = houghBox.getBounds<ContinuousTanL>();
47 std::array<float, 2> xRot;
48 xRot[0] = x * phi0Vec[0]->x() + y * phi0Vec[0]->y();
49 xRot[1] = x * phi0Vec[1]->x() + y * phi0Vec[1]->y();
51 std::array<float, 2> yRot;
52 yRot[0] = -x * phi0Vec[0]->y() + y * phi0Vec[0]->x();
53 yRot[1] = -x * phi0Vec[1]->y() + y * phi0Vec[1]->x();
55 std::array<float, 2> dxdzRot;
56 dxdzRot[0] = dxdz * phi0Vec[0]->x() + dydz * phi0Vec[0]->y();
57 dxdzRot[1] = dxdz * phi0Vec[1]->x() + dydz * phi0Vec[1]->y();
59 std::array<float, 2> dydzRot;
60 dydzRot[0] = -dxdz * phi0Vec[0]->y() + dydz * phi0Vec[0]->x();
61 dydzRot[1] = -dxdz * phi0Vec[1]->y() + dydz * phi0Vec[1]->x();
64 const std::array<float, 2>& s = xRot;
67 if (onlyPositiveArm) {
69 if (xRot[0] < 0 and xRot[1] < 0)
return ESign::c_Invalid;
73 std::array<float, 4> xRotCor;
74 xRotCor[0b00] = xRot[0] + dxdzRot[0] * s[0] *
static_cast<float>(tanL[0]);
75 xRotCor[0b01] = xRot[0] + dxdzRot[0] * s[0] *
static_cast<float>(tanL[1]);
76 xRotCor[0b10] = xRot[1] + dxdzRot[1] * s[1] *
static_cast<float>(tanL[0]);
77 xRotCor[0b11] = xRot[1] + dxdzRot[1] * s[1] *
static_cast<float>(tanL[1]);
79 const std::array<float, 4>& sCor = xRotCor;
81 std::array<float, 4> dist;
82 dist[0b00] = -(yRot[0] + dydzRot[0] * sCor[0b00] *
static_cast<float>(tanL[0]) + l);
83 dist[0b01] = -(yRot[0] + dydzRot[0] * sCor[0b01] *
static_cast<float>(tanL[1]) + l);
84 dist[0b10] = -(yRot[1] + dydzRot[1] * sCor[0b10] *
static_cast<float>(tanL[0]) + l);
85 dist[0b11] = -(yRot[1] + dydzRot[1] * sCor[0b11] *
static_cast<float>(tanL[1]) + l);