[1316] | 1 | // |
---|
| 2 | // ******************************************************************** |
---|
| 3 | // * License and Disclaimer * |
---|
| 4 | // * * |
---|
| 5 | // * The Geant4 software is copyright of the Copyright Holders of * |
---|
| 6 | // * the Geant4 Collaboration. It is provided under the terms and * |
---|
| 7 | // * conditions of the Geant4 Software License, included in the file * |
---|
| 8 | // * LICENSE and available at http://cern.ch/geant4/license . These * |
---|
| 9 | // * include a list of copyright holders. * |
---|
| 10 | // * * |
---|
| 11 | // * Neither the authors of this software system, nor their employing * |
---|
| 12 | // * institutes,nor the agencies providing financial support for this * |
---|
| 13 | // * work make any representation or warranty, express or implied, * |
---|
| 14 | // * regarding this software system or assume any liability for its * |
---|
| 15 | // * use. Please see the license in the file LICENSE and URL above * |
---|
| 16 | // * for the full disclaimer and the limitation of liability. * |
---|
| 17 | // * * |
---|
| 18 | // * This code implementation is the result of the scientific and * |
---|
| 19 | // * technical work of the GEANT4 collaboration. * |
---|
| 20 | // * By using, copying, modifying or distributing the software (or * |
---|
| 21 | // * any work based on the software) you agree to acknowledge its * |
---|
| 22 | // * use in resulting scientific publications, and indicate your * |
---|
| 23 | // * acceptance of all terms of the Geant4 Software license. * |
---|
| 24 | // ******************************************************************** |
---|
| 25 | // |
---|
| 26 | // |
---|
| 27 | #include <assert.h> |
---|
| 28 | |
---|
| 29 | #include "G4GeometryTolerance.hh" |
---|
| 30 | #include "G4Paraboloid.hh" |
---|
| 31 | #include "G4Polyhedron.hh" |
---|
| 32 | #include "Randomize.hh" |
---|
| 33 | int main() |
---|
| 34 | { |
---|
| 35 | G4ThreeVector testPoint; |
---|
| 36 | |
---|
| 37 | G4Paraboloid paraboloid1("Paraboloid1", 1., 0., 3.); |
---|
| 38 | G4Paraboloid paraboloid2("Paraboloid2", .01, 2., 3.); |
---|
| 39 | |
---|
| 40 | G4double kCarTolerance = G4GeometryTolerance::GetInstance()->GetSurfaceTolerance(); |
---|
| 41 | |
---|
| 42 | // Test Inside function. |
---|
| 43 | assert(paraboloid1.Inside(G4ThreeVector(2.598076211, 1.5, 1.)) == kSurface); |
---|
| 44 | assert(paraboloid1.Inside(G4ThreeVector((2 * kCarTolerance + 3.) * std::sqrt(3.) / 2., (2. * kCarTolerance + 3.) / 2., 1.)) == kOutside); |
---|
| 45 | assert(paraboloid1.Inside(G4ThreeVector((- 2 * kCarTolerance + 3.) * std::sqrt(3.) / 2., (- 2. * kCarTolerance + 3.) / 2., 1.)) == kSurface); |
---|
| 46 | |
---|
| 47 | assert(paraboloid1.Inside(G4ThreeVector(std::sqrt(4.5) / std::sqrt(2.), std::sqrt(4.5) / std::sqrt(2.), 0.)) == kSurface); |
---|
| 48 | assert(paraboloid1.Inside(G4ThreeVector(( 2 * kCarTolerance + std::sqrt(4.5)) / std::sqrt(2.), ( 2. * kCarTolerance + std::sqrt(4.5)) / std::sqrt(2.), 0.)) == kOutside); |
---|
| 49 | assert(paraboloid1.Inside(G4ThreeVector((- 2 * kCarTolerance + std::sqrt(4.5)) / std::sqrt(2.), (- 2. * kCarTolerance + std::sqrt(4.5)) / std::sqrt(2.), 0.)) == kInside); |
---|
| 50 | |
---|
| 51 | assert(paraboloid1.Inside(G4ThreeVector(0., 0., -1.)) == kSurface); |
---|
| 52 | assert(paraboloid1.Inside(G4ThreeVector(0., 0., 1.)) == kSurface); |
---|
| 53 | assert(paraboloid1.Inside(G4ThreeVector(0., 0., - 1. - 2 * kCarTolerance)) == kOutside); |
---|
| 54 | assert(paraboloid1.Inside(G4ThreeVector(0., 0., 1. + 2 * kCarTolerance)) == kOutside); |
---|
| 55 | assert(paraboloid1.Inside(G4ThreeVector(0., 0., - 1. + 2 * kCarTolerance)) == kInside); |
---|
| 56 | assert(paraboloid1.Inside(G4ThreeVector(0., 0., 1. - 2 * kCarTolerance)) == kInside); |
---|
| 57 | assert(paraboloid1.Inside(G4ThreeVector((- 2 * kCarTolerance) / std::sqrt(2.), ( 2. * kCarTolerance ) / std::sqrt(2.), -1.)) == kOutside); |
---|
| 58 | |
---|
| 59 | assert(paraboloid2.Inside(G4ThreeVector(2.598076211, 1.5, .01)) == kSurface); |
---|
| 60 | assert(paraboloid2.Inside(G4ThreeVector((2 * kCarTolerance + 3.) * std::sqrt(3.) / 2., (2. * kCarTolerance + 3.) / 2., .01)) == kOutside); |
---|
| 61 | assert(paraboloid2.Inside(G4ThreeVector((- 2 * kCarTolerance + 3.) * std::sqrt(3.) / 2., (- 2. * kCarTolerance + 3.) / 2., .01)) == kSurface); |
---|
| 62 | |
---|
| 63 | assert(paraboloid2.Inside(G4ThreeVector(std::sqrt(6.5) / std::sqrt(2.), std::sqrt(6.5) / std::sqrt(2.), 0.)) == kSurface); |
---|
| 64 | assert(paraboloid2.Inside(G4ThreeVector(( 2. * kCarTolerance + std::sqrt(6.5)) / std::sqrt(2.), ( 2. * kCarTolerance + std::sqrt(6.5)) / std::sqrt(2.), 0.)) == kOutside); |
---|
| 65 | assert(paraboloid2.Inside(G4ThreeVector((- 2. * kCarTolerance + std::sqrt(6.5)) / std::sqrt(2.), (- 2. * kCarTolerance + std::sqrt(6.5)) / std::sqrt(2.), 0.)) == kInside); |
---|
| 66 | |
---|
| 67 | assert(paraboloid2.Inside(G4ThreeVector(0., 0., -.01)) == kSurface); |
---|
| 68 | assert(paraboloid2.Inside(G4ThreeVector(0., 0., .01)) == kSurface); |
---|
| 69 | assert(paraboloid2.Inside(G4ThreeVector(0., 0., - .01 - 2 * kCarTolerance)) == kOutside); |
---|
| 70 | assert(paraboloid2.Inside(G4ThreeVector(0., 0., .01 + 2 * kCarTolerance)) == kOutside); |
---|
| 71 | assert(paraboloid2.Inside(G4ThreeVector(0., 0., - .01 + 2 * kCarTolerance)) == kInside); |
---|
| 72 | assert(paraboloid2.Inside(G4ThreeVector(0., 0., .01 - 2 * kCarTolerance)) == kInside); |
---|
| 73 | assert(paraboloid2.Inside(G4ThreeVector((- 2. - 2 * kCarTolerance) / std::sqrt(2.), (2. + 2. * kCarTolerance ) / std::sqrt(2.), -.01)) == kOutside); |
---|
| 74 | assert(paraboloid2.Inside(G4ThreeVector((- 2. + 2 * kCarTolerance) / std::sqrt(2.), (2. - 2. * kCarTolerance ) / std::sqrt(2.), -.01)) == kSurface); |
---|
| 75 | assert(paraboloid2.Inside(G4ThreeVector((- 2.) / std::sqrt(2.), (2.) / std::sqrt(2.), -.01)) == kSurface); |
---|
| 76 | |
---|
| 77 | // Test DistanceToIn(p, v) function. |
---|
| 78 | assert(std::fabs(paraboloid1.DistanceToIn( G4ThreeVector(3.,2.,10.), |
---|
| 79 | G4ThreeVector(-0.099014754299999993558678568206233, -0.099014754299999993558678568206233, -0.99014754279999994679428709787317)) |
---|
| 80 | - 9.0895544461477406628091557649896) < kCarTolerance); |
---|
| 81 | assert(std::fabs(paraboloid1.DistanceToIn(G4ThreeVector(1., 0., 1.), G4ThreeVector(0., 0., -1.))) < kCarTolerance); |
---|
| 82 | assert(std::fabs(paraboloid1.DistanceToIn(G4ThreeVector(0., 0., -2.), G4ThreeVector(0., 0., 1.)) - 1) < kCarTolerance); |
---|
| 83 | assert(std::fabs(paraboloid1.DistanceToIn(G4ThreeVector(-2., 0., -1.), G4ThreeVector(1/std::sqrt(2.), 0., 1/std::sqrt(2.))) - 1/ std::sqrt(2.)) < kCarTolerance); |
---|
| 84 | assert(std::fabs(paraboloid1.DistanceToIn(G4ThreeVector(1., 0., 1.), G4ThreeVector(1., 0., 0.)) ) >= kInfinity); |
---|
| 85 | assert(std::fabs(paraboloid1.DistanceToIn(G4ThreeVector(1., 0., 1.), G4ThreeVector(1., 0., -0.0000001)) ) <= kCarTolerance); |
---|
| 86 | |
---|
| 87 | assert(std::fabs(paraboloid2.DistanceToIn( G4ThreeVector(3.,2.,10.), |
---|
| 88 | G4ThreeVector(-0.099014754299999993558678568206233, -0.099014754299999993558678568206233, -0.99014754279999994679428709787317)) |
---|
| 89 | - 10.0894054352) < kCarTolerance); |
---|
| 90 | assert(std::fabs(paraboloid2.DistanceToIn(G4ThreeVector(1., 0., .01), G4ThreeVector(0., 0., -1.))) < kCarTolerance); |
---|
| 91 | assert(std::fabs(paraboloid2.DistanceToIn(G4ThreeVector(0., 0., -1.), G4ThreeVector(0., 0., 1.)) - 0.99) < kCarTolerance); |
---|
| 92 | assert(std::fabs(paraboloid2.DistanceToIn(G4ThreeVector(-2.2, 0., -.01), G4ThreeVector(1/std::sqrt(2.), 0., 1/std::sqrt(2.))) - 0.004669633692) < kCarTolerance); |
---|
| 93 | assert(std::fabs(paraboloid2.DistanceToIn(G4ThreeVector(1., 0., .01), G4ThreeVector(1., 0., 0.)) ) >= kInfinity); |
---|
| 94 | assert(std::fabs(paraboloid2.DistanceToIn(G4ThreeVector(1., 0., .01), G4ThreeVector(1., 0., -0.0000001)) ) <= kCarTolerance); |
---|
| 95 | |
---|
| 96 | // Test DistanceToOut(p, v, ...) function. |
---|
| 97 | assert(std::fabs(paraboloid1.DistanceToOut(G4ThreeVector(1., 0., 1.), G4ThreeVector(0., 0., -1.), false, NULL, NULL) - 1.7777777777777776) < kCarTolerance); |
---|
| 98 | assert(std::fabs(paraboloid1.DistanceToOut(G4ThreeVector(0., 0., 0.), G4ThreeVector(0., 0., -1.), false, NULL, NULL) - 1) < kCarTolerance); |
---|
| 99 | assert(std::fabs(paraboloid1.DistanceToOut(G4ThreeVector(0., 0., 0.), G4ThreeVector(1. / std::sqrt(2.), 1. / std::sqrt(2.), 0.), false, NULL, NULL) - 2.1213203435) < kCarTolerance); |
---|
| 100 | assert(std::fabs(paraboloid1.DistanceToOut(G4ThreeVector(0., 0., 0.), G4ThreeVector(1. / std::sqrt(2.), 0., 1. / std::sqrt(2.)), false, NULL, NULL) - 1.4142135623) < kCarTolerance); |
---|
| 101 | assert(std::fabs(paraboloid1.DistanceToOut(G4ThreeVector(0., 0., 0.), G4ThreeVector(1. / std::sqrt(2.), 0., -1. / std::sqrt(2.)), false, NULL, NULL) - 1.1912334058) < kCarTolerance); |
---|
| 102 | assert(std::fabs(paraboloid1.DistanceToOut(G4ThreeVector(1., 0., 1.), G4ThreeVector(1., 0., 0.), false, NULL, NULL) - 2.) < kCarTolerance); |
---|
| 103 | assert(std::fabs(paraboloid1.DistanceToOut(G4ThreeVector(1., 0., 1.), G4ThreeVector(1., 0., 0.00000001), false, NULL, NULL)) < kCarTolerance); |
---|
| 104 | |
---|
| 105 | assert(std::fabs(paraboloid2.DistanceToOut(G4ThreeVector(2.5, 0., .01), G4ThreeVector(0., 0., -1.), false, NULL, NULL) - 0.010999999999999999) < kCarTolerance); |
---|
| 106 | assert(std::fabs(paraboloid2.DistanceToOut(G4ThreeVector(0., 0., 0.), G4ThreeVector(0., 0., -1.), false, NULL, NULL) - 0.01) < kCarTolerance); |
---|
| 107 | assert(std::fabs(paraboloid2.DistanceToOut(G4ThreeVector(0., 0., 0.), G4ThreeVector(1. / std::sqrt(2.), 1. / std::sqrt(2.), 0.), false, NULL, NULL) - 2.5495097567) < kCarTolerance); |
---|
| 108 | assert(std::fabs(paraboloid2.DistanceToOut(G4ThreeVector(0., 0., 0.), G4ThreeVector(1. / std::sqrt(2.), 0., 1. / std::sqrt(2.)), false, NULL, NULL) - 0.01414213562) < kCarTolerance); |
---|
| 109 | assert(std::fabs(paraboloid2.DistanceToOut(G4ThreeVector(0., 0., 0.), G4ThreeVector(1. / std::sqrt(2.), 0., -1. / std::sqrt(2.)), false, NULL, NULL) - 0.01414213562) < kCarTolerance); |
---|
| 110 | assert(std::fabs(paraboloid2.DistanceToOut(G4ThreeVector(1., 0., -.01), G4ThreeVector(1., 0., 0.), false, NULL, NULL) - 1.) < kCarTolerance); |
---|
| 111 | assert(std::fabs(paraboloid2.DistanceToOut(G4ThreeVector(1., 0., .01), G4ThreeVector(1., 0., 0.00000001), false, NULL, NULL)) < kCarTolerance); |
---|
| 112 | |
---|
| 113 | // Test volume function. |
---|
| 114 | assert(std::fabs(paraboloid1.GetCubicVolume() - 28.274334) < 1e-6); |
---|
| 115 | assert(std::fabs(paraboloid2.GetCubicVolume() - 0.408407) < 1e-6); |
---|
| 116 | |
---|
| 117 | // Test area function. |
---|
| 118 | // G4cout<<paraboloid1.GetPolyhedron()->GetSurfaceArea()<<G4endl; |
---|
| 119 | assert(std::fabs(paraboloid1.GetSurfaceArea() - 66.758844) < 1e-6); |
---|
| 120 | assert(std::fabs(paraboloid2.GetSurfaceArea() - 56.551935) < 1e-6); |
---|
| 121 | |
---|
| 122 | // Test SurfaceNormal(p) function. |
---|
| 123 | assert((paraboloid1.SurfaceNormal(G4ThreeVector(1., 2., 1.)) - G4ThreeVector(0., 0., 1.)).r() < kCarTolerance); |
---|
| 124 | assert((paraboloid1.SurfaceNormal(G4ThreeVector(1.732050808, 2.449489743, 1.)) - G4ThreeVector(0.40824829,0.57735027,0.70710678)).r() < 1e-5); |
---|
| 125 | assert((paraboloid1.SurfaceNormal(G4ThreeVector(1.573213272, 1.573213272, 0.1)) - G4ThreeVector(0.49718308,0.49718308,-0.71106819)).r() < 1e-5); |
---|
| 126 | assert((paraboloid1.SurfaceNormal(G4ThreeVector(0., 0., -1.)) - G4ThreeVector(0., 0., -1.)).r() < kCarTolerance); |
---|
| 127 | |
---|
| 128 | assert((paraboloid2.SurfaceNormal(G4ThreeVector(1., 2., 1.)) - G4ThreeVector(0., 0., 1.)).r() < kCarTolerance); |
---|
| 129 | assert((paraboloid2.SurfaceNormal(G4ThreeVector(1.732050808, 2.449489743, 0.01)) - G4ThreeVector(0.40824829,0.57735027,0.70710678)).r() < 1e-5); |
---|
| 130 | assert((paraboloid2.SurfaceNormal(G4ThreeVector(1.658312395, 2., 0.001)) - G4ThreeVector(0.013263635,0.015996545,-0.99978407)).r() < 1e-5); |
---|
| 131 | assert((paraboloid2.SurfaceNormal(G4ThreeVector(0., 0., -.01)) - G4ThreeVector(0., 0., -1.)).r() < kCarTolerance); |
---|
| 132 | |
---|
| 133 | |
---|
| 134 | // Add Test Distance To Out for User Problem with Substraction Of Paraboloid :: Problem Report N1015 |
---|
| 135 | G4Paraboloid paraboloid3("Paraboloid1", 72., 0., 240.); |
---|
| 136 | // G4Paraboloid paraboloid3("Paraboloid1", 72., 210., 240.);//This test is Ok, Intersection with DZ working correctly |
---|
| 137 | G4double distOut1; |
---|
| 138 | distOut1=paraboloid3.DistanceToOut(G4ThreeVector(200., 0., 72.), G4ThreeVector(0.0,0.,-1.), false, NULL, NULL); |
---|
| 139 | assert((distOut1-44.0)<1e-5); |
---|
| 140 | //G4cout<<"Test3::distOut="<<distOut1<<G4endl; |
---|
| 141 | |
---|
| 142 | distOut1=paraboloid3.DistanceToOut(G4ThreeVector(200., 0., 72.), G4ThreeVector(0.000000000001,0.,-1.), false, NULL, NULL); |
---|
| 143 | assert((distOut1-44.0)<1e-5); |
---|
| 144 | //G4cout<<"Test3::distOut="<<distOut1<<G4endl; |
---|
| 145 | // Add Rotation On the Surface around "Problem" Point(200.,0.,72.) |
---|
| 146 | |
---|
| 147 | G4double tolA=0.25e-7; |
---|
| 148 | G4ThreeVector In (200.,0.,72.); |
---|
| 149 | EInside in; |
---|
| 150 | G4ThreeVector Dir,vDir,pSurf; |
---|
| 151 | Dir=G4ThreeVector(10*tolA,0.,-1.); |
---|
| 152 | vDir=Dir.unit(); |
---|
| 153 | in=paraboloid3.Inside(In); |
---|
| 154 | if(in!=kSurface)G4cout<<"Problem ::Point p"<<In<<" is NOT On Surface"<<G4endl; |
---|
| 155 | |
---|
| 156 | for(G4int i=0; i<100; i++){ |
---|
| 157 | |
---|
| 158 | G4double distOut=paraboloid3.DistanceToOut(In,vDir); |
---|
| 159 | G4cout.precision(16); |
---|
| 160 | pSurf=In+vDir*distOut; |
---|
| 161 | in=paraboloid3.Inside(pSurf); |
---|
| 162 | if(in!=kSurface) G4cout<<"Problem :: ps is Not on the Surface DistToOut="<<distOut<<" dir="<<vDir<<G4endl; |
---|
| 163 | Dir=Dir-G4ThreeVector(tolA,0,0); |
---|
| 164 | vDir=Dir.unit(); |
---|
| 165 | |
---|
| 166 | } |
---|
| 167 | // Rotation from the Lower DZ plane |
---|
| 168 | Dir=G4ThreeVector(10*tolA,0.,1.); |
---|
| 169 | vDir=Dir.unit(); |
---|
| 170 | In= G4ThreeVector (0.,0.,-72.); |
---|
| 171 | for(G4int i=0; i<100; i++){ |
---|
| 172 | |
---|
| 173 | G4double distOut=paraboloid3.DistanceToOut(In,vDir); |
---|
| 174 | G4cout.precision(16); |
---|
| 175 | pSurf=In+vDir*distOut; |
---|
| 176 | in=paraboloid3.Inside(pSurf); |
---|
| 177 | if(in!=kSurface) G4cout<<"Problem :: ps is Not on the Surface DistToOut="<<distOut<<" dir="<<vDir<<G4endl; |
---|
| 178 | Dir=Dir-G4ThreeVector(tolA,0,0); |
---|
| 179 | vDir=Dir.unit(); |
---|
| 180 | } |
---|
| 181 | // Paraboloid with R1!=0 and with Point situated On both Surfaces : Z and Parabolic |
---|
| 182 | G4Paraboloid paraboloid5("Paraboloid1", 10., 0., 100.); |
---|
| 183 | distOut1=paraboloid5.DistanceToOut(G4ThreeVector(100., 0., 10.), G4ThreeVector(0.0,0.,-1.), false, NULL, NULL); |
---|
| 184 | assert((distOut1-0.0)<1e-5); |
---|
| 185 | |
---|
| 186 | Dir=G4ThreeVector(-0.9,0.,-0.1); |
---|
| 187 | vDir=Dir.unit(); |
---|
| 188 | distOut1=paraboloid5.DistanceToOut(G4ThreeVector(100., 0., 10.), vDir, false, NULL, NULL); |
---|
| 189 | pSurf=G4ThreeVector(100.0,0.,10.)+vDir*distOut1; |
---|
| 190 | in=paraboloid5.Inside(pSurf); |
---|
| 191 | if(in!=kSurface)G4cout<<"Problem :: ps is Not on the Surface "<<pSurf<<" vDir="<<vDir<<G4endl; |
---|
| 192 | |
---|
| 193 | return 0; |
---|
| 194 | } |
---|