This paper introduces a computationally efficient approach for solving Model Predictive Control (MPC) reference tracking problems with state and control constraints. The approach consists of three key components: First, a log-domain interior-point quadratic programming method that forms the basis of the overall approach; second, a method of warm-starting this optimizer by using the MPC solution from the previous timestep; and third, a computational governor that bounds the suboptimality of the warm-start by altering the reference command provided to the MPC problem. As a result, the closed-loop system is altered in a manner so that MPC solutions can be computed using fewer optimizer iterations per timestep. In a numerical experiment, the computational governor reduces the worst-case computation time of a standard MPC implementation by 90%, while maintaining good closed-loop performance.
more »
« less
Quadrotor Flight Envelope Protection with Trajectory and Yaw Tracking
This study proposes a reference governor control strategy to ensure that a quadrotor drone follows a planar trajectory while respecting the prescribed safety constraints. These constraints, including polynomial constraints accounting for aerodynamic and gyroscopic effects, were transformed into linear constraints using novel state-space augmentation. This allows for the design of a reference governor, which is designed to safeguard the drone’s flight envelope by adjusting the reference trajectory during trajectory tracking while also ensuring yaw tracking with lower priority than position tracking, especially when constraints are at risk of being violated. This study also presents simulations that illustrate the effectiveness of the proposed algorithms.
more »
« less
- PAR ID:
- 10596544
- Publisher / Repository:
- AIAA
- Date Published:
- Journal Name:
- Journal of Guidance, Control, and Dynamics
- Volume:
- 47
- Issue:
- 12
- ISSN:
- 0731-5090
- Page Range / eLocation ID:
- 2601 to 2614
- Format(s):
- Medium: X
- Sponsoring Org:
- National Science Foundation
More Like this
-
-
We address the problem of synthesizing a controller for nonlinear systems with reach-avoid requirements. Our controller consists of a reference controller and a tracking controller which drives the actual trajectory to follow the reference trajectory. We identify a type of reference trajectory such that the tracking error between the actual trajectory of the closed-loop system and the reference trajectory can be bounded. Moreover, such a bound on the tracking error is independent of the reference trajectory. Using such bounds on the tracking error, we propose a method that can find a reference trajectory by solving a satisfiability problem over linear constraints. Our overall algorithm guarantees that the resulting controller can make sure every trajectory from the initial set of the system satisfies the given reach-avoid requirement. We also implement our technique in a tool FACTEST. We show that FACTEST can find controllers for four vehicle models (3–6 dimensional state space and 2–4 dimensional input space) across eight scenarios (with up to 22 obstacles), all with running time at the sub-second range.more » « less
-
This paper introduces the Feasibility Governor (FG): an add-on unit that enlarges the region of attraction of Model Predictive Control by manipulating the reference to ensure that the underlying optimal control problem remains feasible. The FG is developed for linear systems subject to polyhedral state and input constraints. Offline computations using polyhedral projection algorithms are used to construct the feasibility set. Online implementation relies on the solution of a convex quadratic program that guarantees recursive feasibility. The closed-loop system is shown to satisfy constraints, achieve asymptotic stability, and exhibit zero-offset tracking.more » « less
-
A set-theoretic Failure Model and Effect Management (FMEM) strategy for stuck/jammed actuators in systems with redundant actuators is considered. This strategy uses a reference governor for command tracking while satisfying state and control constraints and, once the failure mode is known, generates a recovery command sequence during mode transitions triggered by actuator failures. In the paper, this FMEM strategy is enhanced with a scheme to detect and isolate failures within a finite time, and to handle unmeasured set-bounded disturbance inputs. A numerical example is reported to illustrate the offline design process and the online operation with the proposed approach.more » « less
-
A parameter governor-based control scheme is developed to enforce various constraints, such as the Line of Sight (LoS) cone angle, the thrust limit, and the relative approach velocity during rendezvous missions in a near rectilinear halo orbit (NRHO) in the Earth-Moon system. The parameter governor is an add-on scheme to the nominal closed-loop system, which dynamically adjusts controller parameters in order to enforce the constraints. For the application to the rendezvous mission, we utilize the Time Shift Governor (TSG) which time shifts the target trajectory commanded to the Deputy spacecraft controller. The time shift is gradually reduced to zero so that the virtual target trajectory gradually converges to the Chief spacecraft trajectory as time evolves, and the rendezvous mission can be accomplished. Simulation results are reported that demonstrate the effectiveness of the proposed control scheme.more » « less
An official website of the United States government

