Exemplos de quaternion_from_matrix em Python

Exemplo n.º 1

def PosRotToX(p, R):
    M = _rostf.identity_matrix()
    M[:3, :3] = R
    x = list(p) + [0.0] * 4
    x[3:7] = _rostf.quaternion_from_matrix(M)
    return x

Exemplo n.º 2

def RotToQ(R):
    M = _rostf.identity_matrix()
    M[:3, :3] = R
    return _rostf.quaternion_from_matrix(M)