Макрос: сложение регистровой пары и одного регистра - ATmega AVR - Ответ 11284441

@dimyurk1978 · 25.04.2015, 13:26

В общем как-то так, шаблон ядра конечного автомата на асме:

Код

//========================================================================
#define tab_h(x) HIGH(x), LOW(x)
#define tab_l(x) LOW(x), HIGH(x)
//========================================================================

//========================================================================
.macro   pushiwl
ldi      r16, LOW(@0)
push   r16
ldi      r16, HIGH(@0)
push   r16
.endmacro
//========================================================================

.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 ; Считывание ID ошибки.
rjmp   Proc_Errors ; переход на обработчик ошибок.
//========================================================================

//========================================================================
.def   FSM_STATE             = r20
//========================================================================

//========================================================================
.equ   ERR_ID_FSM_1_MAX_STATES = 1
//========================================================================

.dseg

//========================================================================
_FSM_1_STATE: // Состояние автомата.
.byte   1
//========================================================================

//========================================================================
Proc_FSM_1_Save_State:
sts     _FSM_1_STATE, FSM_STATE
ret
//========================================================================

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

lds         FSM_STATE, _FSM_1_STATE ; Считывание состояния.

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

//========================================================================
Proc_FSM_1_Init:
; bla-bla
Proc_FSM_1_Init_Save_State:
ldi FSM_STATE, _PROC_FSM_1_1
ret
//========================================================================

//========================================================================
Proc_FSM_1_1:
; bla-bla
Proc_FSM_1_1_Save_State:
ldi FSM_STATE, _PROC_FSM_1_OTHER
ret
//========================================================================

//========================================================================
//           STATE          MAX_FSM_STATES    TABLE_HANDLERS

Tab_FSM_1:
.db    tab_h(_FSM_1_STATE), MAX_FSM_1_STATES, tab_h(Tab_Jmp_FSM_1_Homdlers), ERR_ID_FSM_1_MAX_STATES

Tab_Jmp_FSM_1_Homdlers:
// Названия состояний задаем здесь во избежание ошибок.
.equ   MAX_FSM_1_STATES        = 2 // Количество состояний автомата.

.equ   _PROC_FSM_1_INIT        = 0
.db    tab_h(Proc_FSM_1_Init)

.equ   _PROC_FSM_1_1           = 1
.db    tab_h(Proc_FSM_1_1)
//========================================================================

Разъебеснение этой строки:

Код

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

В ядре индексный переход на обработчик состояния. ijmp. В конце обработчика установка состояния. Либо текущее остается, либо задается.

Код

Proc_FSM_1_Init_Save_State:
ldi FSM_STATE, _PROC_FSM_1_1
ret

По идее должен быть возврат, откуда вызвали модуль Proc_FSM_1. Но мы подсунули стеку адрес возврата Proc_FSM_1_Save_State. Поэтому сначала будет переход на этот адрес, и потом только возврат к месту вызова модуля.

Накидал на скору руку. Тщательно проверять нет ни времени ни желания. Разбирайтесь, запускайте мой пример в симуляторе студии. Удачи.

Всем желающим один из моих проектов на асме для разбирательства.

[22.77 Кб]

Вернуться к обсуждению:
Макрос: сложение регистровой пары и одного регистра ATmega AVR

Следующий ответ