Skip to content

Instantly share code, notes, and snippets.

View JensMunkHansen's full-sized avatar

Jens Munk Hansen JensMunkHansen

View GitHub Profile
@JensMunkHansen
JensMunkHansen / gauss_newton.py
Created April 7, 2024 17:21
Gauss-Newton update using Quaternions
#!/usr/bin/env python3
#
# Rotation-only registration of point clouds using Quaternions and Gauss-Newton
#
import numpy as np
from sympy import (symbols, diff, Matrix, lambdify)
def rot_quat(v, a):
"""