[TF-M] T398/T413: Source cleanup and tool integration