Subversion Repositories HelenOS

 *

 * It takes care of low-level keyboard functions.

#include <arch/drivers/i8042.h>

#include <arch/interrupt.h>

#include <cpu.h>

#include <arch/asm.h>

#include <arch.h>

#include <synch/spinlock.h>

#include <typedefs.h>

#include <console/chardev.h>

#include <console/console.h>

#include <macros.h>

#include <interrupt.h>

/* Keyboard commands. */

#define KBD_ENABLE  0xf4

#define KBD_DISABLE 0xf5

#define KBD_ACK     0xfa

/*

 * 60  Write 8042 Command Byte: next data byte written to port 60h is

 *     placed in 8042 command register. Format:

 *

 *    |7|6|5|4|3|2|1|0|8042 Command Byte

 *     | | | | | | | `---- 1=enable output register full interrupt

 *     | | | | | | `----- should be 0

 *     | | | | | `------ 1=set status register system, 0=clear

 *     | | | | `------- 1=override keyboard inhibit, 0=allow inhibit

 *     | | | `-------- disable keyboard I/O by driving clock line low

 *     | | `--------- disable auxiliary device, drives clock line low

 *     | `---------- IBM scancode translation 0=AT, 1=PC/XT

 *     `----------- reserved, should be 0

 */

#define i8042_SET_COMMAND   0x60

#define i8042_COMMAND       0x69

#define i8042_BUFFER_FULL_MASK  0x01

#define i8042_WAIT_MASK     0x02

#define i8042_MOUSE_DATA        0x20

#define SPECIAL     '?'

#define KEY_RELEASE 0x80

/**

 * These codes read from i8042 data register are silently ignored.

 */

#define IGNORE_CODE 0x7f

static void key_released(uint8_t sc);

static void key_pressed(uint8_t sc);

static char key_read(chardev_t *d);

#define PRESSED_SHIFT       (1<<0)

#define PRESSED_CAPSLOCK    (1<<1)

#define LOCKED_CAPSLOCK     (1<<0)

#define ACTIVE_READ_BUFF_SIZE 16    /* Must be power of 2 */

static uint8_t active_read_buff[ACTIVE_READ_BUFF_SIZE];

SPINLOCK_INITIALIZE(keylock);       /**< keylock protects keyflags and lockflags. */

static volatile int keyflags;       /**< Tracking of multiple keypresses. */

static volatile int lockflags;      /**< Tracking of multiple keys lockings. */

static void i8042_suspend(chardev_t *);

static void i8042_resume(chardev_t *);

static chardev_t kbrd;

static chardev_operations_t ops = {

    .suspend = i8042_suspend,

    .resume = i8042_resume,

    .read = key_read

};

    '`',

    '\\',

    '*',

    '~',

    '|',

    '*',

static void i8042_interrupt(int n, istate_t *istate);

static void i8042_wait(void);

static iroutine oldvector;

/** Initialize keyboard and service interrupts using kernel routine */

void i8042_grab(void)

{

    oldvector = exc_register(VECTOR_KBD, "i8042_interrupt", (iroutine) i8042_interrupt);

    i8042_wait();

    i8042_command_write(i8042_SET_COMMAND);

    i8042_wait();

    i8042_data_write(i8042_COMMAND);

    i8042_wait();

}

/** Resume the former interrupt vector */

void i8042_release(void)

{

    if (oldvector)

        exc_register(VECTOR_KBD, "user_interrupt", oldvector);

}

/** Initialize i8042. */

void i8042_init(void)

{

    int i;

    i8042_grab();

        /* Prevent user from accidentaly releasing calling i8042_resume

     * and disabling keyboard

     */

    oldvector = NULL;

    trap_virtual_enable_irqs(1<<IRQ_KBD);

    chardev_initialize("i8042_kbd", &kbrd, &ops);

    stdin = &kbrd;

    /*

     * Clear input buffer.

     * Number of iterations is limited to prevent infinite looping.

     */

    for (i = 0; (i8042_status_read() & i8042_BUFFER_FULL_MASK) && i < 100; i++) {

        i8042_data_read();

    }  

}

