손끝을 공에 두는 관절 각도 구하기

FK는 각도에서 위치를 구했습니다. 실제로 로봇을 움직일 때는 반대가 필요합니다. "저 공을 잡아라"라는 명령을 관절 각도로 바꾸는 계산, 역기구학(IK, Inverse Kinematics)입니다.

MuJoCo 엔진과 OMX 모델을 불러오는 중입니다… (약 17 MB)
t = 0.00 s 준비

1개념: 삼각형 하나로 줄여서 푼다

손을 수평으로 유지한다고 정하면(θ2+θ3+θ4 = 0) 문제가 쉬워집니다. 손목은 손끝에서 L3만큼 뒤에 있으니, 남은 일은 어깨–팔꿈치–손목 삼각형을 푸는 것입니다.

L1L2dL3 γβ 어깨팔꿈치 위팔꿈치 아래손목공
  1. 손목 위치: W = (공 x − L3, 공 z), 어깨에서 손목까지 거리 d = √(Wx² + Wz²)
  2. 코사인 법칙으로 팔꿈치 안쪽 각 γ와 어깨에서 본 각 β:
    cos γ = (L1² + L2² − d²) ÷ (2·L1·L2)
    cos β = (L1² + d² − L2²) ÷ (2·L1·d)
  3. 위팔 방향(수평에서 위로) φ1 = atan2(Wz, Wx) ± β. +는 팔꿈치가 위, −는 아래. 그래서 답이 2개입니다.
  4. 관절 각도로 바꾸기 (α = 20.1°는 위팔이 기울어 붙은 각):
    θ2 = 90° − α − φ1
    아래팔 방향 φ2 = φ1 ∓ (180° − γ), θ3 = −φ2 − θ2
    θ4 = −(θ2 + θ3) ← 손을 수평으로

d가 L1 + L2 = 0.2825 m보다 길면 삼각형이 만들어지지 않습니다. 그 공에는 손이 닿지 않습니다.

2예측: 공 (0.35, 0.00) m을 잡는 각도

공 위치 (어깨 기준) x = 0.35 m, z = 0.00 m · L1 = 0.1205, L2 = 0.162, L3 = 0.1206 m, α = 20.1°

계산기(\)로 차례대로 풀어 보세요. 팔꿈치가 위인 해부터 구합니다.

m
°
°
풀이 보기

3실험: 각도를 넣어 공 잡기 — 해 2개 모두

θ2, θ3을 넣고 자세 보기를 누르면 팔이 그 자세가 됩니다. θ4는 손이 수평이 되도록 자동으로 −(θ2+θ3)입니다. 손끝과 공(주황) 사이 거리가 5 mm 이내면 잡은 것입니다.

°

팔꿈치가 위인 해와 아래인 해를 둘 다 찾으면 다음 단계가 열립니다. 아래 해는 ③의 ±에서 부호만 바꿔 다시 계산하면 됩니다.

4확인: 공 (0.42, 0.00) m은?

이 공에 손을 수평으로 두는 각도를 구하면 어떻게 될까요?

5응용: 실제 OMX는 어느 해를 쓸까?

3단계에서 찾은 두 해를 비교해 보세요. 실제 로봇 제어에서는 보통 하나만 씁니다.