NMPC system for UAV control