256 {
257 HepVector cen1( lp1.
center() );
258 HepVector cen2( lp2.
center() );
259 double dx = cen1( 1 ) - cen2( 1 );
260 double dy = cen1( 2 ) - cen2( 2 );
261 double dc = sqrt( dx * dx + dy * dy );
262 if (
dc < fabs( 0.5 / lp1.
kappa() ) + fabs( 0.5 / lp2.
kappa() ) )
263 {
264 double a1 = std::sqrt( lp1.alpha() ) + std::sqrt( lp1.beta() );
265 double a2 = std::sqrt( lp2.alpha() ) + std::sqrt( lp2.beta() );
266 double a3 = lp1.alpha() * lp2.alpha() + lp1.beta() * lp2.beta();
267 double det = lp1.alpha() * lp2.beta() - lp1.beta() * lp2.alpha();
268 if ( fabs( det ) > 1e-12 )
269 {
270 double c1 = a2 * std::sqrt( lp1.
kappa() ) + a1 * std::sqrt( lp2.
kappa() ) -
272 if ( c1 != 0 )
273 {
274 double cinv = 1.0 / c1;
275 double c2 = std::sqrt( a3 ) - 0.5 * ( a1 + a2 ) -
276 2.0 * a3 * ( lp1.gamma() * lp2.
kappa() + lp2.gamma() * lp1.
kappa() );
277 double c3 = a2 * std::sqrt( lp1.gamma() ) + a1 * std::sqrt( lp2.gamma() ) -
278 2.0 * a3 * lp1.gamma() * lp2.gamma();
279 double root = std::sqrt( c2 ) - 4.0 * c1 * c3;
281 {
283 double rad2[2];
284 rad2[0] = 0.5 * cinv * ( -c2 -
root );
285 rad2[1] = 0.5 * cinv * ( -c2 +
root );
286 double ab1 = -( lp2.beta() * lp1.gamma() - lp1.beta() * lp2.gamma() );
287 double ab2 = ( lp2.alpha() * lp1.gamma() - lp1.alpha() * lp2.gamma() );
288 double ac1 = -( lp2.beta() * lp1.
kappa() - lp1.beta() * lp2.
kappa() );
289 double ac2 = ( lp2.alpha() * lp1.
kappa() - lp1.alpha() * lp2.
kappa() );
290 double dinv = 1.0 / det;
291 v1( 1 ) = dinv * ( ab1 + ac1 * rad2[0] );
292 v1( 2 ) = dinv * ( ab2 + ac2 * rad2[0] );
293 v1( 3 ) = 0;
294 v2( 1 ) = dinv * ( ab1 + ac1 * rad2[1] );
295 v2( 2 ) = dinv * ( ab2 + ac2 * rad2[1] );
296 v2( 3 ) = 0;
297 double d1 = lp1.
d( v1( 1 ), v1( 2 ) );
298 double d2 = lp2.
d( v1( 1 ), v1( 2 ) );
299 double d3 = lp1.
d( v2( 1 ), v2( 2 ) );
300 double d4 = lp2.
d( v2( 1 ), v2( 2 ) );
301 double r = sqrt( rad2[0] );
302 Lpar::Cpar cp1( lp1 );
303 Lpar::Cpar cp2( lp2 );
304 for ( int j = 0; j < 2; j++ )
305 {
306 double s1, s2;
307 if ( j == 0 )
308 {
309 s1 = lp1.
s( v1( 1 ), v1( 2 ) );
310 s2 = lp2.
s( v1( 1 ), v1( 2 ) );
311 }
312 else
313 {
314 s1 = lp1.
s( v2( 1 ), v2( 2 ) );
315 s2 = lp2.
s( v2( 1 ), v2( 2 ) );
316 }
317 double phi1 = cp1.fi() + 2 * cp1.cu() * s1;
318 double phi2 = cp2.fi() + 2 * cp2.cu() * s2;
319 double f = ( 1 + 2 * cp1.cu() * cp1.da() ) * ( 1 + 2 * cp2.cu() * cp2.da() ) *
320 cos( cp1.fi() - cp2.fi() );
321 f -= 2 * ( lp1.gamma() * lp2.
kappa() + lp2.gamma() * lp1.
kappa() );
323 }
324 return 2;
325 }
326 }
327 }
328 }
329 return 0;
330 }
TFile f("ana_bhabha660a_dqa_mcPat_zy_old.root")
double cos(const BesAngle a)
double d(double x, double y) const
double s(double x, double y) const