"""Utility functions for matrix operations.""" from __future__ import annotations import math from tabulate import tabulate Matrix = list[list[int | float]] def transpose(matrix: Matrix) -> Matrix: """Return the transpose of a matrix. Args: matrix: Rectangular, non-empty matrix in row-major format. Returns: The transposed matrix. Raises: ValueError: If the matrix is empty or has irregular rows. """ if not matrix: raise ValueError("Cannot transpose an empty matrix") row_length = len(matrix[0]) if row_length == 0: raise ValueError("Matrix rows must have at least one column") for row in matrix: if len(row) != row_length: raise ValueError("Inconsistent row lengths; matrix must be rectangular") return [list(column) for column in zip(*matrix)] def matmul(a: Matrix, b: Matrix) -> Matrix: """Return the matrix product of two matrices. Args: a: Matrix with m rows and n columns. b: Matrix with n rows and p columns. Returns: The product matrix with m rows and p columns. Raises: ValueError: If a matrix is empty or the inner dimensions do not match. """ if not a or not b: raise ValueError("Both matrices must be non-empty") if not a[0] or not b[0]: raise ValueError("Matrices must have at least one column") rows_a, cols_a = len(a), len(a[0]) rows_b, cols_b = len(b), len(b[0]) if cols_a != rows_b: raise ValueError( f"Inner matrix dimensions must agree: got {cols_a} and {rows_b}" ) result: Matrix = [] for i in range(rows_a): result_row: list[int | float] = [] for j in range(cols_b): total: int | float = 0 for k in range(cols_a): total += a[i][k] * b[k][j] result_row.append(total) result.append(result_row) return result def rot_2D(theta: float) -> Matrix: """Create a 2D rotation matrix. Args: theta: Rotation angle in radians. Positive values rotate counter-clockwise. Returns: A 2x2 rotation matrix [[cos, -sin], [sin, cos]]. """ return [ [math.cos(theta), -math.sin(theta)], [math.sin(theta), math.cos(theta)], ] def project_perspective( point: tuple[float, float, float], focal_length: float = 1.0, scale: float = 1.0, camera_distance: float = 4.0, ) -> tuple[float, float]: """Projiziert einen 3D-Punkt perspektivisch auf die x-y-Ebene. x_2d = x * focal_length / (z + camera_distance) * scale y_2d = y * focal_length / (z + camera_distance) * scale Args: point: Der 3D-Punkt (x, y, z). focal_length: Brennweite, steuert die Stärke der Perspektive. scale: Skalierungsfaktor für den projizierten Punkt. camera_distance: Offset für die Kameraposition auf der z-Achse. Returns: Der 2D-Punkt (x_2d, y_2d). Raises: ValueError: Wenn z + camera_distance gleich 0 ist. """ x, y, z = point depth = z + camera_distance if depth == 0: raise ValueError("z + camera_distance darf nicht 0 sein") return (x * focal_length / depth * scale, y * focal_length / depth * scale) def rot_3D(angle: float, axis: str) -> list[list[float]]: """Gibt die 3D-Rotationsmatrix für eine Drehung um eine Koordinatenachse zurück. Rotation um die x-Achse: [[1, 0, 0], [0, cos(a), -sin(a)], [0, sin(a), cos(a)]] Rotation um die y-Achse: [[cos(a), 0, sin(a)], [0, 1, 0], [-sin(a), 0, cos(a)]] Rotation um die z-Achse: [[cos(a), -sin(a), 0], [sin(a), cos(a), 0], [0, 0, 1]] Args: angle: Drehwinkel a im Bogenmaß. axis: Drehachse, "x", "y" oder "z". Returns: Die 3x3-Rotationsmatrix als verschachtelte Liste. Raises: ValueError: Wenn axis nicht "x", "y" oder "z" ist. """ cos_a = math.cos(angle) sin_a = math.sin(angle) if axis == "x": return [[1, 0, 0], [0, cos_a, -sin_a], [0, sin_a, cos_a]] if axis == "y": return [[cos_a, 0, sin_a], [0, 1, 0], [-sin_a, 0, cos_a]] if axis == "z": return [[cos_a, -sin_a, 0], [sin_a, cos_a, 0], [0, 0, 1]] raise ValueError("axis muss 'x', 'y' oder 'z' sein") if __name__ == "__main__": matrix_a = [ [3, 4, -1, 4], [-2, 2, 5, 1], ] matrix_b = [ [1, 3, -2], [2, 5, 1], [-1, 4, -4], [2, 3, 6], ] assert matmul(matrix_a, matrix_b) == [[20, 37, 26], [-1, 27, -8]] assert matmul([[1, 2]], [[3], [4]]) == [[11]] assert transpose([[1, 2, 3], [4, 5, 6]]) == [[1, 4], [2, 5], [3, 6]] for bad_matrix in ([], [[1, 2], [3, 4, 5]]): try: transpose(bad_matrix) except ValueError: pass else: raise AssertionError("ValueError erwartet") point = [[1.0], [0.0]] rotated = matmul(rot_2D(math.pi / 2), point) assert math.isclose(rotated[0][0], 0.0, abs_tol=1e-9) assert math.isclose(rotated[1][0], 1.0, abs_tol=1e-9) assert rot_2D(0) == [[1.0, 0.0], [0.0, 1.0]] print(tabulate(rot_2D(1.0))) print("Alle Tests bestanden.")