Verschachtelte For Schleife pausieren und wieder fortsetzen

Hallo Leute,

ich habe ein Problem und mir fällt gerade keine elegante Möglichkeit 
ein, dass zu lösen.

Ich habe zwei verschachtelte For-Schleifen um x und y Verschiebung eines 
Messtisches zu ermöglichen. Das wird genutzt, um ein Raster zu 
vermessen. Jetzt würde ich gerne die Möglichkeit haben, diese Messung zu 
pausieren und später dort weiter zu machen. Auch soll vorgesehen werden, 
die Messung abbrechen zu können. Die Steuerung erfolgt über CAN. Das 
Einlsen der Botschaft per Interrupt. Das Decodieren der CAN Matrix und 
somit die Auswertung des Befehls aber außerhalb des Interrupts. Daher 
bräuchte ich sowas wie einen Interrupt für meine verschachtelten 
For-Schleifen. Kriege ich einen Interrupt durch die Can Botschaft, soll 
wenn die Botschaft komplett ist, in die Auswertung der Botschaft 
gesprungen werden und danach zurück in die aktuelle Position der 
For-Schleife, um ggf. dort mit dem ausgewerteten Kommando was tun zu 
können.

Wie kann man sowas lösen? Mir fällt jetzt nur ein, die aktuellen 
Positionen der For-Schleifen zu speichern, komplett die Schleifen zu 
verlassen. Die Auswertung zu machen und die Schleifen neu zu starten mit 
den zuletzt gespeicherten Werten. Dabei muss ich dann aber wieder 
Sonderfälle für die Initialisierung des Messequipment berücksichtigen, 
weshalb das erstmal nicht so schön wäre.

Gruß und Danke,
Sebastian