44 lines
1.5 KiB
Python
44 lines
1.5 KiB
Python
import math
|
|
import numpy as np
|
|
|
|
|
|
class Geometry:
|
|
def __init__(self, delta=0.5):
|
|
self._delta = delta
|
|
|
|
def almost_equal(self, v1, v2):
|
|
delta = math.sqrt(pow((v1[0] - v2[0]), 2) + pow((v1[1] - v2[1]), 2) + pow((v1[2] - v2[2]), 2))
|
|
return delta <= self._delta
|
|
|
|
def is_almost_same_surface(self, s1, s2):
|
|
# delta is grads an need to be converted into radians
|
|
delta = np.rad2deg(self._delta)
|
|
difference = (s1.inclination - s2.inclination) % math.pi
|
|
if abs(difference) > delta:
|
|
return False
|
|
# s1 and s2 are at least almost parallel surfaces
|
|
# calculate distance point to plane using all the vertex
|
|
# select surface1 value for the point (X,Y,Z) where two of the values are 0
|
|
minimum_distance = 200000
|
|
parametric = s2.polygon.get_parametric()
|
|
n2 = s2.normal
|
|
for point in s1.points:
|
|
distance = abs(
|
|
(point[0] * parametric[0]) + (point[1] * parametric[1]) + (point[2] * parametric[2]) + parametric[3])
|
|
normal_module = math.sqrt(pow(n2[0], 2) + pow(n2[1], 2) + pow(n2[2], 2))
|
|
if normal_module == 0:
|
|
print(normal_module)
|
|
continue
|
|
distance = distance / normal_module
|
|
if distance < minimum_distance:
|
|
minimum_distance = distance
|
|
return minimum_distance <= self._delta
|
|
|
|
@staticmethod
|
|
def to_points_matrix(points, remove_last=False):
|
|
rows = points.size // 3
|
|
points = points.reshape(rows, 3)
|
|
if remove_last:
|
|
points = np.delete(points, rows - 1, 0)
|
|
return points
|