SurveyAlignmentPoints.cc

Go to the documentation of this file.

#include "Alignment/CommonAlignment/interface/Alignable.h"
#include "Alignment/CommonAlignment/interface/SurveyDet.h"
#include "Alignment/CommonAlignment/interface/SurveyResidual.h"
#include "Alignment/SurveyAnalysis/interface/SurveyParameters.h"
 
#include "Alignment/SurveyAnalysis/interface/SurveyAlignmentPoints.h"
 
SurveyAlignmentPoints::SurveyAlignmentPoints(const align::Alignables& sensors,
                                             const std::vector<align::StructureType>& levels)
    : SurveyAlignment(sensors, levels) {}
 
void SurveyAlignmentPoints::findAlignPars(bool bias) {
  unsigned int nSensor = theSensors.size();
 
  for (unsigned int i = 0; i < nSensor; ++i) {
    Alignable* ali = theSensors[i];
 
    AlgebraicSymMatrix sumJVJT(6, 0);  // 6 by 6 symmetric matrix init to 0
    AlgebraicVector sumJVe(6, 0);      // init to 0
 
    for (unsigned int l = 0; l < theLevels.size(); ++l) {
      SurveyResidual res(*ali, theLevels[l], bias);
 
      if (!res.valid())
        continue;
 
      align::LocalVectors residuals = res.pointsResidual();
 
      unsigned int nPoints = residuals.size();
 
      for (unsigned int j = 0; j < nPoints; ++j) {
        AlgebraicMatrix J = ali->survey()->derivatives(j);
        AlgebraicSymMatrix V(3, 1);  // identity for now
        AlgebraicVector e(3);        // local residual
 
        const align::LocalVector& lr = residuals[j];
 
        e(1) = lr.x();
        e(2) = lr.y();
        e(3) = lr.z();
        V /= 1e-4 * 1e-4;
        sumJVe += J * (V * e);
        sumJVJT += V.similarity(J);
      }
    }
 
    int dummy;
    sumJVJT.invert(dummy);  // sumJVJT = sumJVJT^-1
    sumJVe = -sumJVJT * sumJVe;
 
    ali->setAlignmentParameters(new SurveyParameters(ali, sumJVe, sumJVJT));
  }
}