|
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
|
/** \file RigidBodyAlignmentParameters.cc
*
* Version : $Revision: 1.14 $
* last update: $Date: 2008/09/02 15:08:12 $
* by : $Author: flucke $
*/
#include "FWCore/Utilities/interface/Exception.h"
#include "Alignment/CommonAlignment/interface/Alignable.h"
#include "Alignment/CommonAlignment/interface/AlignableDetOrUnitPtr.h"
#include "Alignment/CommonAlignmentParametrization/interface/AlignmentParametersFactory.h"
#include "Alignment/CommonAlignmentParametrization/interface/FrameToFrameDerivative.h"
#include "Alignment/CommonAlignmentParametrization/interface/SegmentAlignmentDerivatives4D.h"
#include "CondFormats/Alignment/interface/Definitions.h"
// This class's header
#include "Alignment/CommonAlignmentParametrization/interface/RigidBodyAlignmentParameters4D.h"
//__________________________________________________________________________________________________
AlgebraicMatrix RigidBodyAlignmentParameters4D::derivatives(const TrajectoryStateOnSurface &tsos,
const AlignableDetOrUnitPtr &alidet) const {
const Alignable *ali = this->alignable(); // Alignable of these parameters
if (ali == alidet) { // same alignable => same frame
return SegmentAlignmentDerivatives4D()(tsos);
} else { // different alignable => transform into correct frame
const AlgebraicMatrix deriv = SegmentAlignmentDerivatives4D()(tsos);
FrameToFrameDerivative ftfd;
return ftfd.frameToFrameDerivative(alidet, ali).T() * deriv;
}
}
//__________________________________________________________________________________________________
RigidBodyAlignmentParameters4D *RigidBodyAlignmentParameters4D::clone(const AlgebraicVector ¶meters,
const AlgebraicSymMatrix &covMatrix) const {
RigidBodyAlignmentParameters4D *rbap =
new RigidBodyAlignmentParameters4D(alignable(), parameters, covMatrix, selector());
if (userVariables())
rbap->setUserVariables(userVariables()->clone());
rbap->setValid(isValid());
return rbap;
}
//__________________________________________________________________________________________________
RigidBodyAlignmentParameters4D *RigidBodyAlignmentParameters4D::cloneFromSelected(
const AlgebraicVector ¶meters, const AlgebraicSymMatrix &covMatrix) const {
RigidBodyAlignmentParameters4D *rbap = new RigidBodyAlignmentParameters4D(
alignable(), expandVector(parameters, selector()), expandSymMatrix(covMatrix, selector()), selector());
if (userVariables())
rbap->setUserVariables(userVariables()->clone());
rbap->setValid(isValid());
return rbap;
}
//__________________________________________________________________________________________________
int RigidBodyAlignmentParameters4D::type() const { return AlignmentParametersFactory::kRigidBody4D; }
|