이 페이지는 기계 번역을 사용하여 번역되었습니다. 영어 원문을 보려면 여기를 클릭하십시오.

Quaternions to Rotation Angles

쿼터니언으로부터 회전 벡터 결정

• 

라이브러리:
Aerospace Blockset / Utilities / Axes Transformations

설명

Quaternions to Rotation Angles 블록은 4개 요소로 구성된 쿼터니언 벡터(q₀, q₁, q₂, q₃)를 세 개의 회전 각도(R1, R2, R3)로 표현된 회전으로 변환합니다. 이 블록은 회전 각도의 함수로 방향 코사인 행렬(DCM)의 요소를 계산하여 변환을 생성합니다. DCM의 요소들은 단위 쿼터니언 벡터의 함수입니다. Aerospace Blockset™는 스칼라 우선 규칙을 사용하여 정의된 쿼터니언을 사용합니다. 이 블록은 모든 쿼터니언 입력을 정규화합니다. 결과로 얻어진 회전 각도는 프레임 A에서 프레임 B로의 일련의 오른손 내재적 수동 회전을 나타냅니다. 쿼터니언은 프레임 A에서 프레임 B로의 오른손 수동 변환을 나타냅니다. 방향 코사인 행렬에 대한 자세한 내용은 알고리즘를 참조하십시오.

제한 사항

• ZYX, ZXY, YXZ, YZX, XYZ, XZY 회전의 경우, 블록은 ±pi/2 라디안 사이의 R2 각도와 ±pi 라디안 사이의 R1 및 R3 각도를 생성합니다.

• 'ZYZ', 'ZXZ', 'YXY', 'YZY', 'XYX', 'XZX' 회전의 경우, 블록은 0에서 pi 라디안 사이의 R2 각도와 ±pi 라디안 사이의 R1 및 R3 각도를 생성합니다. 그러나 후자의 경우, R2가 0일 때 R3는 0 라디안으로 설정됩니다.

포트

입력

q — 쿼터니언

4×1 벡터

쿼터니언으로, 4×1 벡터로 지정됩니다.

데이터형: double

출력

[R₁,R₂,R₃] — 회전 각도

3×1 벡터

회전 각도로, 3×1 벡터로 반환됩니다(단위: 라디안).

데이터형: double

파라미터

Rotation order — 회전 순서

ZYX (디폴트 값) | ZYZ | ZXY | ZXZ | YXZ | YXY | YZX | YZY | XYZ | XYX | XZY | XZX

세 회전 각도에 대한 출력 회전 순서.

프로그래밍 방식 사용

블록 파라미터: rotationOrder

유형: 문자형 벡터

값: ZYX | ZYZ |ZXY | ZXZ | YXZ | YXY | YZX | YZY | XYZ | XYX | XZY | XZX

디폴트 값: 'ZYX'

알고리즘

DCM의 요소들은 단위 쿼터니언 벡터의 함수입니다. 예를 들어, 회전 순서 z-y-x에 대해 DCM은 다음과 같이 정의됩니다:

$$DCM=\left[\begin{array}{lll}\cos \theta \cos \psi \hfill & \cos \theta \sin \psi \hfill & -\sin \theta \hfill \\ (\sin \varphi \sin \theta \cos \psi -\cos \varphi \sin \psi )\hfill & (\sin \varphi \sin \theta \sin \psi +\cos \varphi \cos \psi )\hfill & \sin \varphi \cos \theta \hfill \\ (\cos \varphi \sin \theta \cos \psi +\sin \varphi \sin \psi )\hfill & (\cos \varphi \sin \theta \sin \psi -\sin \varphi \cos \psi )\hfill & \cos \varphi \cos \theta \hfill \end{array}\right]$$

단위 쿼터니언 벡터로 정의된 DCM은 다음과 같습니다:

$$DCM=\left[\begin{array}{lll}(q_0^2+q_1^2-q_2^2-q_3^2)\hfill & 2(q_1{q}_2+q_0{q}_3)\hfill & 2(q_1{q}_3-q_0{q}_2)\hfill \\ 2(q_1{q}_2-q_0{q}_3)\hfill & (q_0^2-q_1^2+q_2^2-q_3^2)\hfill & 2(q_2{q}_3+q_0{q}_1)\hfill \\ 2(q_1{q}_3+q_0{q}_2)\hfill & 2(q_2{q}_3-q_0{q}_1)\hfill & (q_0^2-q_1^2-q_2^2+q_3^2)\hfill \end{array}\right]$$

위의 방정식으로부터 ZYX 회전 순서에 대한 DCM 요소와 개별 회전 각도 간의 다음과 같은 관계를 도출할 수 있습니다:

$$\begin{array}{c}\varphi =\text{atan}(DCM(2,3),DCM(3,3))\\ =\text{atan}(2(q_2{q}_3+q_0{q}_1),(q_0^2-q_1^2-q_2^2+q_3^2))\\ \theta =\text{asin}(-DCM(1,3))\\ =\text{asin}(-2(q_1{q}_3-q_0{q}_2))\\ \psi =\text{atan}(DCM(1,2),DCM(1,1))\\ =\text{atan}(2(q_1{q}_2+q_0{q}_3),(q_0^2+q_1^2-q_2^2-q_3^2))\end{array}$$

여기서 Ψ는 R1, Θ는 R2, Φ는 R3입니다.

확장 기능

C/C++ 코드 생성
Simulink® Coder™를 사용하여 C 코드나 C++ 코드를 생성할 수 있습니다.

버전 내역

R2007b에 개발됨

참고 항목

Direction Cosine Matrix to Rotation Angles | Direction Cosine Matrix to Quaternions | Quaternions to Direction Cosine Matrix | Rotation Angles to Direction Cosine Matrix | Rotation Angles to Quaternions