MPC Path Tracking Lab
같은 차량, 같은 조향 액추에이터를 두 개의 QP 기반 MPC가 동시에 제어합니다. Case A는 2차 조향 동특성을 예측모델에 포함하고, Case B는 조향이 명령 즉시 반영된다고 가정합니다. 속도·horizon·가중치·액추에이터 대역폭을 바꾸며 경로 오차, 조향 진동, 제약 활성화를 비교하고 속도 스윕으로 경향을 확인해보세요.
| Metric | A · aware | B · vehicle-only | A vs B |
|---|---|---|---|
| RMS lateral error ey | — | — | — |
| Peak lateral error |ey| | — | — | — |
| RMS heading error eψ | — | — | — |
| Mean steering rate |δ̇| | — | — | — |
| Peak steering rate max |δ̇| | — | — | — |
| Peak lateral accel. ay | — | — | — |
| Constrained QP steps share | — | — | — |
| Hildreth iterations mean | — | — | — |
Full-course batch runs with the current Np, Nc, r and actuator. Hollow markers: the vehicle left the path (peak |ey| > 1 m).
A x = [ey, ėy, eψ, ėψ, δ, δ̇]T
δ̈ = ωn2(δcmd − δ) − 2ζωnδ̇
B x = [ey, ėy, eψ, ėψ]T, δ ≡ δcmd
2-DOF bicycle error dynamics, curvature preview κ(s) as a measured disturbance, ZOH at Ts.
minΔU Σk=1Np (qyey,k2 + qψeψ,k2) + r Σj=0Nc−1 Δuj2
s.t. |uj| ≤ δmax, |Δuj| ≤ δ̇maxTs
A only: |δk| ≤ δmax, |δ̇k| ≤ δ̇max
Condensed to a dense QP in Nc increments; receding horizon applies Δu0.
Hildreth's procedure: coordinate ascent on the dual, entered only when the unconstrained optimum violates a bound.
Plant: nonlinear single-track model, m = 1530 kg, tanh tyre saturation (μ = 1.0), actuator angle/rate saturation. Neither controller's model matches it exactly.
Avg. solve — ms per controller step (this browser).
논문에서 검증한 핵심
논문은 식별된 2차 조향 모델과 2-DOF 차량 모델을 통합하고, 조향각·조향각속도 제약을 포함한 QP 기반 MPC를 구성했습니다. DLC와 road course에서 Np=20, Nc=8, Ts=10 ms, r=60을 기준으로 검증했으며, 액추에이터 동특성을 무시한 제어기는 속도가 높아질수록 진동이 커졌습니다.
브라우저 재현 범위
제어기는 논문과 같은 구조(2-DOF 차량 오차 모델 + 2차 조향 모델, 조향각·조향각속도 제약, Hildreth QP)로 매 스텝 실제 QP를 풉니다. 다만 플랜트는 27-DOF CarSim 대신 타이어 포화를 넣은 비선형 단일궤적 모델이고, 브라우저 실시간성을 위해 Ts=20 ms를 사용합니다. 수치는 논문과 직접 비교할 값이 아니라 경향을 보기 위한 것입니다.
About의 논문 정보 보기 →