[TF-M] [RFC] Move re-entrant logic into entrance instead of SPM