LCOM1920-T5G03

int (kbd_poll)(uint8_t bytes[], uint8_t *size){

    if(bytes == NULL || size == NULL) return 1;

    uint8_t c;

    if(kbd_read_byte(&c)) return 1;

    if(c == TWO_BYTE_CODE){

        if(kbd_read_byte(&bytes[0])) return 1;

        bytes[1] = c;

        *size = 2;

    }else{

        bytes[1] = 0;

        bytes[0] = c;

        *size = 1;

    }

    return 0;

}

int (kbd_read_byte)(uint8_t *value){

    uint8_t stat;

    while(1){

        if(util_sys_inb(STATUS_REG, &stat)) return 1;

        if((stat&OUT_BUF_FUL) && ((stat&AUX_MOUSE)^AUX_MOUSE)){

            if(stat & (PARITY_ERROR | TIME_OUT_REC)) return 1;

            else return util_sys_inb(OUTPUT_BUF, value);

        }

        tickdelay(micros_to_ticks(DELAY));

    }

}

#define DELAY   50000 /* @brief KBC Response Delay */

/**

 * @brief High-level function that polls keyboard for scancode

 * High-level function that polls keyboard for scancode of up to 2 bytes. If

 * scancode has only 1 byte, the second byte is set to 0x00.

 * @param bytes Array of at least 2 bytes to store scancode

 * @param size Size of scancode in bytes

 * @return 0 if operation was successful, 1 otherwise

 */

int (kbd_poll)(uint8_t bytes[], uint8_t *size);

/**

 * @brief Low-level function for reading byte from keyboard

 * Low-level function for reading byte from keyboard. Waits until output buffer

 * is full

 * @param value Pointer to variable where byte read from keyboard will be stored

 * @return 0 if operation was successful, 1 otherwise

 */

int (kbd_read_byte)(uint8_t *value);

    uint8_t c[2]; uint8_t size;

    do{

        if(kbd_poll(c, &size)) return 1;

        if(kbd_print_scancode((~c[0])&BREAK_CODE_BIT, size, c)) return 1;

    }while(!(size == 1 && c[0] == ESC_BREAK_CODE));

    return 0;