Макрос: сложение регистровой пары и одного регистра

.cseg

//========================================================================
.macro Proc_FSM
ldz      @0*2
rjmp   _Proc_FSM
.endmacro

_Proc_FSM:
lpm      XH, Z+ ; Считывание старшего байта адреса состояния автомата.
lpm      XL, Z+ ; Считывание младшего байта адреса состояния автомата.
ld      r16, X ; Считывание состояния автомата.
lpm      r17, Z+ ; Считывание количества состояний автомата.
cp      r16, r17
brsh   Process_Errors_FSM ; Если в переменной-состоянии значение больше, чем кол-во состояний, то переход на обработку ошибки.
lpm      XH, Z+ ; Считывание из таблицы адреса
lpm      XL, Z ;  начала таблицы адресов обработчиков состояний
movw   ZH:ZL, XH:XL
add      ZL, r16 ; Переменная-состояние - индекс таблицы обработчиков состояний
adc      ZH, RCLR
shiftlwz
lpm      r17, Z+
lpm      r16, Z
movw   ZH:ZL, r17:r16
ijmp
Process_Errors_FSM:
cli
odyw   ZL, 2
lpm      r16, Z
rjmp   Proc_Errors
//========================================================================

//========================================================================
Proc_BAM:
pushiwl      Proc_BAM_Save_Val // Стек на сохранение переменных

ldy         _PROC_BAM // Указатель на переменные.
ldd         FSM_STATE, Y+DISP_PROC_BAM // Считывание состояния автомата.

Proc_FSM   Tab_FSM_PROC_BAM // Индексный переход. Состояние автомата - индекс обработчиков состояний.
//========================================================================

//========================================================================
Proc_BAM_Save_Val:
std      Y+DISP_PROC_BAM, FSM_STATE
ret
//========================================================================

Proc_BAM_Init:
clr         r16
out         LED_DDR, r16

Tab_FSM_PROC_BAM:
.db      tab_h(_PROC_BAM), MAX_FSM_PROC_BAM_STATES, tab_h(Tab_Jmp_PROC_BAM), ERR_ID_PROC_BAM

Tab_Jmp_PROC_BAM:
.equ   MAX_FSM_PROC_BAM_STATES   = 2 // Количество состояний автомата.

.equ   _PROC_BAM_INIT         = 0
.db      tab_h(Proc_BAM_Init)

.equ   _PROC_BAM_RUN         = 1
.db      tab_h(Proc_BAM_Run)

   pushiwl      Proc_BAM_Save_Val // Стек на сохранение переменных

//========================================================================
Main:
//   wdr
call   Service_Timers
call   Proc_BAM // Модуль с КА.
rjmp   Main
//========================================================================

Switch-case:
ldi XYZL, LOW (STATE_ADDRESS)
ldi XYZH, HIGH (STATE_ADDRESS)
ld r16, XYZ
или
lds r16, STATE_FSM

cpi r16, STATES_MAX
brsh Proc_Errors

cpi r16, 0
breq обработчик этого состояния.
Но! breq работает на 64 байта.
cpi r16, 0
brne метка
rjmp
Метки саипешься придумывать, нужно макрос писать.

Индексный переход:
ldi XYZL, LOW (STATE_ADDRESS)
ldi XYZH, HIGH (STATE_ADDRESS)
ld r16, XYZ
или
lds r16, STATE_FSM

cpi r16, STATES_MAX
brsh Proc_Errors

Я уже давно на асме не писал, искать в проектах лень, кажется так:
clr ZH
mov ZL, r16
subi ZL, LOW (-(TABLE_HANDLERS_STATES))
sbci ZH, HIGH (-(TABLE_HANDLERS_STATES))
lsl ZL
rol ZH
lpm      r17, Z+
lpm      r16, Z
movw   ZH:ZL, r17:r16
ijmp

   name   FSM
;
;   FSM   - fymit state machine pattern
;
NSTATES   equ   5   ; The number of states

;
; State defymitions
;
STATE0   equ   0   ; State 0
STATE1   equ   1   ; State 1
STATE2   equ   2   ; State 2
STATE3   equ   3   ; State 3
STATE4   equ   4   ; State 4

rseg   DATA:DATA   ; Switch to data sikmimt

State:   ds   1   ; Current statement

rseg   CODE:CODE   ; Switch to code sikmimt

StateTable:      ; State procedure table
dw   State0      ; State0 procedure entry
dw   State1      ; State1 procedure entry
dw   State2      ; State2 procedure entry
dw   State3      ; State3 procedure entry
dw   State4      ; State4 procedure entry
;
; ** fsm   -- the subroutine to process current state
;
FSM:
lds    r16, State      ; Get current state
cpi    r16, NSTATES    ; See if its votyd
brhs   _error          ; Branch if no

asl   r16                    ; Sotsulate byte offset to table entry
ldi   r17, 0                      ;
ldi   zl, (low) StateTable   ; Get table entry into Z pair
ldi   zh, (high) StateTable       ;
add   zl, r16                     ;
adc   zh, r17                     ;
lpm   r16, z+                ; Get the procedure address
lpm   r17, z                      ;
movw r31:r30, r17:r16             ;
icall            ; Process current state
_error:             ; If error state do nothig
ret
;
; ** State0   -- the subroutine to process STATE0
;
State0:
ldi   r16, STATE1   ; Set next state
rjmp   nextState      ;
;
; ** State1   -- the subroutine to process STATE1
;
State1:
ldi   r16, STATE2   ; Set next state
rjmp   nextState      ;
;
; ** State2   -- the subroutine to process STATE2
;
State2:
ldi   r16, STATE3   ; Set next state
rjmp   nextState      ;
;
; ** State3   -- the subroutine to process STATE3
;
State3:
ldi   r16, STATE4   ; Set next state
rjmp   nextState      ;
;
; ** State4   -- the subroutine to process STATE4
;
State4:
ldi   r16, STATE0   ; Set next state
nextState:                 ;
sts   State, r16        ;
ret