LEM1802 Display Driver v1.01

:find_display
    HWN I
    :find_display_loop
        SUB I, 1
        HWQ I

        IFE B, [hw_display+1]
            IFE A, [hw_display+2]
                SET [hw_display], I

        IFN I, 0
            SET PC, find_display_loop
SET PC, POP

:update_display
    SET A, 3
    SET B, [disp_border]
    HWI [hw_display]

    SET A, 2
    SET B, [disp_colormap]
    HWI [hw_display]

    SET A, 1
    SET B, [disp_fontmap]
    HWI [hw_display]
    JSR refresh_display
SET PC, POP

:flip_page
    XOR [disp_buffer], [disp_buffer+1]
    XOR [disp_buffer+1], [disp_buffer]
    XOR [disp_buffer], [disp_buffer+1]

:refresh_display
    SET A, 0
    SET B, [disp_buffer]
    HWI [hw_display]
SET PC, POP

:clear_buffer
    SET I, [disp_buffer+1]
    SET J, 0
    :clear_buffer_loop
        STI, [I], 0
        IFL J, 0x180
            SET PC, clear_buffer_loop
SET PC, POP
;-----------------------------------------------------
:hw_display
    DAT 0, 0x7349, 0xF615 ;[HWI Address, ID 0, ID 1]

:disp_buffer
    DAT 0x8000, 0x8180 ;[Onscreen/Front Buffer, Backbuffer]

:disp_border ;Border color [0-16]
    DAT 0
:disp_fontmap ;Use .include [fontmap file] if not default
    DAT 0
:disp_colormap ;Use .include [colormap file] if not default
    DAT 0