Further NMPC integration