80/100, mean
Q1 [-5] The columns of the matrices correspond to the axes. Your sin should be negative in your y component but in the i hat direction not in your x component.
Q3a [-1] Should explain how the answer was derived.
Q3b [-1] Should explain how the answer was derived.
Q4c [-10] no submission for 4c
Q4d [-3] incorrect order
Given a rotation angle about the x-axis, I showed in class how to derive the associated rotation matrix
R 1 0 ( x , Ο ) = R X = ( 1 0 0 0 cos β‘ Ο β sin β‘ Ο 0 sin β‘ Ο cos β‘ Ο ) R_1^0(x,\phi)=R_X=\begin{pmatrix} 1 & 0 & 0 \\ 0 & \cos\phi & -\sin\phi \\ 0 & \sin\phi & \cos\phi \end{pmatrix} R 1 0 β ( x , Ο ) = R X β = β 1 0 0 β 0 cos Ο sin Ο β 0 β sin Ο cos Ο β β
representing how vectors specified in the rotated (1) coordinate system can be represented in the unrotated (0) coordinate system. Using a similar approach, show that:
R 1 0 ( z , Ο ) = R Z = ( cos β‘ Ο β sin β‘ Ο 0 sin β‘ Ο cos β‘ Ο 0 0 0 1 ) R_1^0(z,\psi)=R_Z = \begin{pmatrix} \cos\psi & -\sin\psi & 0 \\ \sin\psi & \cos\psi & 0 \\ 0 & 0 & 1 \end{pmatrix} R 1 0 β ( z , Ο ) = R Z β = β cos Ο sin Ο 0 β β sin Ο cos Ο 0 β 0 0 1 β β
Answer:
20-5, The columns of the matrices correspond to the axes. Your sin should be negative in your y component but in the i hat direction not in your x component.
Let p β \vec p p β represent the vector
p β = p x 0 i ^ 0 + p y 0 j ^ 0 + p z 0 k ^ 0 p β = p x 1 i ^ 1 + p y 1 j ^ 1 + p z 1 k ^ 1 \vec p=p^0_x\hat i_0+p^0_y\hat j_0+p^0_z\hat k_0\\ \vec p=p^1_x\hat i_1+p^1_y\hat j_1+p^1_z\hat k_1 p β = p x 0 β i ^ 0 β + p y 0 β j ^ β 0 β + p z 0 β k ^ 0 β p β = p x 1 β i ^ 1 β + p y 1 β j ^ β 1 β + p z 1 β k ^ 1 β
We want to find the equivalent vector p β \vec p p β represnted in the System 1
p x 0 i ^ 0 = p x 0 cos β‘ Ο i ^ 1 β p x 0 sin β‘ Ο j ^ 1 p y 0 j ^ 0 = p y 0 sin β‘ Ο i ^ 1 + p y 0 cos β‘ Ο j ^ 1 p z 0 k ^ 0 = p z 0 k ^ 1 β ( i ^ 0 j ^ 0 k ^ 0 ) = ( cos β‘ Ο β sin β‘ Ο 0 sin β‘ Ο cos β‘ Ο 0 0 0 1 ) ( i ^ 1 j ^ 1 k ^ 1 ) \begin{equation} \begin{aligned} p_x^0\hat i_0&=p_x^0\cos\psi\hat i_1-p_x^0\sin\psi\hat j_1&\\ p_y^0\hat j_0&=p_y^0\sin\psi\hat i_1+p_y^0\cos\psi\hat j_1\\ p_z^0\hat k_0&=p_z^0\hat k_1 \end{aligned}\\ \Rightarrow \begin{pmatrix} \hat i_0\\\hat j_0\\\hat k_0 \end{pmatrix}=\begin{pmatrix} \cos\psi & -\sin\psi & 0 \\ \sin\psi & \cos\psi & 0 \\ 0 & 0 & 1 \end{pmatrix} \begin{pmatrix} \hat i_1\\\hat j_1\\\hat k_1 \end{pmatrix} \end{equation} p x 0 β i ^ 0 β p y 0 β j ^ β 0 β p z 0 β k ^ 0 β β = p x 0 β cos Ο i ^ 1 β β p x 0 β sin Ο j ^ β 1 β = p y 0 β sin Ο i ^ 1 β + p y 0 β cos Ο j ^ β 1 β = p z 0 β k ^ 1 β β β β i ^ 0 β j ^ β 0 β k ^ 0 β β β = β cos Ο sin Ο 0 β β sin Ο cos Ο 0 β 0 0 1 β β β i ^ 1 β j ^ β 1 β k ^ 1 β β β β β
So we can get the result:
p β 0 = R 1 0 ( z , Ο ) p β 1 R 1 0 ( z , Ο ) = R Z = ( cos β‘ Ο β sin β‘ Ο 0 sin β‘ Ο cos β‘ Ο 0 0 0 1 ) \vec p^0=R_1^0(z,\psi)\vec p^1\\ R_1^0(z,\psi)=R_Z = \begin{pmatrix} \cos\psi & -\sin\psi & 0 \\ \sin\psi & \cos\psi & 0 \\ 0 & 0 & 1 \end{pmatrix} p β 0 = R 1 0 β ( z , Ο ) p β 1 R 1 0 β ( z , Ο ) = R Z β = β cos Ο sin Ο 0 β β sin Ο cos Ο 0 β 0 0 1 β β
a) (10pts) Derive the symbolic form of the Euler angle rotation matrix R Z Y X R_{ZYX} R Z Y X β that corresponds to a sequence of three rotations where the first rotation (Ο \psi Ο ) is about the local z-axis, the second rotation (ΞΈ \theta ΞΈ ) is about the local y-axis, and the third rotation (Ο \phi Ο ) is about the local x-axis. That is, the order of rotation corresponds to ZYX.
b) (5pts) Does the rotation matrix R Z Y X R_{ZYX} R Z Y X β you have derived transform vectors from the unrotated frame to the rotated frame, or from the rotated frame to the unrotated frame? How do you know?
c) (10pts) Given R z , R y , R x R_z, R_y, R_x R z β , R y β , R x β show how you would compute ( R z y x β 1 ) (R_{zyx}^{-1}) ( R z y x β 1 β )
R E = R Z Y X ( Ο , ΞΈ , Ο ) = R z ( Ο ) R Y ( ΞΈ ) R X ( Ο ) = ( cos β‘ Ο β sin β‘ Ο 0 sin β‘ Ο cos β‘ Ο 0 0 0 1 ) ( cos β‘ ΞΈ 0 sin β‘ ΞΈ 0 1 0 β sin β‘ ΞΈ 0 cos β‘ ΞΈ ) ( 1 0 0 0 cos β‘ Ο β sin β‘ Ο 0 sin β‘ Ο cos β‘ Ο ) = ( cos β‘ ΞΈ cos β‘ Ο sin β‘ Ο sin β‘ ΞΈ cos β‘ Ο β cos β‘ Ο sin β‘ Ο sin β‘ Ο sin β‘ Ο + cos β‘ Ο sin β‘ ΞΈ cos β‘ Ο cos β‘ ΞΈ sin β‘ Ο sin β‘ Ο sin β‘ ΞΈ sin β‘ Ο + cos β‘ Ο cos β‘ Ο sin β‘ Ο sin β‘ ΞΈ cos β‘ Ο β cos β‘ Ο sin β‘ Ο β sin β‘ ΞΈ cos β‘ ΞΈ sin β‘ Ο cos β‘ ΞΈ cos β‘ Ο ) \begin{aligned} R_E &=R_{ZYX}(\phi,\theta,\psi)\\ &=R_z(\psi)R_Y(\theta)R_X(\phi)\\ &=\begin{pmatrix} \cos\psi & -\sin\psi & 0 \\ \sin\psi & \cos\psi & 0 \\ 0 & 0 & 1 \end{pmatrix}\begin{pmatrix} \cos\theta & 0 & \sin\theta \\ 0 & 1 & 0 \\ -\sin\theta & 0 & \cos\theta \end{pmatrix}\begin{pmatrix} 1 & 0 & 0 \\ 0 & \cos\phi & -\sin\phi \\ 0 & \sin\phi & \cos\phi \end{pmatrix}\\ &=\begin{pmatrix} \cos\theta\cos\psi & \sin\phi\sin\theta\cos\psi-\cos\phi\sin\psi & \sin\phi\sin\psi+\cos\phi\sin\theta\cos\psi \\ \cos\theta\sin\psi & \sin\phi\sin\theta\sin\psi+\cos\phi\cos\psi & \sin\psi\sin\theta\cos\phi-\cos\psi\sin\phi \\ -\sin\theta & \cos\theta\sin\phi & \cos\theta\cos\phi \end{pmatrix} \end{aligned} R E β β = R Z Y X β ( Ο , ΞΈ , Ο ) = R z β ( Ο ) R Y β ( ΞΈ ) R X β ( Ο ) = β cos Ο sin Ο 0 β β sin Ο cos Ο 0 β 0 0 1 β β β cos ΞΈ 0 β sin ΞΈ β 0 1 0 β sin ΞΈ 0 cos ΞΈ β β β 1 0 0 β 0 cos Ο sin Ο β 0 β sin Ο cos Ο β β = β cos ΞΈ cos Ο cos ΞΈ sin Ο β sin ΞΈ β sin Ο sin ΞΈ cos Ο β cos Ο sin Ο sin Ο sin ΞΈ sin Ο + cos Ο cos Ο cos ΞΈ sin Ο β sin Ο sin Ο + cos Ο sin ΞΈ cos Ο sin Ο sin ΞΈ cos Ο β cos Ο sin Ο cos ΞΈ cos Ο β β β
The matrix R Z Y X R_{ZYX} R Z Y X β transforms vectors from the rotated frame to the unrotated frame . R Z Y X = R Z R Y R X R_{ZYX}=R_ZR_YR_X R Z Y X β = R Z β R Y β R X β Because R X R_X R X β is rotated frame to the unrotated frame, R Y R_Y R Y β is rotated frame to the unrotated, and R Z R_Z R Z β is rotated frame to the unrotated. So do R Z Y X R_{ZYX} R Z Y X β transforms vectors from the rotated frame to the unrotated frame .
( R Z Y X ) β 1 = ( R Z R Y R X ) β 1 = ( R X ) β 1 ( R Y ) β 1 ( R Z ) β 1 = ( R X ) T ( R Y ) T ( R Z ) T \begin{aligned} (R_{ZYX})^{-1} &=(R_ZR_YR_X)^{-1}\\ &=(R_X)^{-1}(R_Y)^{-1}(R_Z)^{-1}\\ &=(R_X)^{T}(R_Y)^{T}(R_Z)^{T} \end{aligned} ( R Z Y X β ) β 1 β = ( R Z β R Y β R X β ) β 1 = ( R X β ) β 1 ( R Y β ) β 1 ( R Z β ) β 1 = ( R X β ) T ( R Y β ) T ( R Z β ) T β
-1, Should explain how the answer was derived.
H t r a n s β 1 = ( I β d 0 1 ) H_{trans}^{-1}=\begin{pmatrix} I & -d \\ 0 & 1 \end{pmatrix} H t r an s β 1 β = ( I 0 β β d 1 β )
-1, Should explain how the answer was derived.
H r o t β 1 = ( R T 0 0 1 ) H_{rot}^{-1}=\begin{pmatrix} R^T & 0 \\ 0 & 1 \end{pmatrix} H r o t β 1 β = ( R T 0 β 0 1 β )
( H ) β 1 = ( H t r a n s H r o t ) β 1 = ( H r o t ) β 1 ( H t r a n s ) β 1 = ( R T 0 0 1 ) ( I β d 0 1 ) = ( R T β R T d 0 1 ) \begin{aligned} (H)^{-1} &=(H_{trans}H_{rot})^{-1}\\ &=(H_{rot})^{-1}(H_{trans})^{-1}\\ &=\begin{pmatrix} R^T & 0 \\ 0 & 1 \end{pmatrix}\begin{pmatrix} I & -d \\ 0 & 1 \end{pmatrix}\\ &=\begin{pmatrix} R^T & -R^Td \\ 0 & 1 \end{pmatrix} \end{aligned} ( H ) β 1 β = ( H t r an s β H r o t β ) β 1 = ( H r o t β ) β 1 ( H t r an s β ) β 1 = ( R T 0 β 0 1 β ) ( I 0 β β d 1 β ) = ( R T 0 β β R T d 1 β ) β
F 1 0 = ( 1 0 0 3 0 1 0 1 0 0 1 0 0 0 0 1 ) F 2 0 = ( 1 0 0 8 0 1 0 0 0 0 1 0 0 0 0 1 ) ( 2 2 β 2 2 0 0 2 2 2 2 0 0 0 0 1 0 0 0 0 1 ) = ( 2 2 β 2 2 0 8 2 2 2 2 0 0 0 0 1 0 0 0 0 1 ) F 3 0 = ( 1 0 0 0 0 1 0 3 0 0 1 0 0 0 0 1 ) ( 1 0 0 4 0 1 0 0 0 0 1 0 0 0 0 1 ) ( 0 β 1 0 0 1 0 0 0 0 0 1 0 0 0 0 1 ) = ( 0 β 1 0 4 1 0 0 3 0 0 1 0 0 0 0 1 ) \begin{aligned} F_1^0&=\begin{pmatrix} 1 & 0 & 0 & 3\\ 0 & 1 & 0 & 1\\ 0 & 0 & 1 & 0\\ 0 & 0 & 0 & 1 \end{pmatrix}\\ F_2^0&=\begin{pmatrix} 1 & 0 & 0 & 8\\ 0 & 1 & 0 & 0\\ 0 & 0 & 1 & 0\\ 0 & 0 & 0 & 1 \end{pmatrix}\begin{pmatrix} \frac{\sqrt2}{2} & -\frac{\sqrt2}{2} & 0 & 0\\ \frac{\sqrt2}{2} & \frac{\sqrt2}{2} & 0 & 0\\ 0 & 0 & 1 & 0\\ 0 & 0 & 0 & 1 \end{pmatrix}\\ &= \begin{pmatrix} \frac{\sqrt2}{2} & -\frac{\sqrt2}{2} & 0 & 8\\ \frac{\sqrt2}{2} & \frac{\sqrt2}{2} & 0 & 0\\ 0 & 0 & 1 & 0\\ 0 & 0 & 0 & 1 \end{pmatrix}\\ F_3^0&= \begin{pmatrix} 1 & 0 & 0 & 0\\ 0 & 1 & 0 & 3\\ 0 & 0 & 1 & 0\\ 0 & 0 & 0 & 1 \end{pmatrix} \begin{pmatrix} 1 & 0 & 0 & 4\\ 0 & 1 & 0 & 0\\ 0 & 0 & 1 & 0\\ 0 & 0 & 0 & 1 \end{pmatrix} \begin{pmatrix} 0 & -1 & 0 & 0\\ 1 & 0 & 0 & 0\\ 0 & 0 & 1 & 0\\ 0 & 0 & 0 & 1 \end{pmatrix}\\ &=\begin{pmatrix} 0 & -1 & 0 & 4\\ 1 & 0 & 0 & 3\\ 0 & 0 & 1 & 0\\ 0 & 0 & 0 & 1 \end{pmatrix} \end{aligned} F 1 0 β F 2 0 β F 3 0 β β = β 1 0 0 0 β 0 1 0 0 β 0 0 1 0 β 3 1 0 1 β β = β 1 0 0 0 β 0 1 0 0 β 0 0 1 0 β 8 0 0 1 β β β 2 2 β β 2 2 β β 0 0 β β 2 2 β β 2 2 β β 0 0 β 0 0 1 0 β 0 0 0 1 β β = β 2 2 β β 2 2 β β 0 0 β β 2 2 β β 2 2 β β 0 0 β 0 0 1 0 β 8 0 0 1 β β = β 1 0 0 0 β 0 1 0 0 β 0 0 1 0 β 0 3 0 1 β β β 1 0 0 0 β 0 1 0 0 β 0 0 1 0 β 4 0 0 1 β β β 0 1 0 0 β β 1 0 0 0 β 0 0 1 0 β 0 0 0 1 β β = β 0 1 0 0 β β 1 0 0 0 β 0 0 1 0 β 4 3 0 1 β β β
β£ d 3 0 β£ = β£ [ 4 , 3 , 0 ] T β£ = 5 |d_3^0|=|[4, 3, 0]^T|=5 β£ d 3 0 β β£ = β£ [ 4 , 3 , 0 ] T β£ = 5
β£ d 3 2 β£ = β£ d 3 0 β d 2 0 β£ = β£ [ β 4 , 3 , 0 ] T β£ = 5 |d_3^2|=|d_3^0-d_2^0|=|[-4,3,0]^T|=5 β£ d 3 2 β β£ = β£ d 3 0 β β d 2 0 β β£ = β£ [ β 4 , 3 , 0 ] T β£ = 5
-10, no submission for 4c
F 3 2 = ( F 2 0 ) β 1 F 3 0 = [ 2 2 2 2 0 β 2 2 β 2 2 2 2 0 7 2 2 0 0 1 0 0 0 0 1 ] d 3 2 = [ β 2 2 , 7 2 2 , 0 ] T F_3^2=(F_2^0)^{-1}F_3^0=\begin{bmatrix} \frac{\sqrt2}{2}&\frac{\sqrt2}{2}&0&-\frac{\sqrt2}{2}\\ -\frac{\sqrt2}{2}&\frac{\sqrt2}{2}&0&\frac{7\sqrt2}{2}\\ 0&0&1&0\\ 0&0&0&1 \end{bmatrix}\\ d_3^2=[-\frac{\sqrt2}{2},\frac{7\sqrt2}{2},0]^T F 3 2 β = ( F 2 0 β ) β 1 F 3 0 β = β 2 2 β β β 2 2 β β 0 0 β 2 2 β β 2 2 β β 0 0 β 0 0 1 0 β β 2 2 β β 2 7 2 β β 0 1 β β d 3 2 β = [ β 2 2 β β , 2 7 2 β β , 0 ] T
-3, incorrect order
H = H t r a n s ( β 4 , 3 , 0 ) H r o t ( Z 2 , β 45 ) = ( 1 0 0 β 4 0 1 0 3 0 0 1 0 0 0 0 1 ) ( 2 2 2 2 0 0 β 2 2 2 2 0 0 0 0 1 0 0 0 0 1 ) = ( 2 2 2 2 0 β 4 β 2 2 2 2 0 3 0 0 1 0 0 0 0 1 ) \begin{aligned} H&=H_{trans}(-4,3,0)H_{rot}(Z^2,-45)\\ &=\begin{pmatrix} 1&0&0&-4\\ 0&1&0&3\\ 0&0&1&0\\ 0&0&0&1 \end{pmatrix}\begin{pmatrix} \frac{\sqrt2}{2}&\frac{\sqrt2}{2}&0&0\\ -\frac{\sqrt2}{2}&\frac{\sqrt2}{2}&0&0\\ 0&0&1&0\\ 0&0&0&1 \end{pmatrix}\\ &=\begin{pmatrix} \frac{\sqrt2}{2}&\frac{\sqrt2}{2}&0&-4\\ -\frac{\sqrt2}{2}&\frac{\sqrt2}{2}&0&3\\ 0&0&1&0\\ 0&0&0&1 \end{pmatrix} \end{aligned} H β = H t r an s β ( β 4 , 3 , 0 ) H r o t β ( Z 2 , β 45 ) = β 1 0 0 0 β 0 1 0 0 β 0 0 1 0 β β 4 3 0 1 β β β 2 2 β β β 2 2 β β 0 0 β 2 2 β β 2 2 β β 0 0 β 0 0 1 0 β 0 0 0 1 β β = β 2 2 β β β 2 2 β β 0 0 β 2 2 β β 2 2 β β 0 0 β 0 0 1 0 β β 4 3 0 1 β β β
β
F 4 0 = H F 2 0 β H = F 4 0 ( F 2 0 ) β 1 F_4^0=HF_2^0\Rightarrow H=F_4^0(F_2^0)^{-1} F 4 0 β = H F 2 0 β β H = F 4 0 β ( F 2 0 β ) β 1