Hello experts,
I'm trying to apply one-step nonlinear model predictive control (NMPC) for 3 degree of freedom nonlinear model of the ships(the system is nonlinear affine). The state weighting matrix is selected to be diagonal. The problem i face is that the controller can not track the position states due to the zeros corresponding to them in the control matrix g(x) (see the attachment).
i think changing the matrix Q, may lead to a solution but i couldn't do that by trail and error and i don't know any technique for selecting it.
Thanks in advance