Simeon Nedelchev
Solve from the measured state.
Apply the first control.
Shift the plan and solve again at the next tick.
Dynamics, input limits, and state limits define feasibility.
A wall 1 m away makes collision avoidance infeasible.
Infeasible model, short horizon, and numerical failure are different diagnoses.
Record status and residuals.
The core example controls height and vertical speed.
Thrust limits become acceleration bounds around hover.
The take-home extends to attitude dynamics.
MPC and clipped LQR use identical limits.
Compare violations, tracking, and computation time.
Reading: MIT trajectory optimization