Esempio n. 1
0
def quatDivR(q1, q2):
    return quatMult(q1, quatInv(q2))
Esempio n. 2
0
def rollPitchYaw2Quat(rpy):
    return sm.quatInv(tf.transformations.quaternion_from_euler(rpy[0], rpy[1], rpy[2], 'rxyz'))
Esempio n. 3
0
def quatDivL(q1, q2):
    return quatMult(quatInv(q2), q1)
Esempio n. 4
0
def quat2RollPitchYaw(quat):
    return tf.transformations.euler_from_quaternion(sm.quatInv(quat), 'rxyz')
Esempio n. 5
0
def qinv(q):
    return sm.quatInv(q)
Esempio n. 6
0
def qinv(q):
    return asrl.quatInv(q)
Esempio n. 7
0
def qinv(q):
    return sm.quatInv(q)
Esempio n. 8
0
def qinv(q):
    return asrl.quatInv(q)