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