Import Geant4 9.6.0 source tree
This commit is contained in:
Gabriele Cosmo
@@ -25,18 +25,7 @@
|
||||
// ********************************************************************
|
||||
//
|
||||
//
|
||||
// $Id: G4QuadrangularFacet.cc,v 1.9 2010-09-23 10:27:25 gcosmo Exp $
|
||||
// GEANT4 tag $Name: not supported by cvs2svn $
|
||||
//
|
||||
// %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
|
||||
//
|
||||
// MODULE: G4QuadrangularFacet.cc
|
||||
//
|
||||
// Date: 15/06/2005
|
||||
// Author: P R Truscott
|
||||
// Organisation: QinetiQ Ltd, UK
|
||||
// Customer: UK Ministry of Defence : RAO CRP TD Electronic Systems
|
||||
// Contract: C/MAT/N03517
|
||||
// $Id$
|
||||
//
|
||||
// %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
|
||||
//
|
||||
@@ -44,91 +33,105 @@
|
||||
// --------------
|
||||
//
|
||||
// 31 October 2004, P R Truscott, QinetiQ Ltd, UK - Created.
|
||||
// 12 October 2012, M Gayer, CERN
|
||||
// New implementation reducing memory requirements by 50%,
|
||||
// and considerable CPU speedup together with the new
|
||||
// implementation of G4TessellatedSolid.
|
||||
//
|
||||
// %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
|
||||
|
||||
#include "G4QuadrangularFacet.hh"
|
||||
#include "globals.hh"
|
||||
#include "geomdefs.hh"
|
||||
#include "Randomize.hh"
|
||||
|
||||
using namespace std;
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
// !!!THIS IS A FUDGE!!! IT'S TWO ADJACENT G4TRIANGULARFACETS
|
||||
// --- NOT EFFICIENT BUT PRACTICAL.
|
||||
//
|
||||
G4QuadrangularFacet::G4QuadrangularFacet (const G4ThreeVector Pt0,
|
||||
const G4ThreeVector vt1, const G4ThreeVector vt2,
|
||||
const G4ThreeVector vt3, G4FacetVertexType vertexType)
|
||||
: G4VFacet(), facet1(0), facet2(0)
|
||||
G4QuadrangularFacet::G4QuadrangularFacet (const G4ThreeVector &vt0,
|
||||
const G4ThreeVector &vt1,
|
||||
const G4ThreeVector &vt2,
|
||||
const G4ThreeVector &vt3,
|
||||
G4FacetVertexType vertexType)
|
||||
{
|
||||
P0 = Pt0;
|
||||
nVertices = 4;
|
||||
G4ThreeVector e1, e2, e3;
|
||||
|
||||
SetVertex(0, vt0);
|
||||
if (vertexType == ABSOLUTE)
|
||||
{
|
||||
P.push_back(vt1);
|
||||
P.push_back(vt2);
|
||||
P.push_back(vt3);
|
||||
|
||||
E.push_back(vt1 - P0);
|
||||
E.push_back(vt2 - P0);
|
||||
E.push_back(vt3 - P0);
|
||||
SetVertex(1, vt1);
|
||||
SetVertex(2, vt2);
|
||||
SetVertex(3, vt3);
|
||||
|
||||
e1 = vt1 - vt0;
|
||||
e2 = vt2 - vt0;
|
||||
e3 = vt3 - vt0;
|
||||
}
|
||||
else
|
||||
{
|
||||
P.push_back(P0 + vt1);
|
||||
P.push_back(P0 + vt2);
|
||||
P.push_back(P0 + vt3);
|
||||
|
||||
E.push_back(vt1);
|
||||
E.push_back(vt2);
|
||||
E.push_back(vt3);
|
||||
}
|
||||
SetVertex(1, vt0 + vt1);
|
||||
SetVertex(2, vt0 + vt2);
|
||||
SetVertex(3, vt0 + vt3);
|
||||
|
||||
G4double length1 = E[0].mag();
|
||||
G4double length2 = (P[1]-P[0]).mag();
|
||||
G4double length3 = (P[2]-P[1]).mag();
|
||||
G4double length4 = E[2].mag();
|
||||
|
||||
G4ThreeVector normal1 = E[0].cross(E[1]).unit();
|
||||
G4ThreeVector normal2 = E[1].cross(E[2]).unit();
|
||||
|
||||
if (length1 <= kCarTolerance || length2 <= kCarTolerance ||
|
||||
length3 <= kCarTolerance || length4 <= kCarTolerance ||
|
||||
normal1.dot(normal2) < 0.9999999999)
|
||||
e1 = vt1;
|
||||
e2 = vt2;
|
||||
e3 = vt3;
|
||||
}
|
||||
G4double length1 = e1.mag();
|
||||
G4double length2 = (GetVertex(2)-GetVertex(1)).mag();
|
||||
G4double length3 = (GetVertex(3)-GetVertex(2)).mag();
|
||||
G4double length4 = e3.mag();
|
||||
|
||||
G4ThreeVector normal1 = e1.cross(e2).unit();
|
||||
G4ThreeVector normal2 = e2.cross(e3).unit();
|
||||
|
||||
bool isDefined = (length1 > kCarTolerance && length2 > kCarTolerance &&
|
||||
length3 > kCarTolerance && length4 > kCarTolerance &&
|
||||
normal1.dot(normal2) >= 0.9999999999);
|
||||
|
||||
if (isDefined)
|
||||
{
|
||||
fFacet1 = G4TriangularFacet (GetVertex(0),GetVertex(1),
|
||||
GetVertex(2),ABSOLUTE);
|
||||
fFacet2 = G4TriangularFacet (GetVertex(0),GetVertex(2),
|
||||
GetVertex(3),ABSOLUTE);
|
||||
|
||||
G4TriangularFacet facet3 (GetVertex(0),GetVertex(1),GetVertex(3),ABSOLUTE);
|
||||
G4TriangularFacet facet4 (GetVertex(1),GetVertex(2),GetVertex(3),ABSOLUTE);
|
||||
|
||||
G4ThreeVector normal12 = fFacet1.GetSurfaceNormal()
|
||||
+ fFacet2.GetSurfaceNormal();
|
||||
G4ThreeVector normal34 = facet3.GetSurfaceNormal()
|
||||
+ facet4.GetSurfaceNormal();
|
||||
G4ThreeVector normal = 0.25 * (normal12 + normal34);
|
||||
|
||||
fFacet1.SetSurfaceNormal (normal);
|
||||
fFacet2.SetSurfaceNormal (normal);
|
||||
|
||||
G4ThreeVector vtmp = 0.5 * (e1 + e2);
|
||||
fCircumcentre = GetVertex(0) + vtmp;
|
||||
G4double radiusSqr = vtmp.mag2();
|
||||
fRadius = std::sqrt(radiusSqr);
|
||||
}
|
||||
else
|
||||
{
|
||||
G4Exception("G4QuadrangularFacet::G4QuadrangularFacet()",
|
||||
"InvalidSetup", JustWarning,
|
||||
"GeomSolids0002", JustWarning,
|
||||
"Length of sides of facet are too small or sides not planar.");
|
||||
G4cerr << G4endl;
|
||||
G4cerr << "P0 = " << P0 << G4endl;
|
||||
G4cerr << "P1 = " << P[0] << G4endl;
|
||||
G4cerr << "P2 = " << P[1] << G4endl;
|
||||
G4cerr << "P3 = " << P[2] << G4endl;
|
||||
G4cerr << "Side lengths = P0->P1" << length1 << G4endl;
|
||||
G4cerr << "Side lengths = P1->P2" << length2 << G4endl;
|
||||
G4cerr << "Side lengths = P2->P3" << length3 << G4endl;
|
||||
G4cerr << "Side lengths = P3->P0" << length4 << G4endl;
|
||||
G4cerr << G4endl;
|
||||
|
||||
isDefined = false;
|
||||
geometryType = "G4QuadragularFacet";
|
||||
surfaceNormal = G4ThreeVector(0.0,0.0,0.0);
|
||||
}
|
||||
else
|
||||
{
|
||||
isDefined = true;
|
||||
geometryType = "G4QuadrangularFacet";
|
||||
|
||||
facet1 = new G4TriangularFacet(P0,P[0],P[1],ABSOLUTE);
|
||||
facet2 = new G4TriangularFacet(P0,P[1],P[2],ABSOLUTE);
|
||||
surfaceNormal = normal1;
|
||||
|
||||
G4ThreeVector vtmp = 0.5 * (E[0] + E[1]);
|
||||
circumcentre = P0 + vtmp;
|
||||
radiusSqr = vtmp.mag2();
|
||||
radius = std::sqrt(radiusSqr);
|
||||
|
||||
for (size_t i=0; i<4; i++) I.push_back(0);
|
||||
G4cerr << endl;
|
||||
G4cerr << "P0 = " << GetVertex(0) << endl;
|
||||
G4cerr << "P1 = " << GetVertex(1) << endl;
|
||||
G4cerr << "P2 = " << GetVertex(2) << endl;
|
||||
G4cerr << "P3 = " << GetVertex(3) << endl;
|
||||
G4cerr << "Side lengths = P0->P1" << length1 << endl;
|
||||
G4cerr << "Side lengths = P1->P2" << length2 << endl;
|
||||
G4cerr << "Side lengths = P2->P3" << length3 << endl;
|
||||
G4cerr << "Side lengths = P3->P0" << length4 << endl;
|
||||
G4cerr << endl;
|
||||
fRadius = 0.0;
|
||||
}
|
||||
}
|
||||
|
||||
@@ -136,12 +139,6 @@ G4QuadrangularFacet::G4QuadrangularFacet (const G4ThreeVector Pt0,
|
||||
//
|
||||
G4QuadrangularFacet::~G4QuadrangularFacet ()
|
||||
{
|
||||
delete facet1;
|
||||
delete facet2;
|
||||
|
||||
P.clear();
|
||||
E.clear();
|
||||
I.clear();
|
||||
}
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
@@ -149,49 +146,43 @@ G4QuadrangularFacet::~G4QuadrangularFacet ()
|
||||
G4QuadrangularFacet::G4QuadrangularFacet (const G4QuadrangularFacet &rhs)
|
||||
: G4VFacet(rhs)
|
||||
{
|
||||
facet1 = new G4TriangularFacet(*(rhs.facet1));
|
||||
facet2 = new G4TriangularFacet(*(rhs.facet2));
|
||||
fFacet1 = rhs.fFacet1;
|
||||
fFacet2 = rhs.fFacet2;
|
||||
fRadius = 0.0;
|
||||
}
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
const G4QuadrangularFacet &
|
||||
G4QuadrangularFacet::operator=(G4QuadrangularFacet &rhs)
|
||||
G4QuadrangularFacet &
|
||||
G4QuadrangularFacet::operator=(const G4QuadrangularFacet &rhs)
|
||||
{
|
||||
// Check assignment to self
|
||||
//
|
||||
if (this == &rhs) { return *this; }
|
||||
if (this == &rhs)
|
||||
return *this;
|
||||
|
||||
// Copy base class data
|
||||
//
|
||||
G4VFacet::operator=(rhs);
|
||||
fFacet1 = rhs.fFacet1;
|
||||
fFacet2 = rhs.fFacet2;
|
||||
fRadius = 0.0;
|
||||
|
||||
// Copy data
|
||||
//
|
||||
delete facet1; facet1 = new G4TriangularFacet(*(rhs.facet1));
|
||||
delete facet2; facet2 = new G4TriangularFacet(*(rhs.facet2));
|
||||
|
||||
return *this;
|
||||
return *this;
|
||||
}
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
G4VFacet *G4QuadrangularFacet::GetClone ()
|
||||
{
|
||||
G4QuadrangularFacet *c =
|
||||
new G4QuadrangularFacet (P0, P[0], P[1], P[2], ABSOLUTE);
|
||||
G4VFacet *cc = 0;
|
||||
cc = c;
|
||||
return cc;
|
||||
G4QuadrangularFacet *c = new G4QuadrangularFacet (GetVertex(0), GetVertex(1),
|
||||
GetVertex(2), GetVertex(3),
|
||||
ABSOLUTE);
|
||||
return c;
|
||||
}
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
G4ThreeVector G4QuadrangularFacet::Distance (const G4ThreeVector &p)
|
||||
{
|
||||
G4ThreeVector v1 = facet1->Distance(p);
|
||||
G4ThreeVector v2 = facet2->Distance(p);
|
||||
|
||||
G4ThreeVector v1 = fFacet1.Distance(p);
|
||||
G4ThreeVector v2 = fFacet2.Distance(p);
|
||||
|
||||
if (v1.mag2() < v2.mag2()) return v1;
|
||||
else return v2;
|
||||
}
|
||||
@@ -199,68 +190,26 @@ G4ThreeVector G4QuadrangularFacet::Distance (const G4ThreeVector &p)
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
G4double G4QuadrangularFacet::Distance (const G4ThreeVector &p,
|
||||
const G4double)
|
||||
{
|
||||
/*G4ThreeVector D = P0 - p;
|
||||
G4double d = E[0].dot(D);
|
||||
G4double e = E[1].dot(D);
|
||||
G4double s = b*e - c*d;
|
||||
G4double t = b*d - a*e;*/
|
||||
G4double dist = kInfinity;
|
||||
|
||||
/*if (s+t > 1.0 || s < 0.0 || t < 0.0)
|
||||
{
|
||||
G4ThreeVector D0 = P0 - p;
|
||||
G4ThreeVector D1 = P[0] - p;
|
||||
G4ThreeVector D2 = P[1] - p;
|
||||
|
||||
G4double d0 = D0.mag();
|
||||
G4double d1 = D1.mag();
|
||||
G4double d2 = D2.mag();
|
||||
|
||||
dist = min(d0, min(d1, d2));
|
||||
if (dist > minDist) return kInfinity;
|
||||
}*/
|
||||
|
||||
dist = Distance(p).mag();
|
||||
|
||||
G4double)
|
||||
{
|
||||
G4double dist = Distance(p).mag();
|
||||
return dist;
|
||||
}
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
G4double G4QuadrangularFacet::Distance (const G4ThreeVector &p,
|
||||
const G4double, const G4bool outgoing)
|
||||
G4double G4QuadrangularFacet::Distance (const G4ThreeVector &p, G4double,
|
||||
const G4bool outgoing)
|
||||
{
|
||||
/*G4ThreeVector D = P0 - p;
|
||||
G4double d = E[0].dot(D);
|
||||
G4double e = E[1].dot(D);
|
||||
G4double s = b*e - c*d;
|
||||
G4double t = b*d - a*e;*/
|
||||
G4double dist = kInfinity;
|
||||
|
||||
/*if (s+t > 1.0 || s < 0.0 || t < 0.0)
|
||||
{
|
||||
G4ThreeVector D0 = P0 - p;
|
||||
G4ThreeVector D1 = P[0] - p;
|
||||
G4ThreeVector D2 = P[1] - p;
|
||||
|
||||
G4double d0 = D0.mag();
|
||||
G4double d1 = D1.mag();
|
||||
G4double d2 = D2.mag();
|
||||
|
||||
dist = min(d0, min(d1, d2));
|
||||
if (dist > minDist ||
|
||||
(D0.dot(surfaceNormal) > 0.0 && !outgoing) ||
|
||||
(D0.dot(surfaceNormal) < 0.0 && outgoing)) return kInfinity;
|
||||
}*/
|
||||
|
||||
G4double dist;
|
||||
|
||||
G4ThreeVector v = Distance(p);
|
||||
G4double dir = v.dot(surfaceNormal);
|
||||
if ((dir > dirTolerance && !outgoing) ||
|
||||
(dir <-dirTolerance && outgoing)) dist = kInfinity;
|
||||
else dist = v.mag();
|
||||
|
||||
G4double dir = v.dot(GetSurfaceNormal());
|
||||
if ( ((dir > dirTolerance) && (!outgoing))
|
||||
|| ((dir < -dirTolerance) && outgoing))
|
||||
dist = kInfinity;
|
||||
else
|
||||
dist = v.mag();
|
||||
return dist;
|
||||
}
|
||||
|
||||
@@ -268,70 +217,68 @@ G4double G4QuadrangularFacet::Distance (const G4ThreeVector &p,
|
||||
//
|
||||
G4double G4QuadrangularFacet::Extent (const G4ThreeVector axis)
|
||||
{
|
||||
G4double s = P0.dot(axis);
|
||||
for (G4ThreeVectorList::iterator it=P.begin(); it!=P.end(); it++)
|
||||
{
|
||||
G4double sp = it->dot(axis);
|
||||
if (sp > s) s = sp;
|
||||
}
|
||||
G4double ss = 0;
|
||||
|
||||
return s;
|
||||
for (G4int i = 0; i <= 3; ++i)
|
||||
{
|
||||
G4double sp = GetVertex(i).dot(axis);
|
||||
if (sp > ss) ss = sp;
|
||||
}
|
||||
return ss;
|
||||
}
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
G4bool G4QuadrangularFacet::Intersect (const G4ThreeVector &p,
|
||||
const G4ThreeVector &v, G4bool outgoing, G4double &distance,
|
||||
G4double &distFromSurface, G4ThreeVector &normal)
|
||||
const G4ThreeVector &v,
|
||||
G4bool outgoing,
|
||||
G4double &distance,
|
||||
G4double &distFromSurface,
|
||||
G4ThreeVector &normal)
|
||||
{
|
||||
G4bool intersect =
|
||||
facet1->Intersect(p,v,outgoing,distance,distFromSurface,normal);
|
||||
fFacet1.Intersect(p,v,outgoing,distance,distFromSurface,normal);
|
||||
if (!intersect) intersect =
|
||||
fFacet2.Intersect(p,v,outgoing,distance,distFromSurface,normal);
|
||||
if (!intersect)
|
||||
{
|
||||
intersect = facet2->Intersect(p,v,outgoing,distance,distFromSurface,normal);
|
||||
distance = distFromSurface = kInfinity;
|
||||
normal.set(0,0,0);
|
||||
}
|
||||
|
||||
if (!intersect)
|
||||
{
|
||||
distance = kInfinity;
|
||||
distFromSurface = kInfinity;
|
||||
normal = G4ThreeVector(0.0,0.0,0.0);
|
||||
}
|
||||
|
||||
return intersect;
|
||||
}
|
||||
|
||||
////////////////////////////////////////////////////////////////////////
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
// GetPointOnFace
|
||||
// Auxiliary method to get a random point on surface
|
||||
//
|
||||
// Auxiliary method for get a random point on surface
|
||||
|
||||
G4ThreeVector G4QuadrangularFacet::GetPointOnFace() const
|
||||
{
|
||||
G4ThreeVector pr;
|
||||
|
||||
if ( G4UniformRand() < 0.5 )
|
||||
{
|
||||
pr = facet1->GetPointOnFace();
|
||||
}
|
||||
else
|
||||
{
|
||||
pr = facet2->GetPointOnFace();
|
||||
}
|
||||
|
||||
G4ThreeVector pr = (G4RandFlat::shoot(0.,1.) < 0.5)
|
||||
? fFacet1.GetPointOnFace() : fFacet2.GetPointOnFace();
|
||||
return pr;
|
||||
}
|
||||
|
||||
////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
// GetArea
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
// Auxiliary method for returning the surface area
|
||||
|
||||
//
|
||||
G4double G4QuadrangularFacet::GetArea()
|
||||
{
|
||||
if (!area) { area = facet1->GetArea() + facet2->GetArea(); }
|
||||
|
||||
G4double area = fFacet1.GetArea() + fFacet2.GetArea();
|
||||
return area;
|
||||
}
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
G4String G4QuadrangularFacet::GetEntityType () const
|
||||
{
|
||||
return "G4QuadrangularFacet";
|
||||
}
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
G4ThreeVector G4QuadrangularFacet::GetSurfaceNormal () const
|
||||
{
|
||||
return fFacet1.GetSurfaceNormal();
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user