53 const std::array<DiscretePhi0, 2>& phi0Vec = houghBox.getBounds<DiscretePhi0>();
54 const std::array<ContinuousImpact, 2>& impact = houghBox.getBounds<ContinuousImpact>();
56 std::array<float, 2> xRot;
57 xRot[0] = x * phi0Vec[0]->x() + y * phi0Vec[0]->y();
58 xRot[1] = x * phi0Vec[1]->x() + y * phi0Vec[1]->y();
61 if (onlyPositiveArm) {
63 if (xRot[0] < 0 and xRot[1] < 0)
return ESign::c_Invalid;
66 std::array<float, 2> yRotPlusL;
67 yRotPlusL[0] = -x * phi0Vec[0]->y() + y * phi0Vec[0]->x() + l;
68 yRotPlusL[1] = -x * phi0Vec[1]->y() + y * phi0Vec[1]->x() + l;
71 std::array<float, 4> dist;
72 dist[0b00] = yRotPlusL[0] -
static_cast<float>(impact[0]);
73 dist[0b10] = yRotPlusL[1] -
static_cast<float>(impact[0]);
74 dist[0b01] = yRotPlusL[0] -
static_cast<float>(impact[1]);
75 dist[0b11] = yRotPlusL[1] -
static_cast<float>(impact[1]);