-
Notifications
You must be signed in to change notification settings - Fork 0
/
geometry.py
75 lines (54 loc) · 1.71 KB
/
geometry.py
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
import math
class Point2D:
def __init__(self, id, x, y):
self.id = id
self.x = x
self.y = y
def getById(id, points):
point = [ p for p in points if p.id == id ]
return point[0]
class Point(Point2D):
def __init__(self, id, a, b, c):
Point2D.__init__(self, id, a, b)
self.z = c
def coordinates(self):
print(self.x, self.y, self.z)
class Edge:
def __init__(self, point1, point2):
self.point1 = point1
self.point2 = point2
class Triangle:
def __init__(self, point1, point2, point3):
self.point1 = point1
self.point2 = point2
self.point3 = point3
def translate(triangles, dx, dy, dz):
for t in triangles:
for v in t:
v[0] = v[0] + dx
v[1] = v[1] + dy
v[2] = v[2] + dz
def rotate(triangles):
modelRotateY = 0.020
modelRotateX = 0.020
avg = [0.0, 0.0, 0.0]
count = 0
for t in triangles:
for v in t:
avg[0] += v[0]
avg[1] += v[1]
avg[2] += v[2]
count += 1
for i in range(0,3):
avg[i] = avg[i]/count
translate(triangles, -avg[0], -avg[1], -avg[2])
for t in triangles:
for v in t:
x = v[0]
y = v[1]
z = v[2]
v[0] = math.cos(modelRotateY)*x + math.sin(modelRotateY)*z
v[2] = -math.sin(modelRotateY)*x + math.cos(modelRotateY)*z
v[1] = math.cos(modelRotateX)*y + math.sin(modelRotateX)*v[2]
v[2] = -math.sin(modelRotateX)*y + math.cos(modelRotateX)*v[2]
translate(triangles, avg[0], avg[1], avg[2])