Patent US 10,877,445

A predictive controller controls a vehicle subject to equality and inequality constraints on state and control variables of the vehicle and solves a matrix equation of necessary optimality conditions to produce control inputs to control the vehicle. The controller represents the state variables as a function of the control variables using discrete-time dynamics and determines the control inputs iteratively using two levels of iterations. The first level of iterations selects active inequality constraints, updates a constraint Jacobian matrix with a low-rank update for a change in the set of active inequality constraints to include the active inequality constraints, and updates a preconditioning matrix with a low-rank factorization update, in response to the low-rank update of the constraint Jacobian matrix. The second level of iterations, nested in the first level, solves the matrix equation with the updated constraint Jacobian matrix using the updated preconditioning matrix to produce the control inputs.