transformation 유도

World frame에서 PHANToM tooltip frame 까지의 trasnformation을 유도해야 하는데.. World coordinate에서 Robot coordinate까지는 transformation이 맞는데, robot coordinate에서 phantom coordinate로 가는 변환이 자꾸 어긋난다.

벌써 며칠 째 삽질인지.. 에휴. 분명 하나 하나 따져보면 다 맞는데, 막상 합쳐서 곱해보면 값이 영~ -_-;

transformation 유도가 얼른 끝나야 Jacobian을 유도하고, tool tip에 적용되는 force도 계산해낼텐데.. 과연 5월에 디펜스를 할 수 있을까? 허허..