/** Process i8042 interrupt.

 *

 * @param n Interrupt vector.

 * @param istate Interrupted state.

 */

void i8042_interrupt(int n, istate_t *istate)

{

    uint8_t x;

    uint8_t status;

    while (((status=i8042_status_read()) & i8042_BUFFER_FULL_MASK)) {

        x = i8042_data_read();

        if ((status & i8042_MOUSE_DATA))

            continue;

        if (x & KEY_RELEASE)

            key_released(x ^ KEY_RELEASE);

        else

            key_pressed(x);

    }

    trap_virtual_eoi();

}

/** Wait until the controller reads its data. */

void i8042_wait(void) {

    while (i8042_status_read() & i8042_WAIT_MASK) {

        /* wait */

    }

}

/** Process release of key.

 *

 * @param sc Scancode of the key being released.

 */

void key_released(uint8_t sc)

{

    spinlock_lock(&keylock);

    switch (sc) {

        case SC_LSHIFT:

        case SC_RSHIFT:

        keyflags &= ~PRESSED_SHIFT;

        break;

        case SC_CAPSLOCK:

        keyflags &= ~PRESSED_CAPSLOCK;

        if (lockflags & LOCKED_CAPSLOCK)

            lockflags &= ~LOCKED_CAPSLOCK;

        else

            lockflags |= LOCKED_CAPSLOCK;

        break;

        default:

        break;

    }

    spinlock_unlock(&keylock);

}

/** Process keypress.

 *

 * @param sc Scancode of the key being pressed.

 */

void key_pressed(uint8_t sc)

{

    char *map = sc_primary_map;

    char ascii = sc_primary_map[sc];

    bool shift, capslock;

    bool letter = false;

    spinlock_lock(&keylock);

    switch (sc) {

    case SC_LSHIFT:

    case SC_RSHIFT:

            keyflags |= PRESSED_SHIFT;

        break;

    case SC_CAPSLOCK:

        keyflags |= PRESSED_CAPSLOCK;

        break;

    case SC_SPEC_ESCAPE:

        break;

    case SC_LEFTARR:

        chardev_push_character(&kbrd, 0x1b);

        chardev_push_character(&kbrd, 0x5b);

        chardev_push_character(&kbrd, 0x44);

        break;

    case SC_RIGHTARR:

        chardev_push_character(&kbrd, 0x1b);

        chardev_push_character(&kbrd, 0x5b);

        chardev_push_character(&kbrd, 0x43);

        break;

    case SC_UPARR:

        chardev_push_character(&kbrd, 0x1b);

        chardev_push_character(&kbrd, 0x5b);

        chardev_push_character(&kbrd, 0x41);

        break;

    case SC_DOWNARR:

        chardev_push_character(&kbrd, 0x1b);

        chardev_push_character(&kbrd, 0x5b);

        chardev_push_character(&kbrd, 0x42);

        break;

    case SC_HOME:

        chardev_push_character(&kbrd, 0x1b);

        chardev_push_character(&kbrd, 0x4f);

        chardev_push_character(&kbrd, 0x48);

        break;

    case SC_END:

        chardev_push_character(&kbrd, 0x1b);

        chardev_push_character(&kbrd, 0x4f);

        chardev_push_character(&kbrd, 0x46);

        break;

    case SC_DELETE:

        chardev_push_character(&kbrd, 0x1b);

        chardev_push_character(&kbrd, 0x5b);

        chardev_push_character(&kbrd, 0x33);

        chardev_push_character(&kbrd, 0x7e);

        break;

    default:

            letter = is_lower(ascii);

        capslock = (keyflags & PRESSED_CAPSLOCK) || (lockflags & LOCKED_CAPSLOCK);

        shift = keyflags & PRESSED_SHIFT;

        if (letter && capslock)

            shift = !shift;

        if (shift)

            map = sc_secondary_map;

        chardev_push_character(&kbrd, map[sc]);

        break;

    }

    spinlock_unlock(&keylock);

}

