22 : fIStation(-1), fId(Vc::Zero), fX0(Vc::Zero), fX1(Vc::Zero), fX2(Vc::Zero), fErr2X1(Vc::Zero), fErrX12(Vc::Zero), fErr2X2(Vc::Zero), fR(Vc::Zero), fErr2R(Vc::Zero),
23 fErr2A(Vc::Zero), fU(Vc::Zero), fDR(Vc::Zero), fIsLeft(true), fISec(Vc::Zero), fAngle(Vc::Zero)
29 float_m
IsValid()
const {
return fIStation >= 0; }
35 return fIStation[v.firstOne()];
39 uint_v
Id()
const {
return fId; };
43 float_v
X0()
const {
return fX0; }
44 float_v
X1()
const {
return fX1; }
45 float_v
X2()
const {
return fX2; }
47 float_v
Err2X1()
const {
return fErr2X1; }
48 float_v
ErrX12()
const {
return fErrX12; }
49 float_v
Err2X2()
const {
return fErr2X2; }
51 float_v
U()
const {
return fU; }
52 float_v
R()
const {
return fR; }
53 float_v
DR()
const {
return fDR; }
54 int_v
ISec()
const {
return fISec; }
55 float_v
Err2R()
const {
return fErr2R; }
56 float_v
Err2A()
const {
return fErr2A; }
57 float_m
IsLeft()
const {
return fIsLeft; }
59 float_v
Angle()
const {
return fAngle; }
70 float_v fX0, fX1, fX2;
71 float_v fErr2X1, fErrX12, fErr2X2;
88 x1(!fIsLeft) -= xCorr;
94 int_v::Memory mIStation;
95 mIStation = int_v(-1);
98 float_v::Memory mX1, mX2, mX0;
99 float_v::Memory mErr2X1, mErrX12, mErr2X2;
100 float_v::Memory mR, mU, mDR, mErr2R, mErr2A, mIsLeft;
101 float_v::Memory mAlpha;
102 float_v::Memory mIsUsed;
105 foreach_bit(
unsigned short iV, valid)
121 mErr2R[iV] = h.
Err2R();
122 mErr2A[iV] = h.
Err2A();
123 mIsLeft[iV] = h.
IsLeft() ? 1.f : 0.f;
124 mISec[iV] = h.
ISec();
125 mAlpha[iV] = h.
Angle();
126 mIsUsed[iV] = h.
IsUsed() ? 1.f : 0.f;
129 fIStation = int_v(mIStation);
133 fErr2X1 = float_v(mErr2X1);
134 fErrX12 = float_v(mErrX12);
135 fErr2X2 = float_v(mErr2X2);
137 fErr2R = float_v(mErr2R);
138 fErr2A = float_v(mErr2A);
139 fIsLeft = (float_v(mIsLeft) == 1.f);
142 fISec = int_v(mISec);
143 fAngle = float_v(mAlpha);
float_v X1Corrected(const PndCATrackParamVector &p) const
friend F32vec4 rsqrt(const F32vec4 &a)
void GetGlobalCoor(int iV, float &x, float &y, float &z) const
static void CALocalToGlobal(T x0, T x1, T angle, T &x, T &y)