===== бла ... бла =====
in ZL,SPL
in ZH,SPH
subi ZL,K - 3 (где N количество байт которые были сохренеы в стеке)
sbci ZH,0
st Z-,Low(AdresFunction)
st Z-,High(AdresFunction)
adiw ZL,K
out SPL,ZL
out SPH,ZH
pop ....
pop ....
pop ....
reti
Идея вобщем примерно такая только по ret из функции куда вы выдете это вопрос интересный.