/home/bes3soft/bes3soft/Boss/7.0.2/dist/7.0.2/Reconstruction/TrackUtil/TrackUtil-00-00-08/src/Lpar.cxx File Reference

#include <iostream>
#include <cmath>
#include "TrackUtil/Lpar.h"

Go to the source code of this file.

Functions

int intersect (const Lpar &lp1, const Lpar &lp2, HepVector &v1, HepVector &v2)
std::ostreamoperator<< (std::ostream &o, Lpar &s)


Function Documentation

int intersect ( const Lpar lp1,
const Lpar lp2,
HepVector &  v1,
HepVector &  v2 
)

Definition at line 243 of file Lpar.cxx.

References Lpar::alpha(), Lpar::beta(), Lpar::center(), cos(), Lpar::d(), dc, Lpar::gamma(), ganga-rec::j, Lpar::kappa(), phi1, phi2, root, and Lpar::s().

00243                                                                           {
00244   HepVector cen1(lp1.center());
00245   HepVector cen2(lp2.center());
00246   double dx = cen1(1)-cen2(1);
00247   double dy = cen1(2)-cen2(2);
00248   double dc = sqrt(dx*dx+dy*dy);
00249   if(dc<fabs(0.5/lp1.kappa())+fabs(0.5/lp2.kappa())) {
00250     double a1 = std::sqrt(lp1.alpha()) + std::sqrt(lp1.beta());
00251     double a2 = std::sqrt(lp2.alpha()) + std::sqrt(lp2.beta());
00252     double a3 = lp1.alpha()*lp2.alpha() + lp1.beta()*lp2.beta();
00253     double det = lp1.alpha()*lp2.beta() - lp1.beta()*lp2.alpha();
00254     if(fabs(det)>1e-12) {
00255       double c1 = a2 * std::sqrt(lp1.kappa()) + a1 * std::sqrt(lp2.kappa()) -
00256         2.0 * a3 * lp1.kappa() * lp2.kappa();
00257       if(c1!=0) {
00258         double cinv = 1.0 / c1;
00259         double c2 = std::sqrt(a3) - 0.5 * (a1 + a2) - 2.0 * a3 *
00260           (lp1.gamma() * lp2.kappa() + lp2.gamma() * lp1.kappa());
00261         double c3 = a2 * std::sqrt(lp1.gamma()) + a1 * std::sqrt(lp2.gamma()) -
00262           2.0 * a3 * lp1.gamma() * lp2.gamma();
00263         double root = std::sqrt(c2) - 4.0 * c1 * c3;
00264         if (root>=0) {
00265           root = sqrt(root);
00266           double rad2[2];
00267           rad2[0] = 0.5 * cinv * (-c2 - root);
00268           rad2[1] = 0.5 * cinv * (-c2 + root);
00269           double ab1 = -(lp2.beta() * lp1.gamma() - lp1.beta() * lp2.gamma());
00270           double ab2 = (lp2.alpha() * lp1.gamma() - lp1.alpha() * lp2.gamma());
00271           double ac1 = -(lp2.beta() * lp1.kappa() - lp1.beta() * lp2.kappa());
00272           double ac2 = (lp2.alpha() * lp1.kappa() - lp1.alpha() * lp2.kappa());
00273           double dinv = 1.0 / det;
00274           v1(1) = dinv * (ab1 + ac1 * rad2[0]);
00275           v1(2) = dinv * (ab2 + ac2 * rad2[0]);
00276           v1(3) = 0;
00277           v2(1) = dinv * (ab1 + ac1 * rad2[1]);
00278           v2(2) = dinv * (ab2 + ac2 * rad2[1]);
00279           v2(3) = 0;
00280           double d1 = lp1.d(v1(1),v1(2));
00281           double d2 = lp2.d(v1(1),v1(2));
00282           double d3 = lp1.d(v2(1),v2(2));
00283           double d4 = lp2.d(v2(1),v2(2));
00284           double r = sqrt(rad2[0]);
00285           Lpar::Cpar cp1(lp1);
00286           Lpar::Cpar cp2(lp2);
00287           for(int j=0;j<2;j++) {
00288             double s1,s2;
00289             if(j==0) {
00290               s1 = lp1.s(v1(1),v1(2));
00291               s2 = lp2.s(v1(1),v1(2));
00292             } else {
00293               s1 = lp1.s(v2(1),v2(2));
00294               s2 = lp2.s(v2(1),v2(2));
00295             }
00296             double phi1 = cp1.fi() + 2 * cp1.cu() * s1;
00297             double phi2 = cp2.fi() + 2 * cp2.cu() * s2;
00298             double f = (1 + 2 * cp1.cu() * cp1.da()) *
00299               (1 + 2 * cp2.cu() * cp2.da()) * cos(cp1.fi()-cp2.fi());
00300             f -= 2 * (lp1.gamma() * lp2.kappa() + lp2.gamma() * lp1.kappa());
00301             double cosphi12 = f;
00302           }
00303           return 2;
00304         }
00305       }
00306     }
00307   }
00308   return 0;
00309 }

std::ostream& operator<< ( std::ostream o,
Lpar s 
)

Definition at line 319 of file Lpar.cxx.

References s.

00319                                                {
00320   return o << " al=" << s.m_alpha << " be=" << s.m_beta
00321            << " ka=" << s.m_kappa << " ga=" << s.m_gamma;
00322 }


Generated on Tue Nov 29 23:16:53 2016 for BOSS_7.0.2 by  doxygen 1.4.7