correct crane NMPC example in MATLAB