|
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
|
#include "Alignment/CommonAlignment/interface/SurveyDet.h"
SurveyDet::SurveyDet(const AlignableSurface& surface, const align::ErrorMatrix& errors)
: theSurface(surface), theErrors(errors) {
const align::Scalar W3 = surface.width() / 3.;
const align::Scalar L3 = surface.length() / 3.;
thePoints.reserve(4); // 4 survey points
// thePoints.push_back( align::LocalPoint( 0., 0., 0.) );
thePoints.push_back(align::LocalPoint(W3, 0., 0.));
// thePoints.push_back( align::LocalPoint( W3, L3, 0.) );
thePoints.push_back(align::LocalPoint(0., L3, 0.));
// thePoints.push_back( align::LocalPoint(-W3, L3, 0.) );
thePoints.push_back(align::LocalPoint(-W3, 0., 0.));
// thePoints.push_back( align::LocalPoint(-W3, -L3, 0.) );
thePoints.push_back(align::LocalPoint(0., -L3, 0.));
// thePoints.push_back( align::LocalPoint( W3, -L3, 0.) );
}
AlgebraicMatrix SurveyDet::derivatives(unsigned int index) const {
AlgebraicMatrix jac(6, 3, 0); // 6 by 3 Jacobian init to 0
// jac(1, 1) = S11; jac(1, 2) = S12; jac(1, 3) = S13;
// jac(2, 1) = S21; jac(2, 2) = S22; jac(2, 3) = S23;
// jac(3, 1) = S31; jac(3, 2) = S32; jac(3, 3) = S33;
// jac(4, 1) = u2 * S31;
// jac(4, 2) = u2 * S32;
// jac(4, 3) = u2 * S33;
// jac(5, 1) = -u1 * S31;
// jac(5, 2) = -u1 * S32;
// jac(5, 3) = -u1 * S33;
// jac(6, 1) = u1 * S21 - u2 * S11;
// jac(6, 2) = u1 * S22 - u2 * S12;
// jac(6, 3) = u1 * S23 - u2 * S13;
jac(1, 1) = 1.;
jac(2, 2) = 1.;
jac(3, 3) = 1.;
jac(5, 3) -= jac(6, 2) = thePoints[index].x();
jac(6, 1) -= jac(4, 3) = thePoints[index].y();
return jac;
}
|