Control algorithm for a linear dynamic system subjected to complex constraints