이 포스팅은 System Dynamics 시리즈 8 편 중 4 번째 글 입니다.
목차
좌표계의 회전 변환
i번째에서 정의된 좌표계는, 내가 원하는 global 좌표계에서 좌표로 다음과 같은 관계를 갖는다.
[xpyp]=[cosθ−sinθsinθcosθ][xipyip]이 행렬을 A라 정의하자.
Ai=[cosθ−sinθsinθcosθ]위치 벡터의 표현
다음과 같이 global 좌표계가 있고, 특정 body에서 정의된 좌표계가 있을 때, 우리는 이 두 좌표계를 변환할 필요가 있다. global 좌표계에서 body의 움직임을 알고 싶다. 강체라 가정하고, body의 좌표계에서 중심점이 되는 곳을 우리는 reference point 라 부른다. 또 그곳에서 정의되는 좌표계를 body frame, local coordinate 라 한다. 그리고 global 좌표계의 중심이 되는 곳을 reference frame 이라 부를 것이다. 이 두좌표계를 변환하는 관계식은 다음과 같다.
→rpi=→Ri+→upi이 표기법을 말로 정의해보면, global 좌표계에서 표현된 p점의 벡터 는, reference point까지의 벡터 와 reference point로 부터 global 좌표계에서 표현된 특정 위치의 벡터 를 더한 것이다. 라는 의미이다. 이 때, reference point로 부터 global 좌표계에서 표현된 특정 위치의 벡터는 local coordinate 로 부터 global coordinate 로 회전 변환 한 것이므로,
→rpi=→Ri+Ai→−upi여기서 맨 오른쪽에 표현된 term은, local coordinate에서 표현된 특정 좌표이다.
→−upi=[−xpi−ypi]속도 벡터의 표현
위치벡터를 미분하면, 얻을 수 있다.
→rpi=ddt→rpi=⋅→Ri+⋅Ai→−upi+Ai⋅→−upi여기서 의미를 파악해보면, 시간에 흐름에 따라, Rigid body assumption 에 의해 local coordinate 안에서 p점의 속도는 0이다. 따라서 마지막 항은 0이다.
→rpi=ddt→rpi=⋅→Ri+⋅Ai→−upi여기서 행렬 미분을 생각해보면, A는 theta 만의 함수이므로 이녀석을 시간 t에 대해 미분하면, chain rule 에 의해,
⋅Ai=ddtAi(θi)=dθidt(ddθiAi)=⋅θiAi,θ이렇게 표현되고, A를 theta에 대해 미분한 행렬은,
Ai,θ=[−sinθi−cosθicosθi−sinθi]Transform to Cross product form
결과적으로, 강체에서 속도 벡터는,
⋅→rpi=⋅→Ri+⋅θiAi,θ→−upi2D에서 각속도 벡터는,
→ωi=⋅θiˆk=[00⋅θi]T이 때,
⋅θiAi,θ→−upi=⋅θi[−sinθi−cosθicosθi−sinθi][−xpi−ypi]=⋅θi[−−xpisinθi−−ypicosθi−xpicosθi−−ypisinθi]로 정리될 수 있다. 여기서 Up 벡터는 다음과 같이 표현 될 수 있다.
→upi=Ai→−upi=[cosθi−sinθisinθicosθi][−xpi−ypi]=[−xpicosθi−−ypisinθi−xpisinθi+−ypicosθi]=[uixuiy]각속도 백터와 Up 벡터를 내적하면,
→ωi×→upi=|ˆiˆjˆk00⋅θiuixuiy0|=|0⋅θiuiy0|ˆi−|0⋅θiuix0|ˆj+|00uixuiy|ˆk=−⋅θiuiyˆi+⋅θiuixˆj이 식을 행렬식으로 표현하면,
⋅θi[−uiyuix]=⋅θi[−−xpisinθi−−ypicosθi−xpicosθi−−ypisinθi]=⋅θiAi,θ→−upi따라서,
⋅θiAi,θ→−upi=→ωi×→upiSummary
결론적으로 속도 벡터는 다음과 같이 표현된다.
→rpi=⋅→Ri+⋅θiAi,θ→−upi=⋅→Ri+→ωi×→upi가속도 벡터의 표현
⋅⋅→rpi=ddt⋅→rpi=ddt[⋅→Ri+⋅θiAi,θ→−upi]정리하면,
⋅⋅→rpi=⋅⋅→Ri−(⋅θi)2Ai→−upi+⋅⋅θiAi,θ→−upi=⋅⋅→Ri+[→ωi×(→ωi×→upi)]+[αi×→upi]여기서 alpha는,
αi=[00⋅⋅θi]T이다.