ASM Fibonnacci #1

DEF LD  0x80                ; LED adatregiszter          (írható/olvasható)
DEF SW  0x81                ; DIP kapcsoló adatregiszter (csak olvasható)
DEF DIG0 0x90
DEF DIG1 0x91

init:
    MOV r0, #0;
    MOV r1, #1;

work:
    MOV r2, r0;
    ADD r2, r1;
    JMP display_ld;

next_state:
    MOV r0, r1;
    MOV r1, r2;
    JMP work;

display_ld:
    MOV LD, r2;
    ;JMP next_state;

display:
    CMP r2, #1;
    JZ display_01;

    CMP r2, #2;
    JZ display_02;

    CMP r2, #3;
    JZ display_03;

    CMP r2, #4;
    JZ display_04;

    CMP r2, #5;
    JZ display_05;

    CMP r2, #6;
    JZ display_06;

    CMP r2, #7;
    JZ display_07;

    CMP r2, #8;
    JZ display_08;

    CMP r2, #9;
    JZ display_09;

    CMP r2, #10;
    JZ display_10;
    JNZ display_nothing;

    JMP next_state;

display_nothing:
    JSR display_clear;
    JMP next_state;

display_01:
    JSR load_num_1;
    JSR display_dig_0;
    JMP next_state;

display_02:
    JSR load_num_2;
    JSR display_dig_0;
    JMP next_state;

display_03:
    JSR load_num_3;
    JSR display_dig_0;
    JMP next_state;

display_04:
    JSR load_num_4;
    JSR display_dig_0;
    JMP next_state;

display_05:
    JSR load_num_5;
    JSR display_dig_0;
    JMP next_state;

display_06:
    JSR load_num_6;
    JSR display_dig_0;
    JMP next_state;

display_07:
    JSR load_num_7;
    JSR display_dig_0;
    JMP next_state;

display_08:
    JSR load_num_8;
    JSR display_dig_0;
    JMP next_state;

display_09:
    JSR load_num_9;
    JSR display_dig_0;
    JMP next_state;

display_10:
    JSR load_num_0;
    JSR display_dig_0;
    JSR load_num_1;
    JSR display_dig_1;
    JMP next_state;

load_num_0:
    MOV r3, #63;
    RTS;

load_num_1:
    MOV r3, #6;
    RTS;

load_num_2:
    MOV r3, #91;
    RTS;

load_num_3:
    MOV r3, #79;
    RTS;

load_num_4:
    MOV r3, #102;
    RTS;

load_num_5:
    MOV r3, #109;
    RTS;

load_num_6:
    MOV r3, #125;
    RTS;

load_num_7:
    MOV r3, #7;
    RTS;

load_num_8:
    MOV r3, #127;
    RTS;

load_num_9:
    MOV r3, #111;
    RTS;

display_clear:
    MOV r3, #0;
    MOV DIG0, r3;
    MOV DIG1, r3;
    RTS;

display_dig_0:
    MOV DIG0, r3;
    RTS;

display_dig_1:
    MOV DIG1, r3;
    RTS;