1개념: 각도를 더해 가며 팔을 따라간다
기호가 낯설면 → 0 · 기초 개념: q 읽는 법
옆에서 보면 OMX 팔은 위팔·아래팔·손 세 막대가 이어진 모양입니다. 어깨(joint2)에서 출발해 막대 하나씩 따라가며 x(앞), z(위)를 더하면 손끝 위치가 나옵니다. 이것을 순기구학(FK, Forward Kinematics)이라고 합니다.
| 막대 | 길이 [m] | 방향 (모든 관절 0°일 때) |
|---|---|---|
| 위팔 L1 (어깨→팔꿈치) | 0.1205 | 수직에서 앞으로 α = 20.1° 기울어 붙어 있음 |
| 아래팔 L2 (팔꿈치→손목) | 0.162 | 수평 앞 |
| 손 L3 (손목→손끝) | 0.1206 | 수평 앞 |
관절이 +로 돌면 그 뒤의 막대가 모두 앞(아래)으로 숙여집니다. 그래서 아래팔의 방향은 θ2+θ3, 손의 방향은 θ2+θ3+θ4처럼 각도를 더해서 정합니다.
z = L1·cos(θ2+α) − L2·sin(θ2+θ3) − L3·sin(θ2+θ3+θ4)
좌표는 어깨(joint2) 축이 원점입니다. 손끝은 그리퍼 끝의 가운데(end_effector)입니다. 막대 길이는 ROBOTIS 모델 값에서 읽었습니다.