1
|
|
|
import math |
2
|
|
|
from gem import vector |
3
|
|
|
from gem import plane |
4
|
|
|
|
5
|
|
|
class CSG(object): |
6
|
|
|
def __init__(self): |
7
|
|
|
self.polygons = [] |
8
|
|
|
|
9
|
|
|
def clone(self): |
10
|
|
|
newCSG = CSG() |
11
|
|
|
for i in range(len(self.polygons)): |
12
|
|
|
newCSG.polygons.append(self.polygons[i].clone()) |
13
|
|
|
return newCSG |
14
|
|
|
|
15
|
|
|
def fromPolygons(self, polygons): |
16
|
|
|
newCSG = CSG() |
17
|
|
|
newCSG.polygons = polygons |
18
|
|
|
return newCSG |
19
|
|
|
|
20
|
|
|
def toPolygons(self): |
21
|
|
|
return self.polygons |
22
|
|
|
|
23
|
|
|
def setColor(self, r, g, b): |
24
|
|
|
for i in range(len(self.polygons)): |
25
|
|
|
self.polygons[i].shared = [r, g, b] |
26
|
|
|
|
27
|
|
|
def union(self, otherCSG): |
28
|
|
|
csgA = csgNode(self.clone().polygons) |
29
|
|
|
csgB = csgNode(otherCSG.clone().polygons) |
30
|
|
|
csgA.clipTo(csgB) |
31
|
|
|
csgB.clipTo(csgA) |
32
|
|
|
csgB.invert() |
33
|
|
|
csgB.clipTo(csgA) |
34
|
|
|
csgB.invert() |
35
|
|
|
csgA.build(csgB.allPolygons()) |
36
|
|
|
|
37
|
|
|
return self.fromPolygons(csgA.allPolygons()) |
38
|
|
|
|
39
|
|
View Code Duplication |
def subtract(self, otherCSG): |
|
|
|
|
40
|
|
|
csgA = csgNode(self.clone().polygons) |
41
|
|
|
csgB = csgNode(otherCSG.clone().polygons) |
42
|
|
|
|
43
|
|
|
csgA.invert() |
44
|
|
|
csgA.clipTo(csgB) |
45
|
|
|
csgB.clipTo(csgA) |
46
|
|
|
csgB.invert() |
47
|
|
|
csgB.clipTo(csgA) |
48
|
|
|
csgB.invert() |
49
|
|
|
csgA.build(csgB.allPolygons()) |
50
|
|
|
csgA.invert() |
51
|
|
|
return self.fromPolygons(csgA.allPolygons()) |
52
|
|
|
|
53
|
|
View Code Duplication |
def intersect(self, otherCSG): |
|
|
|
|
54
|
|
|
csgA = csgNode(self.clone().polygons) |
55
|
|
|
csgB = csgNode(otherCSG.clone().polygons) |
56
|
|
|
|
57
|
|
|
csgA.invert() |
58
|
|
|
csgB.clipTo(csgA) |
59
|
|
|
csgB.invert() |
60
|
|
|
csgA.clipTo(csgB) |
61
|
|
|
csgB.clipTo(csgA) |
62
|
|
|
csgA.build(csgB.allPolygons()) |
63
|
|
|
csgA.invert() |
64
|
|
|
|
65
|
|
|
|
66
|
|
|
return self.fromPolygons(csgA.allPolygons()) |
67
|
|
|
|
68
|
|
|
def inverse(self): |
69
|
|
|
newCSG = self.clone() |
70
|
|
|
for i in range(len(self.polygons)): |
71
|
|
|
newCSG.polygons[i] = self.polygons[i].flip() |
72
|
|
|
return newCSG |
73
|
|
|
|
74
|
|
|
def cube(self, center, radius): |
75
|
|
|
c = center |
76
|
|
|
r = radius |
77
|
|
|
|
78
|
|
|
indices = [[0, 4, 6, 2], |
79
|
|
|
[1, 3, 7, 5], |
80
|
|
|
[0, 1, 5, 4], |
81
|
|
|
[2, 6, 7, 3], |
82
|
|
|
[0, 2, 3, 1], |
83
|
|
|
[4, 5, 7, 6]] |
84
|
|
|
|
85
|
|
|
normals = [[-1, 0, 0], |
86
|
|
|
[ 1, 0, 0], |
87
|
|
|
[ 0,-1, 0], |
88
|
|
|
[ 0, 1, 0], |
89
|
|
|
[ 0, 0,-1], |
90
|
|
|
[ 0, 0, 1]] |
91
|
|
|
|
92
|
|
|
finalPolygons = [] |
93
|
|
|
invidiualPolygonVertices = [] |
94
|
|
|
|
95
|
|
|
for i in range(6): |
96
|
|
|
invidiualPolygonVertices = [] |
97
|
|
|
for j in range(4): |
98
|
|
|
pos = vector.Vector(3, |
99
|
|
|
data = [c[0] + r[0] * (2 * int(bool(indices[i][j] & 1)) - 1), |
100
|
|
|
c[1] + r[1] * (2 * int(bool(indices[i][j] & 2)) - 1), |
101
|
|
|
c[2] + r[2] * (2 * int(bool(indices[i][j] & 4)) - 1)]) |
102
|
|
|
|
103
|
|
|
invidiualPolygonVertices.append(csgVertex(pos, vector.Vector(3, normals[i]))) |
104
|
|
|
finalPolygons.append(csgPolygon(invidiualPolygonVertices, [1, 1, 1])) |
105
|
|
|
|
106
|
|
|
return self.fromPolygons(finalPolygons) |
107
|
|
|
|
108
|
|
|
def sphere(self, center, radius, slices, stacks): |
109
|
|
|
c = vector.Vector(3, data=center) |
110
|
|
|
r = radius |
111
|
|
|
sl = slices |
112
|
|
|
st = stacks |
113
|
|
|
|
114
|
|
|
polygons = [] |
115
|
|
|
vertices = [] |
116
|
|
|
|
117
|
|
|
#vertex = lambda theta, phi: vertices.append(csgVertex(c + (vector.Vector(3, data=[math.cos(theta) * math.sin(phi), math.cos(phi), math.sin(theta) * math.sin(phi)]) * r), vector.Vector(3, data=[math.cos(theta) * math.sin(phi), math.cos(phi), math.sin(theta) * math.sin(phi)]))) |
118
|
|
|
def vertex(theta, phi): |
119
|
|
|
t = theta * math.pi * 2 |
120
|
|
|
p = phi * math.pi |
121
|
|
|
cosT = math.cos(t) |
122
|
|
|
cosP = math.cos(p) |
123
|
|
|
sinT = math.sin(t) |
124
|
|
|
sinP = math.sin(p) |
125
|
|
|
|
126
|
|
|
direction = vector.Vector(3, data=[cosT * sinP, cosP, sinT * sinP]) |
127
|
|
|
|
128
|
|
|
vertices.append(csgVertex(c + (direction * r), direction)) |
129
|
|
|
|
130
|
|
|
for i in range(sl): |
131
|
|
|
for j in range(st): |
132
|
|
|
|
133
|
|
|
i = float(i) |
134
|
|
|
j = float(j) |
135
|
|
|
|
136
|
|
|
vertices = [] |
137
|
|
|
|
138
|
|
|
vertex(i / sl, j / st) |
139
|
|
|
|
140
|
|
|
if j > 0: |
141
|
|
|
vertex((i + 1) / sl, j / st) |
142
|
|
|
|
143
|
|
|
if j < (stacks - 1): |
144
|
|
|
vertex((i + 1) / sl, (j + 1) / st) |
145
|
|
|
|
146
|
|
|
vertex(i / sl, (j + 1) / st) |
147
|
|
|
|
148
|
|
|
polygons.append(csgPolygon(vertices, [1, 1, 1])) |
149
|
|
|
|
150
|
|
|
return self.fromPolygons(polygons) |
151
|
|
|
|
152
|
|
|
def cylinder(self, start, end, radius, slices): |
153
|
|
|
s = vector.Vector(3, data=start) |
154
|
|
|
e = vector.Vector(3, data=end) |
155
|
|
|
r = radius |
156
|
|
|
slices = slices |
157
|
|
|
|
158
|
|
|
ray = e - s |
159
|
|
|
|
160
|
|
|
axisZ = ray.normalize() |
161
|
|
|
isY = abs(axisZ.vector[1]) > 0.5 |
162
|
|
|
axisX = vector.cross(vector.Vector(3, data=[isY, int(not isY), 0.0]), axisZ).normalize() |
163
|
|
|
axisY = vector.cross(axisX, axisZ).normalize() |
164
|
|
|
|
165
|
|
|
start = csgVertex(s, -axisZ) |
166
|
|
|
end = csgVertex(e, axisZ.normalize()) |
167
|
|
|
|
168
|
|
|
polygons = [] |
169
|
|
|
|
170
|
|
|
def point(stack, sliceC, normalBlend): |
171
|
|
|
angle = sliceC * math.pi * 2 |
172
|
|
|
out = axisX * math.cos(angle) + axisY * math.sin(angle) |
173
|
|
|
pos = s + ray * stack + out * r |
174
|
|
|
normal = out * (1 - abs(normalBlend)) + axisZ * normalBlend |
175
|
|
|
return csgVertex(pos, normal) |
176
|
|
|
|
177
|
|
|
for i in range(slices): |
178
|
|
|
t0 = i / slices |
179
|
|
|
t1 = (i + 1) / slices |
180
|
|
|
|
181
|
|
|
polygons.append(csgPolygon([start, point(0, t0, -1), point(0, t1, -1)], [1, 1, 1])) |
182
|
|
|
polygons.append(csgPolygon([point(0, t1, 0), point(0, t0, 0), point(1, t0, 0), point(1, t1, 0)], [1, 1, 1])) |
183
|
|
|
polygons.append(csgPolygon([end, point(1, t1, 1), point(1, t0, 1)], [1, 1, 1])) |
184
|
|
|
|
185
|
|
|
return self.fromPolygons(polygons) |
186
|
|
|
|
187
|
|
|
|
188
|
|
|
class csgVertex(object): |
189
|
|
|
def __init__(self, pos, normal): |
190
|
|
|
self.pos = pos |
191
|
|
|
self.normal = normal |
192
|
|
|
self.color = [1, 0, 0] |
193
|
|
|
|
194
|
|
|
def __repr__(self): |
195
|
|
|
return 'csgVertex: pos:{} , normal:{}, color:{}'.format(self.pos, self.normal, self.color) |
196
|
|
|
|
197
|
|
|
def clone(self): |
198
|
|
|
return csgVertex(self.pos.clone(), self.normal.clone()) |
199
|
|
|
|
200
|
|
|
def flip(self): |
201
|
|
|
self.normal = -self.normal |
202
|
|
|
|
203
|
|
|
def interpolate(self, vert, t): |
204
|
|
|
pos = vector.lerp(self.pos, vert.pos, t) |
205
|
|
|
normal = vector.lerp(self.normal, vert.normal, t) |
206
|
|
|
return csgVertex(pos, normal) |
207
|
|
|
|
208
|
|
|
class csgPlane(plane.Plane): |
209
|
|
|
def __init__(self, normal, d): |
210
|
|
|
super(csgPlane, self).__init__() |
211
|
|
|
self.normal = normal |
212
|
|
|
self.d = d |
213
|
|
|
self.epsilon = 1e-5 |
214
|
|
|
|
215
|
|
|
def __repr__(self): |
216
|
|
|
return 'csgPlane: normal:{} , d:{}'.format(self.normal, self.d) |
217
|
|
|
|
218
|
|
|
def clone(self): |
219
|
|
|
return csgPlane(self.normal.clone(), self.d) |
220
|
|
|
|
221
|
|
|
def splitPolygon(self, polygon, cFront, cBack, f1, b1): |
222
|
|
|
coplanarFront = cFront |
223
|
|
|
coplanarBack = cBack |
224
|
|
|
front = f1 |
225
|
|
|
back = b1 |
226
|
|
|
|
227
|
|
|
COPLANAR = 0 |
228
|
|
|
FRONT = 1 |
229
|
|
|
BACK = 2 |
230
|
|
|
SPANNING = 3 |
231
|
|
|
|
232
|
|
|
polygonType = 0 |
233
|
|
|
types = [] |
234
|
|
|
|
235
|
|
|
for i in range(len(polygon.vertices)): |
236
|
|
|
t = self.normal.dot(polygon.vertices[i].pos) - self.d |
237
|
|
|
typeP = 0 |
238
|
|
|
if t < -self.epsilon: |
239
|
|
|
typeP = BACK |
240
|
|
|
if t > self.epsilon: |
241
|
|
|
typeP = FRONT |
242
|
|
|
if t > -self.epsilon and t < self.epsilon: |
243
|
|
|
typeP = COPLANAR |
244
|
|
|
|
245
|
|
|
polygonType |= typeP |
246
|
|
|
types.append(typeP) |
247
|
|
|
|
248
|
|
|
|
249
|
|
|
if polygonType == COPLANAR: |
250
|
|
|
if self.normal.dot(polygon.plane.normal) > 0: |
251
|
|
|
coplanarFront.append(polygon) |
252
|
|
|
else: |
253
|
|
|
coplanarBack.append(polygon) |
254
|
|
|
if polygonType == FRONT: |
255
|
|
|
front.append(polygon) |
256
|
|
|
if polygonType == BACK: |
257
|
|
|
back.append(polygon) |
258
|
|
|
if polygonType == SPANNING: |
259
|
|
|
f = [] |
260
|
|
|
b = [] |
261
|
|
|
|
262
|
|
|
for i in range(len(polygon.vertices)): |
263
|
|
|
j = (i + 1) % len(polygon.vertices) |
264
|
|
|
ti = types[i] |
265
|
|
|
tj = types[j] |
266
|
|
|
|
267
|
|
|
vi = polygon.vertices[i] |
268
|
|
|
vj = polygon.vertices[j] |
269
|
|
|
|
270
|
|
|
if (ti != BACK): |
271
|
|
|
f.append(vi) |
272
|
|
|
if (ti != FRONT): |
273
|
|
|
if ti != BACK: |
274
|
|
|
b.append(vi.clone()) |
275
|
|
|
else: |
276
|
|
|
b.append(vi) |
277
|
|
|
|
278
|
|
|
if ((ti | tj) == SPANNING): |
279
|
|
|
t = (self.d - self.normal.dot(vi.pos)) / self.normal.dot(vj.pos - vi.pos) |
280
|
|
|
v = vi.interpolate(vj, t) |
281
|
|
|
f.append(v) |
282
|
|
|
b.append(v.clone()) |
283
|
|
|
|
284
|
|
|
if (len(f) >= 3): |
285
|
|
|
front.append(csgPolygon(f, polygon.shared)) |
286
|
|
|
if (len(b) >= 3): |
287
|
|
|
back.append(csgPolygon(b, polygon.shared)) |
288
|
|
|
|
289
|
|
|
return coplanarFront, coplanarBack, front, back |
290
|
|
|
|
291
|
|
|
class csgPolygon(object): |
292
|
|
|
def __init__(self, vertices, shared): |
293
|
|
|
self.vertices = vertices |
294
|
|
|
self.shared = shared |
295
|
|
|
self.plane = csgPlane(vector.Vector(3), 0) |
296
|
|
|
self.plane.fromPoints(vertices[0].pos, vertices[1].pos, vertices[2].pos) |
297
|
|
|
|
298
|
|
|
def __repr__(self): |
299
|
|
|
return 'csgPolygon: vertices:{} , shared:{}, plane:{}'.format(self.vertices, self.shared, self.plane) |
300
|
|
|
|
301
|
|
|
def clone(self): |
302
|
|
|
return csgPolygon(self.vertices, self.shared) |
303
|
|
|
|
304
|
|
|
def flip(self): |
305
|
|
|
vertices = self.vertices[::-1] |
306
|
|
|
for i in range(len(self.vertices)): |
307
|
|
|
if self.vertices[i] == None: |
308
|
|
|
vertices.append(self.vertices[i].flip()) |
309
|
|
|
|
310
|
|
|
self.vertices = vertices |
311
|
|
|
self.plane.flip() |
312
|
|
|
|
313
|
|
|
class csgNode(CSG): |
314
|
|
|
def __init__(self, polygons): |
315
|
|
|
super(csgNode, self).__init__() |
316
|
|
|
self.plane = None |
317
|
|
|
self.front = None |
318
|
|
|
self.back = None |
319
|
|
|
self.polygons = [] |
320
|
|
|
|
321
|
|
|
if polygons: |
322
|
|
|
self.build(polygons) |
323
|
|
|
|
324
|
|
|
def clone(self): |
325
|
|
|
newNode = csgNode([]) |
326
|
|
|
newNode.plane = self.plane and self.plane.clone() |
327
|
|
|
newNode.front = self.front and self.front.clone() |
328
|
|
|
newNode.back = self.back and self.back.clone() |
329
|
|
|
newNode.polygons = self.polygons |
330
|
|
|
return newNode |
331
|
|
|
|
332
|
|
|
def invert(self): |
333
|
|
|
for i in range(len(self.polygons)): |
334
|
|
|
self.polygons[i].flip() |
335
|
|
|
|
336
|
|
|
self.plane.flip() |
337
|
|
|
|
338
|
|
|
if (self.front): |
339
|
|
|
self.front.invert() |
340
|
|
|
|
341
|
|
|
if (self.back): |
342
|
|
|
self.back.invert() |
343
|
|
|
|
344
|
|
|
temp = self.front |
345
|
|
|
self.front = self.back |
346
|
|
|
self.back = temp |
347
|
|
|
|
348
|
|
|
def clipPolygons(self, polygons): |
349
|
|
|
if (self.plane == 0): |
350
|
|
|
return polygons |
351
|
|
|
|
352
|
|
|
front = [] |
353
|
|
|
back = [] |
354
|
|
|
|
355
|
|
|
for i in range(len(polygons)): |
356
|
|
|
front, back, front, back = self.plane.splitPolygon(polygons[i], front, back, front, back) |
357
|
|
|
|
358
|
|
|
if self.front: |
359
|
|
|
front = self.front.clipPolygons(front) |
360
|
|
|
|
361
|
|
|
if self.back: |
362
|
|
|
back = self.back.clipPolygons(back) |
363
|
|
|
else: |
364
|
|
|
back = [] |
365
|
|
|
|
366
|
|
|
return front + back |
367
|
|
|
|
368
|
|
|
def clipTo(self, bsp): |
369
|
|
|
self.polygons = bsp.clipPolygons(self.polygons) |
370
|
|
|
|
371
|
|
|
if self.front: |
372
|
|
|
self.front.clipTo(bsp) |
373
|
|
|
if self.back: |
374
|
|
|
self.back.clipTo(bsp) |
375
|
|
|
|
376
|
|
|
def allPolygons(self): |
377
|
|
|
polygons = self.polygons |
378
|
|
|
|
379
|
|
|
if self.front: |
380
|
|
|
polygons = polygons + (self.front.allPolygons()) |
381
|
|
|
if self.back: |
382
|
|
|
polygons = polygons + (self.back.allPolygons()) |
383
|
|
|
return polygons |
384
|
|
|
|
385
|
|
|
def build(self, polygons): |
386
|
|
|
if (len(polygons) == 0): |
387
|
|
|
return |
388
|
|
|
|
389
|
|
|
if (self.plane is None): |
390
|
|
|
self.plane = polygons[0].plane.clone() |
391
|
|
|
|
392
|
|
|
front = [] |
393
|
|
|
back = [] |
394
|
|
|
|
395
|
|
|
for i in range(len(polygons)): |
396
|
|
|
self.polygons, self.polygons, front, back = self.plane.splitPolygon(polygons[i], self.polygons, self.polygons, front, back) |
397
|
|
|
|
398
|
|
|
if len(front): |
399
|
|
|
if (self.front is None): |
400
|
|
|
self.front = csgNode([]) |
401
|
|
|
self.front.build(front) |
402
|
|
|
|
403
|
|
|
if len(back): |
404
|
|
|
if(self.back is None): |
405
|
|
|
self.back = csgNode([]) |
406
|
|
|
self.back.build(back) |
407
|
|
|
|