src/Tools/t_shape_builder.py

   1 # -*- coding: iso-8859-1 -*-
   2
   3 import sys
   4 import salome
   5
   6 import GEOM
   7 from salome.geom import geomBuilder
   8 import math
   9 import SALOMEDS
  10
  11
  12 #O = geompy.MakeVertex(0, 0, 0)
  13 #OX = geompy.MakeVectorDXDYDZ(1, 0, 0)
  14 #OY = geompy.MakeVectorDXDYDZ(0, 1, 0)
  15 #OZ = geompy.MakeVectorDXDYDZ(0, 0, 1)
  16
  17 #geompy.addToStudy( O, 'O' )
  18 #geompy.addToStudy( OX, 'OX' )
  19 #geompy.addToStudy( OY, 'OY' )
  20 #geompy.addToStudy( OZ, 'OZ' )
  21
  22 #r1 = 100.0
  23 #r2 = 50.0
  24 #h1 = 200.0
  25 #h2 = 200.0
  26
  27 def demidisk(study, r1, a1, roty=0):
  28   geompy = geomBuilder.New(study)
  29
  30   O = geompy.MakeVertex(0, 0, 0)
  31   OX = geompy.MakeVectorDXDYDZ(1, 0, 0)
  32   OY = geompy.MakeVectorDXDYDZ(0, 1, 0)
  33   OZ = geompy.MakeVectorDXDYDZ(0, 0, 1)
  34
  35   v=range(8)
  36   l=range(8)
  37   v0 = geompy.MakeVertex(0, 0, 0)
  38   v[0] = geompy.MakeVertex(0, r1/2.0, 0)
  39   v[1] = geompy.MakeVertex(0, r1, 0)
  40   l[1] = geompy.MakeLineTwoPnt(v[0], v[1])
  41   l[2] = geompy.MakeRotation(l[1], OX, a1*math.pi/180.0)
  42   v[4] = geompy.MakeRotation(v[0], OX, a1*math.pi/180.0)
  43   v[6] = geompy.MakeRotation(v[1], OX, a1*math.pi/180.0)
  44
  45   v[2] = geompy.MakeVertex(0, -r1/2.0, 0)
  46   v[3] = geompy.MakeVertex(0, -r1, 0)
  47   l[3] = geompy.MakeLineTwoPnt(v[2], v[3])
  48   l[4] = geompy.MakeRotation(l[3], OX, -a1*math.pi/180.0)
  49   v[5] = geompy.MakeRotation(v[2], OX, -a1*math.pi/180.0)
  50   v[7] = geompy.MakeRotation(v[3], OX, -a1*math.pi/180.0)
  51
  52   l[5] = geompy.MakeLineTwoPnt(v[4], v[5])
  53   l[6] = geompy.MakeLineTwoPnt(v[0], v[4])
  54   l[7] = geompy.MakeLineTwoPnt(v[2], v[5])
  55
  56   v7 = geompy.MakeVertex(0, 0, r1)
  57   arc1 = geompy.MakeArc(v[1], v7, v[3])
  58   l[0] = geompy.MakeLineTwoPnt(v[1], v[3])
  59   face1 = geompy.MakeFaceWires([arc1, l[0]], 1)
  60   part1 = geompy.MakePartition([face1], [l[2], l[4], l[5], l[6], l[7]], [], [], geompy.ShapeType["FACE"], 0, [], 0, True)
  61
  62   if roty != 0:
  63     vrot = [ geompy.MakeRotation(vert, OY, roty*math.pi/180.0) for vert in v ]
  64     lrot = [ geompy.MakeRotation(lin, OY, roty*math.pi/180.0) for lin in l ]
  65     arc = geompy.MakeRotation(arc1, OY, roty*math.pi/180.0)
  66     part = geompy.MakeRotation(part1, OY, roty*math.pi/180.0)
  67     return vrot, lrot, arc, part
  68   else:
  69     return v, l, arc1, part1
  70
  71 def pointsProjetes(study, vref, face):
  72   geompy = geomBuilder.New(study)
  73   vface = geompy.ExtractShapes(face, geompy.ShapeType["VERTEX"], True)
  74   vord = range(len(vref))
  75   plan = geompy.MakePlaneThreePnt(vref[0], vref[1], vref[-1], 10000)
  76   vproj = [ geompy.MakeProjection(vert, plan) for vert in vface ]
  77   for i,v in enumerate(vproj):
  78     dist = [ (geompy.MinDistance(v, vr), j) for j,vr in enumerate(vref) ]
  79     dist.sort()
  80     #print dist
  81     if dist[0][0] < 1.e-3:
  82       vord[dist[0][1]] = vface[i]
  83   return vord
  84
  85 def arcsProjetes(study, vf, face):
  86   geompy = geomBuilder.New(study)
  87   lface = geompy.ExtractShapes(face, geompy.ShapeType["EDGE"], True)
  88   lord = range(3)
  89   ends = [vf[1], vf[6], vf[7], vf[3]]
  90   for i in range(3):
  91     for lf in lface:
  92       pts = geompy.ExtractShapes(lf, geompy.ShapeType["VERTEX"], True)
  93       if (((geompy.MinDistance(pts[0], ends[i]) < 0.001) and (geompy.MinDistance(pts[1], ends[i+1]) < 0.001)) or
  94           ((geompy.MinDistance(pts[1], ends[i]) < 0.001) and (geompy.MinDistance(pts[0], ends[i+1]) < 0.001))):
  95         lord[i] = lf
  96         print "arc_%d OK"%i
  97         break
  98     pass
  99   return lord
 100
 101 def build_shape(study, r1, r2, h1, h2):
 102   geompy = geomBuilder.New(study)
 103
 104   O = geompy.MakeVertex(0, 0, 0)
 105   OX = geompy.MakeVectorDXDYDZ(1, 0, 0)
 106   OY = geompy.MakeVectorDXDYDZ(0, 1, 0)
 107   OZ = geompy.MakeVectorDXDYDZ(0, 0, 1)
 108
 109   a1 = 45.0
 110   seuilmax = 0.1
 111   ratio = float(r2)/float(r1)
 112   if ratio > (1.0 -seuilmax):
 113     a1 = 45.0*(1.0 -ratio)/seuilmax
 114
 115
 116   # --- sections droites des deux demi cylindres avec le partionnement
 117
 118   v1, l1, arc1, part1 = demidisk(study, r1, a1)
 119   v2, l2, arc2, part2 = demidisk(study, r2, a1, 90.0)
 120
 121   geompy.addToStudy(part1, 'part1')
 122   geompy.addToStudy(part2, 'part2')
 123
 124   # --- extrusion des sections --> demi cylindres de travail, pour en extraire les sections utilisées au niveau du Té
 125   #     et enveloppe cylindrique du cylindre principal
 126
 127   demicyl1 = geompy.MakePrismVecH(part1, OX, h1)
 128   demicyl2 = geompy.MakePrismVecH(part2, OZ, h2)
 129   arcextru = geompy.MakePrismVecH(arc1, OX, h1)
 130
 131   geompy.addToStudy(demicyl1, 'demicyl1')
 132   geompy.addToStudy(demicyl2, 'demicyl2')
 133   geompy.addToStudy(arcextru, 'arcextru')
 134
 135   # --- plan de coupe à 45° sur le cylindre principal,
 136   #     section à 45° du cylndre principal,
 137   #     section du cylindre secondaire par l'enveloppe cylindique du cylindre principal
 138
 139   plan1 = geompy.MakePlane(O, OX, 4*r1)
 140   planr = geompy.MakeRotation(plan1, OY, 45*math.pi/180.0)
 141   geompy.addToStudy(planr, 'planr')
 142
 143   sect45 = geompy.MakeCommonList([demicyl1, planr], True)
 144   geompy.addToStudy(sect45, 'sect45')
 145
 146   sect90 = geompy.MakeCommonList([demicyl2, arcextru], True)
 147   geompy.addToStudy(sect90, 'sect90')
 148
 149   # --- liste ordonnée des points projetés sur les deux sections
 150
 151   vord45 = pointsProjetes(study, v1, sect45)
 152   vord90 = pointsProjetes(study, v2, sect90)
 153   for i,v in enumerate(vord45):
 154     geompy.addToStudyInFather(sect45, v, 'v%d'%i)
 155   for i,v in enumerate(vord90):
 156     geompy.addToStudyInFather(sect90, v, 'v%d'%i)
 157
 158   # --- identification des projections des trois arcs de cercle, sur les deux sections.
 159
 160   lord45 = arcsProjetes(study, vord45, sect45)
 161   lord90 = arcsProjetes(study, vord90, sect90)
 162   for i,l in enumerate(lord45):
 163     geompy.addToStudyInFather(sect45, l, 'l%d'%i)
 164   for i,l in enumerate(lord90):
 165     geompy.addToStudyInFather(sect90, l, 'l%d'%i)
 166
 167   # --- abaissement des quatre points centraux de la section du cylindre secondaire
 168
 169   dz = -r2/2.0
 170   for i in (0, 2, 4, 5):
 171     vord90[i] = geompy.TranslateDXDYDZ(vord90[i], 0, 0, dz, True)
 172     geompy.addToStudyInFather(sect90, vord90[i], 'vm%d'%i)
 173
 174   # --- création des deux arêtes curvilignes sur l'enveloppe cylindrique du cylindre principal, à la jonction
 175
 176   curv = [None for i in range(4)] # liaisons entre les points 1, 3, 6 et 7 des 2 sections
 177
 178   curv[0] = geompy.MakeArcCenter(O, vord90[1] , vord45[1], False)
 179   curv[1] = geompy.MakeArcCenter(O, vord90[3] , vord45[3], False)
 180
 181   lipts = ((6, 6, 4), (7, 7, 5))
 182   for i, ipts in enumerate(lipts):
 183     print i, ipts
 184     p0 = vord90[ipts[0]]
 185     p1 = vord45[ipts[1]]
 186     p2 = vord45[ipts[2]]
 187     plan = geompy.MakePlaneThreePnt(p0, p1, p2, 10000)
 188     #geompy.addToStudy(plan, "plan%d"%i)
 189     section = geompy.MakeSection(plan, arcextru, True)
 190     secpart = geompy.MakePartition([section], [sect45, sect90], [], [], geompy.ShapeType["EDGE"], 0, [], 0, True)
 191     #geompy.addToStudy(secpart, "secpart%d"%i)
 192     lsec = geompy.ExtractShapes(secpart, geompy.ShapeType["EDGE"], True)
 193     #print "len(lsec)", len(lsec)
 194     for l in lsec:
 195       pts = geompy.ExtractShapes(l, geompy.ShapeType["VERTEX"], True)
 196       if (((geompy.MinDistance(pts[0], p0) < 0.001) and (geompy.MinDistance(pts[1], p1) < 0.001)) or
 197           ((geompy.MinDistance(pts[1], p0) < 0.001) and (geompy.MinDistance(pts[0], p1) < 0.001))):
 198         curv[i+2] =l
 199         #print "curv_%d OK"%i
 200         break
 201   for i,l in enumerate(curv):
 202     geompy.addToStudyInFather(arcextru, l, "curv%d"%i)
 203
 204   # --- creation des arêtes droites manquantes, des faces et volumes pour les quatre volumes de la jonction
 205
 206   edges = [None for i in range(8)]
 207   edges[0] = geompy.MakeLineTwoPnt(vord45[0], vord90[0])
 208   edges[1] = curv[0]
 209   edges[2] = geompy.MakeLineTwoPnt(vord45[2], vord90[2])
 210   edges[3] = curv[1]
 211   edges[4] = geompy.MakeLineTwoPnt(vord45[4], vord90[4])
 212   edges[5] = geompy.MakeLineTwoPnt(vord45[5], vord90[5])
 213   edges[6] = curv[2]
 214   edges[7] = curv[3]
 215   for i,l in enumerate(edges):
 216     geompy.addToStudy( l, "edge%d"%i)
 217
 218   ed45 = [None for i in range(8)]
 219   ed45[0] = geompy.MakeLineTwoPnt(vord45[0], vord45[2])
 220   ed45[1] = geompy.MakeLineTwoPnt(vord45[0], vord45[1])
 221   ed45[2] = geompy.MakeLineTwoPnt(vord45[4], vord45[6])
 222   ed45[3] = geompy.MakeLineTwoPnt(vord45[2], vord45[3])
 223   ed45[4] = geompy.MakeLineTwoPnt(vord45[5], vord45[7])
 224   ed45[5] = geompy.MakeLineTwoPnt(vord45[4], vord45[5])
 225   ed45[6] = geompy.MakeLineTwoPnt(vord45[0], vord45[4])
 226   ed45[7] = geompy.MakeLineTwoPnt(vord45[2], vord45[5])
 227   for i,l in enumerate(ed45):
 228     geompy.addToStudyInFather(sect45, l, "ed45_%d"%i)
 229
 230   ed90 = [None for i in range(8)]
 231   ed90[0] = geompy.MakeLineTwoPnt(vord90[0], vord90[2])
 232   ed90[1] = geompy.MakeLineTwoPnt(vord90[0], vord90[1])
 233   ed90[2] = geompy.MakeLineTwoPnt(vord90[4], vord90[6])
 234   ed90[3] = geompy.MakeLineTwoPnt(vord90[2], vord90[3])
 235   ed90[4] = geompy.MakeLineTwoPnt(vord90[5], vord90[7])
 236   ed90[5] = geompy.MakeLineTwoPnt(vord90[4], vord90[5])
 237   ed90[6] = geompy.MakeLineTwoPnt(vord90[0], vord90[4])
 238   ed90[7] = geompy.MakeLineTwoPnt(vord90[2], vord90[5])
 239   for i,l in enumerate(ed90):
 240     geompy.addToStudyInFather(sect90, l, "ed90_%d"%i)
 241
 242   faci = []
 243   faci.append(geompy.MakeFaceWires([ed45[6], edges[0], ed90[6], edges[4]], 0))
 244   faci.append(geompy.MakeFaceWires([ed45[7], edges[2], ed90[7], edges[5]], 0))
 245   faci.append(geompy.MakeFaceWires([ed45[2], edges[4], ed90[2], edges[6]], 0))
 246   faci.append(geompy.MakeFaceWires([ed45[5], edges[4], ed90[5], edges[5]], 0))
 247   faci.append(geompy.MakeFaceWires([ed45[4], edges[5], ed90[4], edges[7]], 0))
 248   faci.append(geompy.MakeFaceWires([ed90[0], ed90[6], ed90[5], ed90[7]], 0))
 249   faci.append(geompy.MakeFaceWires([ed90[1], ed90[6], ed90[2], lord90[0]], 0))
 250   faci.append(geompy.MakeFaceWires([ed90[2], ed90[5], ed90[4], lord90[1]], 0))
 251   faci.append(geompy.MakeFaceWires([ed90[3], ed90[7], ed90[4], lord90[2]], 0))
 252   for i,f in enumerate(faci):
 253     geompy.addToStudy(f, "faci_%d"%i)
 254
 255   # --- extrusion droite des faces de jonction, pour reconstituer les demi cylindres
 256
 257   extru1 = geompy.MakePrismVecH(sect45, OX, h1+10)
 258   geompy.addToStudy(extru1, "extru1")
 259
 260   base2 = geompy.MakePartition(faci[5:], [], [], [], geompy.ShapeType["FACE"], 0, [], 0, True)
 261   extru2 = geompy.MakePrismVecH(base2, OZ, h2)
 262   geompy.addToStudy(extru2, "extru2")
 263
 264   # --- partition et coupe
 265
 266   demiDisque = geompy.MakeFaceWires([arc1, l1[0]], 1)
 267   demiCylindre = geompy.MakePrismVecH(demiDisque, OX, h1)
 268   #geompy.addToStudy(demiCylindre, "demiCylindre")
 269   box = geompy.MakeBox(0, -2*(r1+h1), -2*(r1+h1), 2*(r1+h1), 2*(r1+h1), 2*(r1+h1))
 270   rot = geompy.MakeRotation(box, OY, 45*math.pi/180.0)
 271   #geompy.addToStudy(rot, "rot")
 272   garder = geompy.MakeCutList(demiCylindre, [extru2, rot], True)
 273   geompy.addToStudy(garder, "garder")
 274   raccord = geompy.MakePartition([garder], faci, [], [], geompy.ShapeType["SOLID"], 0, [], 0, True)
 275   assemblage = geompy.MakePartition([raccord, extru1, extru2], [], [], [], geompy.ShapeType["SOLID"], 0, [], 0, True)
 276   geompy.addToStudy(assemblage, "assemblage")
 277
 278   box = geompy.MakeBox(-1, -(r1+r2), -1, h1, r1+r2, h2)
 279   geompy.addToStudy(box, "box")
 280   final = geompy.MakeCommonList([box, assemblage], True)
 281
 282   return final