SMC_Matrix3_ToRollPitchYaw_deg (FUN)

 

FUNCTION SMC_Matrix3_ToRollPitchYaw_deg : BOOL

Computes the angles yaw, pitch and roll from a rotation matrix mR. It is assumed that mR is a rotation matrix, i.e. mR*mR^T = I and det(mR) = 1. The angles are in the following ranges: -pi < roll, yaw <= pi, -pi/2 <= pitch <= pi/2. Postcondition: mR = Rz(yaw) * Ry(pitch) * Ry(roll).

InOut:

Scope

Name

Type

Return

SMC_Matrix3_ToRollPitchYaw_deg

BOOL

Inout Const

mR

SMC_Matrix3

Output

dRoll

LREAL

dPitch

LREAL

dYaw

LREAL