Linear stabilization of nonlinear systems program motion