Exemplos de logvect em Python

Exemplo n.º 1

Arquivo: utils.py Projeto: st-le/bimanual

def SO3_distance(R0, R1):
    """
  Return distance between the given two rotation matrices in SO3 space.

  @type  R0: numpy.ndarray
  @param R0: Rotation matrix.
  @type  R1: numpy.ndarray
  @param R1: Rotation matrix.

  @rtype: float
  @return: Distance.
  """
    dR = lie.logvect(dot(R0.T, R1))
    return np.sqrt(dot(dR, dR))

Exemplo n.º 2

def SO3Distance(R0, R1):  # bi-invariance
    return linalg.norm(lie.logvect(dot(R0.T, R1)))

Exemplo n.º 3

Arquivo: Utils.py Projeto: dinhhuy2109/NTU

def SO3Distance(R0, R1): # bi-invariance
    return linalg.norm(lie.logvect(dot(R0.T,R1)))

Exemplo n.º 4

Arquivo: Utils.py Projeto: Puttichai/TOPP-SO3

def SO3Distance(R0, R1): # bi-invariance
    return np.linalg.norm(Lie.logvect(np.dot(R0.T, R1)))