관절 각도로 손끝 위치 구하기

관절을 몇 도씩 꺾으면 손끝이 어디에 갈까요? 동역학의 모든 계산(무게중심까지 거리, 손끝 속도, 손끝 힘)은 이 계산에서 시작합니다. 손으로 예측 → 시뮬레이션으로 확인 → 예측과 비교 순서로 진행합니다.

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

1개념: 각도를 더해 가며 팔을 따라간다

옆에서 보면 OMX 팔은 위팔·아래팔·손 세 막대가 이어진 모양입니다. 어깨(joint2)에서 출발해 막대 하나씩 따라가며 x(앞), z(위)를 더하면 손끝 위치가 나옵니다. 이것을 순기구학(FK, Forward Kinematics)이라고 합니다.

xz α L1L2L3 어깨 joint2팔꿈치손목손끝
막대길이 [m]방향 (모든 관절 0°일 때)
위팔 L1 (어깨→팔꿈치)0.1205수직에서 앞으로 α = 20.1° 기울어 붙어 있음
아래팔 L2 (팔꿈치→손목)0.162수평 앞
손 L3 (손목→손끝)0.1206수평 앞

관절이 +로 돌면 그 뒤의 막대가 모두 앞(아래)으로 숙여집니다. 그래서 아래팔의 방향은 θ2+θ3, 손의 방향은 θ2+θ3+θ4처럼 각도를 더해서 정합니다.

x = L1·sin(θ2+α) + L2·cos(θ2+θ3) + L3·cos(θ2+θ3+θ4)
z = L1·cos(θ2+α) − L2·sin(θ2+θ3) − L3·sin(θ2+θ3+θ4)

좌표는 어깨(joint2) 축이 원점입니다. 손끝은 그리퍼 끝의 가운데(end_effector)입니다. 막대 길이는 ROBOTIS 모델 값에서 읽었습니다.

2예측: 손끝은 어디에 있을까?

계산기(오른쪽 아래, \ 키)를 쓰세요. 삼각함수는 DEG 모드입니다. 답은 m 단위, 손끝 위치 차이가 5 mm 이내면 맞습니다.

문제 1 모든 관절 0° (θ2 = θ3 = θ4 = 0°)
m
문제 2 θ2 = 45°, θ3 = 10°, θ4 = −55°
m
풀이 보기

3실험: 각도를 넣고 손끝 위치 재기

슬라이더로 관절 각도를 바꾸면 팔이 그 자세가 되고, 손끝(파란 점)의 x, z가 왼쪽에 표시됩니다. 내 예측은 주황 점으로 보입니다.

이 실험은 힘을 쓰지 않고 자세만 보여 줍니다(기구학). 문제 1과 문제 2 자세를 각각 한 번씩 확인하면 다음 단계가 열립니다.

4확인: 손목만 돌리면 손끝은 어떻게 움직일까?

문제 2 자세에서 θ4(손목)만 바꿔 보세요. 손끝이 그리는 길은 어떤 모양인가요?

5응용: 바닥 회전 joint1을 돌리면?

joint1은 팔 전체를 바닥 축으로 돌립니다. 위에서 보면 손끝은 joint1 축을 중심으로 원을 그립니다. 모든 관절 0°에서 joint1 = 30°이면 손끝은 옆(y)으로 얼마나 갈까요? (joint1 축은 어깨 바로 아래에 있습니다.)

y = (축에서 손끝까지 수평거리) × sin θ1
m

모델의 손끝은 가운데에서 옆으로 1.6 mm 비켜 있어서 시뮬 값이 조금 다릅니다(5 mm 채점에는 영향 없음).