Torsten Wik, Per Rutquist, Claes Breitholtz: State-constrained control based on linearization of the Hamilton-Jacobi-Bellman equation. CDC 2010: 5192-5197