/* Called from getc(). */

void i8042_resume(chardev_t *d)

{

}

/* Called from getc(). */

void i8042_suspend(chardev_t *d)

{

}

static uint8_t active_read_buff_read(void)

{

    static int i=0;

    i &= (ACTIVE_READ_BUFF_SIZE-1);

    if(!active_read_buff[i]) {

        return 0;

    }

    return active_read_buff[i++];

}

static void active_read_buff_write(uint8_t ch)

{

    static int i=0;

    active_read_buff[i] = ch;

    i++;

    i &= (ACTIVE_READ_BUFF_SIZE-1);

    active_read_buff[i]=0;

}

static void active_read_key_pressed(uint8_t sc)

{

    char *map = sc_primary_map;

    char ascii = sc_primary_map[sc];

    bool shift, capslock;

    bool letter = false;

    /*spinlock_lock(&keylock);*/

    switch (sc) {

    case SC_LSHIFT:

    case SC_RSHIFT:

            keyflags |= PRESSED_SHIFT;

        break;

    case SC_CAPSLOCK:

        keyflags |= PRESSED_CAPSLOCK;

        break;

    case SC_SPEC_ESCAPE:

        break;

    case SC_LEFTARR:

        active_read_buff_write(0x1b);

        active_read_buff_write(0x5b);

        active_read_buff_write(0x44);

        break;

    case SC_RIGHTARR:

        active_read_buff_write(0x1b);

        active_read_buff_write(0x5b);

        active_read_buff_write(0x43);

        break;

    case SC_UPARR:

        active_read_buff_write(0x1b);

        active_read_buff_write(0x5b);

        active_read_buff_write(0x41);

        break;

    case SC_DOWNARR:

        active_read_buff_write(0x1b);

        active_read_buff_write(0x5b);

        active_read_buff_write(0x42);

        break;

    case SC_HOME:

        active_read_buff_write(0x1b);

        active_read_buff_write(0x4f);

        active_read_buff_write(0x48);

        break;

    case SC_END:

        active_read_buff_write(0x1b);

        active_read_buff_write(0x4f);

        active_read_buff_write(0x46);

        break;

    case SC_DELETE:

        active_read_buff_write(0x1b);

        active_read_buff_write(0x5b);

        active_read_buff_write(0x33);

        active_read_buff_write(0x7e);

        break;

    default:

            letter = is_lower(ascii);

        capslock = (keyflags & PRESSED_CAPSLOCK) || (lockflags & LOCKED_CAPSLOCK);

        shift = keyflags & PRESSED_SHIFT;

        if (letter && capslock)

            shift = !shift;

        if (shift)

            map = sc_secondary_map;

        active_read_buff_write(map[sc]);

        break;

    }

    /*spinlock_unlock(&keylock);*/

}

static char key_read(chardev_t *d)

{

    char ch;   

    while(!(ch = active_read_buff_read())) {

        uint8_t x;

        while (!(i8042_status_read() & i8042_BUFFER_FULL_MASK))

            ;

        x = i8042_data_read();

        if (x != IGNORE_CODE) {

            if (x & KEY_RELEASE)

                key_released(x ^ KEY_RELEASE);

            else

                active_read_key_pressed(x);

        }

    }

    return ch;

}

/** Poll for key press and release events.

 *

 * This function can be used to implement keyboard polling.

 */

void i8042_poll(void)

{

    uint8_t x;

    while (((x = i8042_status_read() & i8042_BUFFER_FULL_MASK))) {

        x = i8042_data_read();

        if (x != IGNORE_CODE) {

            if (x & KEY_RELEASE)

                key_released(x ^ KEY_RELEASE);

            else

                key_pressed(x);

        }

    }

}