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