STMF_SVC_TERMINATE
stmf_state.stmf_svc_flags |= STMF_SVC_TERMINATE;
while (!(stmf_state.stmf_svc_flags & STMF_SVC_TERMINATE)) {