Glassvision/IfcOpenShell
1
0
Fork 0
mirror of https://github.com/IfcOpenShell/IfcOpenShell.git synced 2026-08-09 17:31:45 +00:00
Code Issues Packages Projects Releases Wiki Activity

Geolocation util can now apply georeferencing to matrices

Browse Source
This commit is contained in:
Dion Moult
2021-01-20 10:07:48 +11:00
parent ea524767a0
commit 1142c5285c
1 changed files with 49 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/ifcopenshell-python/ifcopenshell/util/geolocation.py
+49
View File
@@ -1,4 +1,5 @@
import math
import numpy as np
def dms2dd(degrees, minutes, seconds, ms=0):
@@ -45,6 +46,54 @@ def enh2xyz(e, n, h, eastings, northings, orthogonal_height, x_axis_abscissa, x_
return (x, y, z)
def local2global(matrix, eastings, northings, orthogonal_height, x_axis_abscissa, x_axis_ordinate, scale=None):
if scale is None:
scale = 1.0
x = np.array([x_axis_abscissa, x_axis_ordinate, 0])
x /= np.linalg.norm(x)
y = np.cross(np.array([0, 0, 1]), x)
intermediate = (
np.matrix(
[
[x[0], y[0], 0, 0],
[x[1], y[1], 0, 0],
[x[2], y[2], 1, 0],
[0, 0, 0, 1],
]
)
@ matrix
)
intermediate[0, 3] = (intermediate[0, 3] * scale) + eastings
intermediate[1, 3] = (intermediate[1, 3] * scale) + northings
intermediate[2, 3] = (intermediate[2, 3] * scale) + orthogonal_height
return intermediate
def global2local(matrix, eastings, northings, orthogonal_height, x_axis_abscissa, x_axis_ordinate, scale=None):
if scale is None:
scale = 1.0
x = np.array([x_axis_abscissa, x_axis_ordinate, 0])
x /= np.linalg.norm(x)
y = np.cross(np.array([0, 0, 1]), x)
result = matrix.copy()
result[0, 3] = (result[0, 3] - eastings) / scale
result[1, 3] = (result[1, 3] - northings) / scale
result[2, 3] = (result[2, 3] - orthogonal_height) / scale
return (
np.linalg.inv(
np.matrix(
[
[x[0], y[0], 0, 0],
[x[1], y[1], 0, 0],
[x[2], y[2], 1, 0],
[0, 0, 0, 1],
]
)
)
@ result
)
# Used for converting the X and Y vectors of the X Axis in IFC geolocation
def xy2angle(x, y):
return math.degrees(math.atan2(y, x))