|
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
|
#ifndef DataFormats_TrackingRecHit_interface_KfComponentsHolder_h_
#define DataFormats_TrackingRecHit_interface_KfComponentsHolder_h_
#include "DataFormats/CLHEP/interface/AlgebraicObjects.h"
#include "DataFormats/Math/interface/ProjectMatrix.h"
#include <cstdint>
#include <cassert>
class TrackingRecHit;
// #define Debug_KfComponentsHolder
class KfComponentsHolder {
public:
KfComponentsHolder() {
#ifdef Debug_KfComponentsHolder
size_ = 0;
#endif
}
template <unsigned int D>
void setup(typename AlgebraicROOTObject<D>::Vector *params,
typename AlgebraicROOTObject<D, D>::SymMatrix *errors,
ProjectMatrix<double, 5, D> *projFunc,
typename AlgebraicROOTObject<D>::Vector *measuredParams,
typename AlgebraicROOTObject<D, D>::SymMatrix *measuredErrors,
const AlgebraicVector5 &tsosLocalParameters,
const AlgebraicSymMatrix55 &tsosLocalErrors);
template <unsigned int D>
typename AlgebraicROOTObject<D>::Vector ¶ms() {
#ifdef Debug_KfComponentsHolder
assert(size_ == D);
#endif
return *reinterpret_cast<typename AlgebraicROOTObject<D>::Vector *>(params_);
}
template <unsigned int D>
typename AlgebraicROOTObject<D, D>::SymMatrix &errors() {
#ifdef Debug_KfComponentsHolder
assert(size_ == D);
#endif
return *reinterpret_cast<typename AlgebraicROOTObject<D, D>::SymMatrix *>(errors_);
}
template <unsigned int D>
typename AlgebraicROOTObject<D, 5>::Matrix projection() {
#ifdef Debug_KfComponentsHolder
assert(size_ == D);
#endif
return this->projFunc<D>().matrix();
//return * reinterpret_cast<typename AlgebraicROOTObject<D,5>::Matrix *>(projection_);
}
template <unsigned int D>
ProjectMatrix<double, 5, D> &projFunc() {
#ifdef Debug_KfComponentsHolder
assert(size_ == D);
#endif
return *reinterpret_cast<ProjectMatrix<double, 5, D> *>(projFunc_);
}
/// Fill in datamembers from a generic TrackingRecHit using the CLHEP matrices
void genericFill(const TrackingRecHit &hit);
template <unsigned int D>
typename AlgebraicROOTObject<D>::Vector &measuredParams() {
#ifdef Debug_KfComponentsHolder
assert(size_ == D);
#endif
return *reinterpret_cast<typename AlgebraicROOTObject<D>::Vector *>(measuredParams_);
}
template <unsigned int D>
typename AlgebraicROOTObject<D, D>::SymMatrix &measuredErrors() {
#ifdef Debug_KfComponentsHolder
assert(size_ == D);
#endif
return *reinterpret_cast<typename AlgebraicROOTObject<D, D>::SymMatrix *>(measuredErrors_);
}
const AlgebraicVector5 &tsosLocalParameters() const { return *tsosLocalParameters_; }
const AlgebraicSymMatrix55 &tsosLocalErrors() const { return *tsosLocalErrors_; }
template <unsigned int D>
void dump();
private:
#ifdef Debug_KfComponentsHolder
uint16_t size_;
#endif
void *params_, *errors_, *projFunc_, *measuredParams_, *measuredErrors_;
const AlgebraicVector5 *tsosLocalParameters_;
const AlgebraicSymMatrix55 *tsosLocalErrors_;
template <unsigned int D>
void genericFill_(const TrackingRecHit &hit);
};
template <unsigned int D>
void KfComponentsHolder::setup(typename AlgebraicROOTObject<D>::Vector *params,
typename AlgebraicROOTObject<D, D>::SymMatrix *errors,
ProjectMatrix<double, 5, D> *projFunc,
typename AlgebraicROOTObject<D>::Vector *measuredParams,
typename AlgebraicROOTObject<D, D>::SymMatrix *measuredErrors,
const AlgebraicVector5 &tsosLocalParameters,
const AlgebraicSymMatrix55 &tsosLocalErrors) {
#ifdef Debug_KfComponentsHolder
assert(size_ == 0); // which means it was uninitialized
size_ = D;
#endif
params_ = params;
errors_ = errors;
projFunc_ = projFunc;
measuredParams_ = measuredParams;
measuredErrors_ = measuredErrors;
tsosLocalParameters_ = &tsosLocalParameters;
tsosLocalErrors_ = &tsosLocalErrors;
}
template <unsigned int D>
void KfComponentsHolder::dump() {
using namespace std;
cout << "Params my: " << params<D>() << endl;
cout << " tsos: " << tsosLocalParameters() << endl;
cout << " meas: " << measuredParams<D>() << endl;
cout << "Errors my:\n" << errors<D>() << endl;
cout << " tsos:\n" << tsosLocalErrors() << endl;
cout << " meas:\n" << measuredErrors<D>() << endl;
cout << "Projection:\n" << projection<D>() << endl;
}
#ifdef Debug_KfComponentsHolder
// undef it so we don't pollute someone else's code.
#undef Debug_KfComponentsHolder
#endif
#endif
|