[cns3xxx]: make smp code more similar to upstream