1개념: 삼각형 하나로 줄여서 푼다
기호가 낯설면 → 상황 {n} FK의 막대 길이와 각도 방향을 먼저 보세요.
손을 수평으로 유지한다고 정하면(θ2+θ3+θ4 = 0) 문제가 쉬워집니다. 손목은 손끝에서 L3만큼 뒤에 있으니, 남은 일은 어깨–팔꿈치–손목 삼각형을 푸는 것입니다.
- 손목 위치: W = (공 x − L3, 공 z), 어깨에서 손목까지 거리 d = √(Wx² + Wz²)
- 코사인 법칙으로 팔꿈치 안쪽 각 γ와 어깨에서 본 각 β:
cos γ = (L1² + L2² − d²) ÷ (2·L1·L2)
cos β = (L1² + d² − L2²) ÷ (2·L1·d)
- 위팔 방향(수평에서 위로) φ1 = atan2(Wz, Wx) ± β. +는 팔꿈치가 위, −는 아래. 그래서 답이 2개입니다.
- 관절 각도로 바꾸기 (α = 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단계에서 찾은 두 해를 비교해 보세요. 실제 로봇 제어에서는 보통 하나만 씁니다.