34 : 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),
35 fErr2A(Vc::Zero), fU(Vc::Zero), fDR(Vc::Zero), fIsLeft(true), fISec(Vc::Zero), fAngle(Vc::Zero)
41 float_m
IsValid()
const {
return fIStation >= 0; }
47 return fIStation[v.firstOne()];
51 uint_v
Id()
const {
return fId; };
55 float_v
X0()
const {
return fX0; }
56 float_v
X1()
const {
return fX1; }
57 float_v
X2()
const {
return fX2; }
59 float_v
Err2X1()
const {
return fErr2X1; }
60 float_v
ErrX12()
const {
return fErrX12; }
61 float_v
Err2X2()
const {
return fErr2X2; }
63 float_v
U()
const {
return fU; }
64 float_v
R()
const {
return fR; }
65 float_v
DR()
const {
return fDR; }
66 int_v
ISec()
const {
return fISec; }
67 float_v
Err2R()
const {
return fErr2R; }
68 float_v
Err2A()
const {
return fErr2A; }
69 float_m
IsLeft()
const {
return fIsLeft; }
71 float_v
Angle()
const {
return fAngle; }
82 float_v fX0, fX1, fX2;
83 float_v fErr2X1, fErrX12, fErr2X2;
100 x1(!fIsLeft) -= xCorr;
106 int_v::Memory mIStation;
107 mIStation = int_v(-1);
110 float_v::Memory mX1, mX2, mX0;
111 float_v::Memory mErr2X1, mErrX12, mErr2X2;
112 float_v::Memory mR, mU, mDR, mErr2R, mErr2A, mIsLeft;
113 float_v::Memory mAlpha;
114 float_v::Memory mIsUsed;
117 foreach_bit(
unsigned short iV, valid)
133 mErr2R[iV] = h.
Err2R();
134 mErr2A[iV] = h.
Err2A();
135 mIsLeft[iV] = h.
IsLeft() ? 1.f : 0.f;
136 mISec[iV] = h.
ISec();
137 mAlpha[iV] = h.
Angle();
138 mIsUsed[iV] = h.
IsUsed() ? 1.f : 0.f;
141 fIStation = int_v(mIStation);
145 fErr2X1 = float_v(mErr2X1);
146 fErrX12 = float_v(mErrX12);
147 fErr2X2 = float_v(mErr2X2);
149 fErr2R = float_v(mErr2R);
150 fErr2A = float_v(mErr2A);
151 fIsLeft = (float_v(mIsLeft) == 1.f);
154 fISec = int_v(mISec);
155 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)