So ein Stack verbiegen und Register sichern, verbraucht einiges an Takte und RAM, von der Sicherheit ganz abgesehen.
Wäre es nicht besser in der ISR ein Flag zu setzen, dieses Flag im main und auch sonst an geeigneten Stellen abzufragen und bei bedarf in die gewünschte Funktion zu springen?