Skip to content

Instantly share code, notes, and snippets.

@maxvoxel8
maxvoxel8 / rigid_transform.py
Last active June 8, 2017 18:34
Insane Clown Posse
#%%
from numpy import *
from math import sqrt
# Input: expects Nx3 matrix of points
# Returns R,t
# R = 3x3 rotation matrix
# t = 3x1 column vector