Перепрограммировать I8259A: драйвер клавиатуры

use32
global _start
extern  kernel_main
IRQ0_VECTOR equ 0x20
IRQ1_VECTOR equ IRQ0_VECTOR + 1
IRQ8_VECTOR equ 0x28
section .text
_start:
    ;IRQ0 0x20
    ;IRQ8 0x28
    mov     al,     0x11
    out     0x20,   al
    jmp     $+2;delay
    out     0xa0,   al  
    jmp     $+2
    mov     al,     IRQ0_VECTOR
    out     0x21,   al
    jmp     $+2
    mov     al,     IRQ8_VECTOR
    out     0xa1,   al
    jmp     $+2
    mov     al,     0x4
    out     0x21,   al
    jmp     $+2
    mov     al,     0x2
    out     0xa1,   al
    jmp     $+2
    mov     al,     0x11
    out     0x21,   al
    jmp     $+2
    mov     al,     0x1
    out     0xa1,   al
 
    ;set _erq1_handler in idt
    mov     esi,    IDT + IRQ1_VECTOR * 8
    mov     eax,    _irq1_handler
    
    mov     word[esi],      ax
    mov     word[esi+2],    cs
    mov     byte[esi+4],    0
    mov     byte[esi+5],    0x8e
    shr     eax,    16
    mov     word[esi+6],    ax
    lidt    [IDTR]
 
    ;block  IRQ0
    in      al,     0x21
    or      al,     1
    out     0x21,   al
 
    mov     dh,     '0' ;display digit
    mov     dl,     '0' ;keypress counter
    sti
 
_main:
    mov     byte[0xb8000],  dh
    mov     byte[0xb8001],  7
    inc     dh
    cmp     dh,     '9' + 1
    jne     _main
    mov     dh,     '0'
    jmp     _main
 
 
_irq1_handler:
;print counter
    mov byte[0xb8002],  dl
    mov byte[0xb8003],  7
    inc     dl
 
;EOI
    push    ax
    mov     al,     0x20
    out     0x20,   al
    jmp     $+2
    pop     ax
    sti
 
    iret
    
    
IDT:
    times 0x100 * 8 db 0
IDT_SIZE equ $ - IDT
 
IDTR:
    dw  IDT_SIZE - 1
    dd  IDT

irq1_handler:
pushad
in al,60h
;al - scancode
in    al, 61h
or    al, 80h
out   61h, al
xor   al, 80h
out   61h, al
mov   al, 20h
out   20h, al
out   0A0h, al
popad
iret