Geant4 Cross Reference |
1 // 1 // 2 // ******************************************* 2 // ******************************************************************** 3 // * License and Disclaimer << 3 // * DISCLAIMER * 4 // * 4 // * * 5 // * The Geant4 software is copyright of th << 5 // * The following disclaimer summarizes all the specific disclaimers * 6 // * the Geant4 Collaboration. It is provided << 6 // * of contributors to this software. The specific disclaimers,which * 7 // * conditions of the Geant4 Software License << 7 // * govern, are listed with their locations in: * 8 // * LICENSE and available at http://cern.ch/ << 8 // * http://cern.ch/geant4/license * 9 // * include a list of copyright holders. << 10 // * 9 // * * 11 // * Neither the authors of this software syst 10 // * Neither the authors of this software system, nor their employing * 12 // * institutes,nor the agencies providing fin 11 // * institutes,nor the agencies providing financial support for this * 13 // * work make any representation or warran 12 // * work make any representation or warranty, express or implied, * 14 // * regarding this software system or assum 13 // * regarding this software system or assume any liability for its * 15 // * use. Please see the license in the file << 14 // * use. * 16 // * for the full disclaimer and the limitatio << 17 // * 15 // * * 18 // * This code implementation is the result << 16 // * This code implementation is the intellectual property of the * 19 // * technical work of the GEANT4 collaboratio << 17 // * GEANT4 collaboration. * 20 // * By using, copying, modifying or distri << 18 // * By copying, distributing or modifying the Program (or any work * 21 // * any work based on the software) you ag << 19 // * based on the Program) you indicate your acceptance of this * 22 // * use in resulting scientific publicati << 20 // * statement, and all its terms. * 23 // * acceptance of all terms of the Geant4 Sof << 24 // ******************************************* 21 // ******************************************************************** 25 // 22 // 26 // G4LineSection implementation << 27 // 23 // 28 // Created: J.Apostolakis, 1999 << 24 // $Id: G4LineSection.cc,v 1.8 2003/10/31 14:35:54 gcosmo Exp $ >> 25 // GEANT4 tag $Name: geant4-06-00 $ >> 26 // 29 // ------------------------------------------- 27 // -------------------------------------------------------------------- 30 28 31 #include "G4LineSection.hh" 29 #include "G4LineSection.hh" 32 30 33 G4LineSection::G4LineSection( const G4ThreeVec 31 G4LineSection::G4LineSection( const G4ThreeVector& PntA, 34 const G4ThreeVec << 32 const G4ThreeVector& PntB ) 35 : EndpointA(PntA), VecAtoB(PntB-PntA) << 33 : EndpointA(PntA), >> 34 VecAtoB(PntB-PntA) 36 { 35 { 37 fABdistanceSq = VecAtoB.mag2(); << 36 fABdistanceSq = VecAtoB.mag2() ; >> 37 /* >> 38 G4double distABsquared = VecAtoB.mag2() ; >> 39 if ( distABsquared == 0.0) >> 40 { >> 41 G4Exception("G4LineSection::G4LineSection()", "WrongArgumentValue", >> 42 FatalException, "Equal points in input (line->point) ?") ; >> 43 } >> 44 else >> 45 { >> 46 inverse_square_distAB=1.0 / distABsquared ; >> 47 } >> 48 */ 38 } 49 } 39 50 40 G4double G4LineSection::Dist( const G4ThreeVec << 51 G4double G4LineSection::Dist( G4ThreeVector OtherPnt ) const 41 { 52 { 42 G4double dist_sq; 53 G4double dist_sq; 43 G4ThreeVector VecAZ; 54 G4ThreeVector VecAZ; 44 G4double sq_VecAZ, inner_prod, unit_projecti 55 G4double sq_VecAZ, inner_prod, unit_projection ; 45 56 46 VecAZ= OtherPnt - EndpointA; 57 VecAZ= OtherPnt - EndpointA; 47 sq_VecAZ = VecAZ.mag2(); 58 sq_VecAZ = VecAZ.mag2(); 48 59 49 inner_prod= VecAtoB.dot( VecAZ ); 60 inner_prod= VecAtoB.dot( VecAZ ); 50 61 51 // Determine Projection(AZ on AB) / Length 62 // Determine Projection(AZ on AB) / Length(AB) 52 // 63 // 53 if( fABdistanceSq != 0.0 ) 64 if( fABdistanceSq != 0.0 ) 54 { 65 { 55 // unit_projection= inner_prod * InvsqDis 66 // unit_projection= inner_prod * InvsqDistAB(); 56 unit_projection = inner_prod/fABdistanceSq 67 unit_projection = inner_prod/fABdistanceSq; 57 68 58 if( (0. <= unit_projection ) && (unit_proj 69 if( (0. <= unit_projection ) && (unit_projection <= 1.0 ) ) 59 { 70 { 60 dist_sq= sq_VecAZ - unit_projection * i 71 dist_sq= sq_VecAZ - unit_projection * inner_prod ; 61 } 72 } 62 else 73 else 63 { 74 { 64 // The perpendicular from the point to t 75 // The perpendicular from the point to the line AB meets the line 65 // in a point outside the line segment! 76 // in a point outside the line segment! 66 77 67 if( unit_projection < 0. ) // A is the c 78 if( unit_projection < 0. ) // A is the closest point 68 { 79 { 69 dist_sq= sq_VecAZ; 80 dist_sq= sq_VecAZ; 70 } 81 } 71 else // B is the c 82 else // B is the closest point 72 { 83 { 73 G4ThreeVector EndpointB = EndpointA << 84 G4ThreeVector EndpointB = EndpointA + VecAtoB; 74 G4ThreeVector VecBZ = OtherPnt - 85 G4ThreeVector VecBZ = OtherPnt - EndpointB; 75 dist_sq = VecBZ.mag2(); 86 dist_sq = VecBZ.mag2(); 76 } 87 } 77 } 88 } 78 } 89 } 79 else 90 else 80 { 91 { 81 dist_sq = (OtherPnt - EndpointA).mag2() ; 92 dist_sq = (OtherPnt - EndpointA).mag2() ; 82 } 93 } 83 if( dist_sq < 0.0 ) << 94 if( dist_sq < 0.0 ) dist_sq = 0.0 ; 84 { << 95 85 dist_sq = 0.0 ; << 96 return sqrt(dist_sq) ; 86 } << 97 } >> 98 >> 99 G4double G4LineSection::Distline( const G4ThreeVector& OtherPnt, >> 100 const G4ThreeVector& LinePntA, >> 101 const G4ThreeVector& LinePntB ) >> 102 { >> 103 G4LineSection LineAB( LinePntA, LinePntB ); // Line from A to B 87 104 88 return std::sqrt(dist_sq) ; << 105 return LineAB.Dist( OtherPnt ); 89 } 106 } 90 107