/// Copy alignment object from source object
void DD4hep::Alignments::AlignmentTools::copy(Alignment from, Alignment to) {
Alignment::Object* f = from.ptr();
Alignment::Object* t = to.ptr();
if ( t != f ) {
t->flag = f->flag;
t->detectorTrafo = f->detectorTrafo;
t->worldTrafo = f->worldTrafo;
t->trToWorld = f->trToWorld;
t->detector = f->detector;
t->placement = f->placement;
t->nodes = f->nodes;
t->delta = f->delta;
t->magic = f->magic;
}
}
/// Compute the survey to-world transformation from the detector element placement with respect to the survey constants
void DD4hep::Alignments::AlignmentTools::computeSurvey(Alignment alignment)
{
Alignment::Object* a = alignment.ptr();
DetElement parent = a->detector.parent();
MaskManipulator mask(a->flag);
if ( parent.isValid() ) {
DetectorTools::PlacementPath path;
DetectorTools::placementPath(parent, a->detector, path);
// TODO: need to take survey corrections into account!
for (size_t i = 0, n=path.size(); n>0 && i < n-1; ++i) {
const PlacedVolume& p = path[i];
a->detectorTrafo.MultiplyLeft(p->GetMatrix());
}
a->worldTrafo = parent.survey()->worldTrafo;
a->worldTrafo.MultiplyLeft(&a->detectorTrafo);
a->trToWorld = Geometry::_transform(&a->worldTrafo);
a->placement = a->detector.placement();
}
mask.set(AlignmentData::SURVEY);
//mask.clear(AlignmentData::INVALID|AlignmentData::DIRTY);
//mask.set(AlignmentData::VALID|AlignmentData::IDEAL);
}
void alignment_reset_dbg(const string& path, const Alignment& a) {
TGeoPhysicalNode* n = a.ptr();
cout << " +++++++++++++++++++++++++++++++ " << path << endl;
cout << " +++++ Misaligned physical node: " << endl;
n->Print();
string np;
if ( n->IsAligned() ) {
for (Int_t i=0; i<=n->GetLevel(); i++) {
TGeoMatrix* mm = n->GetNode(i)->GetMatrix();
np += "/";
np += n->GetNode(i)->GetName();
if ( mm->IsIdentity() ) continue;
if ( i == 0 ) continue;
TGeoHMatrix* glob = n->GetMatrix(i-1);
NodeMap::const_iterator j=original_matrices.find(np);
if ( j != original_matrices.end() && i!=n->GetLevel() ) {
cout << " +++++ Patch Level: " << i << np << endl;
*mm = *((*j).second);
}
else {
if ( i==n->GetLevel() ) {
cout << " +++++ Level: " << i << np << " --- Original matrix: " << endl;
n->GetOriginalMatrix()->Print();
cout << " +++++ Level: " << i << np << " --- Local matrix: " << endl;
mm->Print();
TGeoHMatrix* hm = dynamic_cast<TGeoHMatrix*>(mm);
hm->SetTranslation(n->GetOriginalMatrix()->GetTranslation());
hm->SetRotation(n->GetOriginalMatrix()->GetRotationMatrix());
cout << " +++++ Level: " << i << np << " --- New local matrix" << endl;
mm->Print();
}
else {
cout << " +++++ Level: " << i << np << " --- Keep matrix " << endl;
mm->Print();
}
}
cout << " +++++ Level: " << i << np << " --- Global matrix: " << endl;
glob->Print();
*glob *= *mm;
cout << " +++++ Level: " << i << np << " --- New global matrix: " << endl;
glob->Print();
}
}
cout << "\n\n\n +++++ physical node (full): " << np << endl;
n->Print();
cout << " +++++ physical node (global): " << np << endl;
n->GetMatrix()->Print();
}
/// Compute the ideal/nominal to-world transformation from the detector element placement
void DD4hep::Alignments::AlignmentTools::computeIdeal(Alignment alignment) {
Alignment::Object* a = alignment.ptr();
MaskManipulator mask(a->flag);
DetElement parent = a->detector.parent();
if ( parent.isValid() ) {
DetectorTools::PlacementPath path;
DetectorTools::placementPath(parent, a->detector, path);
for (size_t i = 0, n=path.size(); n>0 && i < n-1; ++i) {
const PlacedVolume& p = path[i];
a->detectorTrafo.MultiplyLeft(p->GetMatrix());
a->nodes.push_back(p);
}
a->worldTrafo = parent.nominal()->worldTrafo;
a->worldTrafo.MultiplyLeft(&a->detectorTrafo);
a->trToWorld = Geometry::_transform(&a->worldTrafo);
a->placement = a->detector.placement();
mask.clear();
mask.set(AlignmentData::HAVE_PARENT_TRAFO);
mask.set(AlignmentData::HAVE_WORLD_TRAFO);
mask.set(AlignmentData::IDEAL);
}
}
/// Compute the ideal/nominal to-world transformation from the detector element placement
void DD4hep::Alignments::AlignmentTools::computeIdeal(Alignment alignment,
const Alignment::NodeList& node_list)
{
Alignment::Object* a = alignment.ptr();
MaskManipulator mask(a->flag);
a->nodes = node_list;
for (size_t i = a->nodes.size(); i > 1; --i) { // Omit the placement of the parent DetElement
TGeoMatrix* m = a->nodes[i - 1]->GetMatrix();
a->worldTrafo.MultiplyLeft(m);
}
DetElement::Object* det = a->detector.ptr();
if ( !a->nodes.empty() ) {
a->detectorTrafo = a->worldTrafo;
a->detectorTrafo.MultiplyLeft(a->nodes[0]->GetMatrix());
a->placement = node_list.back();
}
else {
a->placement = det->placement;
}
a->worldTrafo.MultiplyLeft(&(a->detector.nominal()->worldTrafo));
a->trToWorld = Geometry::_transform(&a->worldTrafo);
mask.set(AlignmentData::IDEAL);
}
