Возврат в функцию на тоже место. Опции

[Alex ma]

Функция А:
Начало
Оператор,
Оператор,
Оператор,
Вызов функции Б,
1Оператор,
Оператор,
Выход из функции.
Конец

Проблема . необходимо выйти из функции А по оператору из вызванной функции Б. Функция Б в глобальной переменной сохраняет адрес возврата на оператор 1 функции А.

Функция Б:
Начало
Оператор,
Оператор,
Сохранение возврата на 1 Оператор,
Выход из функции Б, А.
Конец

Два дня мучаюсь, не знаю, как сделать, сохранить возврат на 1 оператор функции А и выйти из функций А, Б, а потом вернуться на оператор 1.

[Alex ma]

rcall L1
L1: pop R16
pop R17

Спасибо,
можно ли оформить в виде макроса подстановку Cooperat():
_функция:
оператор;
оператор;
оператор;
Cooperat(); // Подстановка строчек кода
оператор_пр_пр;
оператор;
оператор;
_выход_.


Начало Макроса Cooperat():
начало asm
rcall L1
L1: pop R16
pop R17
конец asm
//Вызов функции
SetTCB(); // функция сохраняет в структуре TCB, по мимо прочего PC+(смещение на вызов SetTCB()), чтоб потом при вызове « _функция» по указателю + смещение, попасть в точку "оператор_пр_пр".
Конец Макрос Cooperat().
PC – программный счетчик.
оператор_пр_пр - оператор продолжения программы.