Ошибка при отладке в AVR Studio маленького макроса Опции

[_Алекс]

Была задача получить текущий адрес выполнения программы – программный счетчик PC.
Среда разработки IAR
Запомнить его, сделал вот так, результат, при отладке в AVR STUDIO выдает ошибку с переполнение стека после нескольких прогонах программы, интересно что при вызове rcall L1, стек увеличивается на 2 байта, при pop, pop уменьшается на два, вобщем кажется все правильно.

Макрос взятия адреса и функция в макросе, которая по идеи должна сохранять PC, но просто сделана как тестовая.

#define OutSaveContekst\
{\
asm ("rcall L1\n" "L1: pop r16\n" "pop r17\n");\
SaveContext();\
\
}

Функция SaveContext (по идеи сохранение контекста) ни чего полезного пока
void SaveContext(void){
static int t = 0;
t++;
};

Функция тест в которой применен макрос
void test(void){
static char i;
if (i = = 5){
OutSaveContekst;
i = i + 1;
};
i = i + 1;
};

Главная функция
void main( void )
{
while(1){
test();
}
};

[IgorKossak]

Была задача получить текущий адрес выполнения программы – программный счетчик PC.

SP указывает на место куда в следующий раз будет сохранён байт (pop) или адрес (call).
Поэтому надо модифицировать SP (чтобы он указывал на место в стеке, где лежит сохранённый адрес) и после этого РАЗЫМЕНОВАТЬ его, т. е. взять значение, лежащее в стеке (а не в SP и уж тем более, не во __flash).

[prottoss]

Была задача получить текущий адрес выполнения программы – программный счетчик PC.

SP указывает на место куда в следующий раз будет сохранён байт (pop) или адрес (call).
Поэтому надо модифицировать SP (чтобы он указывал на место в стеке, где лежит сохранённый адрес) и после этого РАЗЫМЕНОВАТЬ его, т. е. взять значение, лежащее в стеке (а не в SP и уж тем более, не во __flash).

Да, Вы правы... А что по поводу вот такого варианта?

Код

     19          unsigned int __flash *OutSaveContekst(void)
   \                     OutSaveContekst:
     20          {
     21             return (unsigned int __flash *)(*(unsigned int *)(SP + 2));
   \   00000000   B7ED               IN      R30, 0x3D
   \   00000002   B7FE               IN      R31, 0x3E
   \   00000004   9632               ADIW    R31:R30, 2
   \   00000006   8100               LD      R16, Z
   \   00000008   8111               LDD     R17, Z+1
   \   0000000A   9508               RET
     22          }

[IgorKossak]

А что по поводу вот такого варианта?

Это и имелось в виду, только среды под рукой не было, чтобы проверить.
PS: атомарность всё-таки необходима. Это можно обеспечить словом __monitor перед определением функции.