이 포스팅은 System Dynamics 시리즈 8 편 중 4 번째 글 입니다.

  • Part 1 - 01: 다물체 동역학 개론
  • Part 2 - 02: 평면에서 다물체계의 운동학
  • Part 3 - 03: Orthogonality, Vector Differentiation, Jacobi's Theorem
  • Part 4 - This Post
  • Part 5 - 05: 기구학적 제약
  • Part 6 - 06: Newton Raphson Method
  • Part 7 - 07: Computational Algorithm
  • Part 8 - 08: Newton-Euler Equations, D'Alembert's Principle
▼ 목록 보기

좌표계의 회전 변환

i번째에서 정의된 좌표계는, 내가 원하는 global 좌표계에서 좌표로 다음과 같은 관계를 갖는다.

[xpyp]=[cosθsinθsinθcosθ][xipyip]

이 행렬을 A라 정의하자.

Ai=[cosθsinθsinθcosθ]

위치 벡터의 표현

스크린샷 2019-05-04 오후 6 18 02

다음과 같이 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+Aiupi

여기서 맨 오른쪽에 표현된 term은, local coordinate에서 표현된 특정 좌표이다.

upi=[xpiypi]

속도 벡터의 표현

위치벡터를 미분하면, 얻을 수 있다.

rpi=ddtrpi=Ri+Aiupi+Aiupi

여기서 의미를 파악해보면, 시간에 흐름에 따라, Rigid body assumption 에 의해 local coordinate 안에서 p점의 속도는 0이다. 따라서 마지막 항은 0이다.

rpi=ddtrpi=Ri+Aiupi

여기서 행렬 미분을 생각해보면, A는 theta 만의 함수이므로 이녀석을 시간 t에 대해 미분하면, chain rule 에 의해,

Ai=ddtAi(θi)=dθidt(ddθiAi)=θiAi,θ

이렇게 표현되고, A를 theta에 대해 미분한 행렬은,

Ai,θ=[sinθicosθicosθisinθi]

Transform to Cross product form

결과적으로, 강체에서 속도 벡터는,

rpi=Ri+θiAi,θupi

2D에서 각속도 벡터는,

ωi=θiˆk=[00θi]T

이 때,

θiAi,θupi=θi[sinθicosθicosθisinθi][xpiypi]=θi[xpisinθiypicosθixpicosθiypisinθi]

로 정리될 수 있다. 여기서 Up 벡터는 다음과 같이 표현 될 수 있다.

upi=Aiupi=[cosθisinθisinθicosθi][xpiypi]=[xpicosθiypisinθixpisinθ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θiypicosθixpicosθiypisinθi]=θiAi,θupi

따라서,

θiAi,θupi=ωi×upi

Summary

결론적으로 속도 벡터는 다음과 같이 표현된다.

rpi=Ri+θiAi,θupi=Ri+ωi×upi

가속도 벡터의 표현

rpi=ddtrpi=ddt[Ri+θiAi,θupi]

정리하면,

rpi=Ri(θi)2Aiupi+θiAi,θupi=Ri+[ωi×(ωi×upi)]+[αi×upi]

여기서 alpha는,

αi=[00θi]T

이다.