본문 바로가기
Lab
manipulator control rigid-body dynamics · computed torque · damped least squares

Robot Arm Lab

똑같은 3관절 로봇팔 네 대가 똑같은 궤적을 동시에 따라갑니다. 다른 것은 토크를 계산하는 방식뿐입니다. 관절마다 독립적으로 도는 PID, 중력만 보상하는 PD, 기준 궤적의 역동역학을 앞먹임으로 넣는 FF+PD, 그리고 팔 전체의 동역학을 상쇄하는 계산 토크 제어(CTC)입니다. 제어기가 모르는 하중을 쥐여 주고, 구동기 토크를 줄이고, 특이점 근처로 팔을 뻗게 하면서 어느 가정이 언제 무너지는지 숫자로 확인해보세요.

Presets
t 0.00 / 0.00 s READY
Work cell · side view PIDPD+gFF+PDCTC reference straight line
tool error ×10
ep PID—
ep PD+g—
ep FF+PD—
ep CTC—
τ {focus} J1/J2/J3—
w · cond(J)—
IK λmax · resid.—
Telemetry vs. time PIDPD+gFF+PDCTC drive limit gripper closed
Run summary not started
MetricPIDPD+gFF+PDCTC
RMS tool error ep ————
Peak tool error max ep ————
Placement error at release ————
Final error end of dwell ————
RMS joint error eq ————
Peak torque use |τ|/τmax ————
Saturated time share ————
Drive energy ∫Peldt ————

Green marks the best value in a row. Tool error is the tool-tip position against the reference joint trajectory; drive energy counts copper loss kiτi2 plus positive mechanical power, with no regeneration.

Payload sweep · 0–5 kg queued

Full-cycle batch runs in a worker: the actual payload varies, the model keeps m̂p (dashed line). Hollow markers: the drive tripped (following error > 100 mm or floor contact).

Plant · rigid-body dynamics

M(q) q̈ + C(q, q̇) q̇ + g(q) + Fvq̇ + Fc tanh(q̇/vs) = sat(τ)

Inverse dynamics by recursive Newton–Euler; M(q) from three unit-acceleration passes, q̈ by Cholesky. Rotor inertia N²Jm added on the diagonal. RK4 at 0.5 ms with τ held over the 1 ms control period.

Links 0.45 / 0.38 / 0.22 m, 6 / 4 / 1.6 kg; drives 130 / 75 / 20 N·m. The payload is a point mass that exists only while the gripper is closed.

Controllers · e = qr − q

PID τi = kp,iei + kd,iėi + ki,i∫ei

PD+g τ = Kpe + Kdė + ĝ(q)

FF+PD τ = ID̂(qr, q̇r, q̈r) + Kpe + Kdė

CTC τ = M̂(q)(q̈r + ωn2e + 2ζωnė) + ĥ(q, q̇)

Decentralised gains kp,i = M̂ii(q0)ωn2, kd,i = 2ζωnM̂ii, ki = kpωn/8 with conditional anti-windup. Hats use m̂p.

Kinematics & reference

Δq = Jᵀ(JJᵀ + λ²I)⁻¹ e, λ² = λ02(1 − (σmin/ε)2) for σmin < ε

w = √det(JvN NTJvT), N ⟂ [1 1 1] (tool angle held)

Quintic s(u) = 10u³ − 15u⁴ + 6u⁵ or a trapezoidal velocity with ¼ ramps. Task space: tool on a straight line, IK every millisecond. Joint space: joint angles interpolated between the same IK waypoints.

Avg. controller step — µs (4 arms, this browser).

What to look for

관찰할 만한 것들

  • 모델이 맞으면 모델 기반 두 제어기(FF+PD, CTC)는 PID·PD+g보다 오차가 수십 배 작습니다. 남는 오차는 1 ms 제로 차수 홀드와 인코더 속도 추정의 지연에서 나옵니다.
  • 하중을 모르면 CTC의 장점이 대부분 사라집니다. 하중 스윕에서 FF+PD와 CTC 곡선은 실제 하중이 모델 하중(m̂)과 같은 지점에서만 바닥을 찍습니다. 계산 토크는 자기가 받은 모델만큼만 정확합니다.
  • 토크가 포화되면 피드백 선형화의 전제(원하는 가속도를 낼 수 있다)가 깨집니다. 구동기가 팔을 붙잡지 못하면 추종 오차 한계에서 드라이브가 트립됩니다.
  • 팔을 다 뻗으면 조작성 타원이 납작해지고, 공구가 조금 움직이는 데에도 관절이 크게 돌아야 합니다. 관절 공간 보간은 같은 경유점 사이를 곡선으로 지나갑니다.
control
1 kHz
plant
RK4 · 0.5 ms
links
0.45/0.38/0.22 m
drives
130/75/20 N·m
Simulation scope

단순화한 부분

플랜트는 수직면 안에서 움직이는 강체 3R 팔입니다. 동역학 자체는 엄밀하지만(테스트에서 질량 행렬, 에너지 보존, 일-에너지 수지를 확인합니다) 관절 유연성, 기어 백래시, 전류 루프, 접촉은 없습니다. 로터 관성은 대각 항으로만 더했고, 쿨롱 마찰은 tanh로 부드럽게 만들었습니다. 하중은 그리퍼가 닫혀 있는 동안 끝점에 붙는 점질량이고, 작업대와의 충돌은 계산하지 않습니다(바닥 접촉만 감지). 비교를 공정하게 하려고 네 제어기가 같은 ωn, ζ를 씁니다. 실제 현장에서는 각 방식마다 따로 튜닝하므로 절대값보다 경향을 보세요.