https://5dok.net/document/zlgjm38g-control-with-a-time-varying-terminal-constraint-set.html