コード例 #1
0
ファイル: conversions.py プロジェクト: amoliu/lfd
def hmat_to_trans_rot(hmat): 
    ''' 
    Converts a 4x4 homogenous rigid transformation matrix to a translation and a 
    quaternion rotation. 
    ''' 
    _scale, _shear, angles, trans, _persp = transformations.decompose_matrix(hmat) 
    rot = transformations.quaternion_from_euler(*angles) 
    return trans, rot 
コード例 #2
0
ファイル: conversions.py プロジェクト: zzz622848/lfd
def hmat_to_trans_rot(hmat):
    ''' 
    Converts a 4x4 homogenous rigid transformation matrix to a translation and a 
    quaternion rotation. 
    '''
    _scale, _shear, angles, trans, _persp = transformations.decompose_matrix(
        hmat)
    rot = transformations.quaternion_from_euler(*angles)
    return trans, rot
コード例 #3
0
ファイル: conversions.py プロジェクト: amoliu/lfd
def yaw_to_quat(yaw):
    return transformations.quaternion_from_euler(0, 0, yaw)
コード例 #4
0
ファイル: conversions.py プロジェクト: zzz622848/lfd
def yaw_to_quat(yaw):
    return transformations.quaternion_from_euler(0, 0, yaw)