Subversion Repositories HelenOS

/*

 * Copyright (c) 2001-2004 Jakub Jermar

 * Copyright (c) 2006 Josef Cejka

 * All rights reserved.

 *

 * Redistribution and use in source and binary forms, with or without

 * modification, are permitted provided that the following conditions

 * are met:

 *

 * - Redistributions of source code must retain the above copyright

 *   notice, this list of conditions and the following disclaimer.

 * - Redistributions in binary form must reproduce the above copyright

 *   notice, this list of conditions and the following disclaimer in the

 *   documentation and/or other materials provided with the distribution.

 * - The name of the author may not be used to endorse or promote products

 *   derived from this software without specific prior written permission.

 *

 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR

 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES

 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.

 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,

 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT

 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,

 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY

 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT

 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF

 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.

 */

/** @addtogroup kbd_port

 * @ingroup kbd

 * @{

 */

/** @file

 * @brief i8042 port driver.

 */

#include <ddi.h>

#include <libarch/ddi.h>

#include <ipc/ipc.h>

#include <async.h>

#include <unistd.h>

#include <sysinfo.h>

#include <kbd_port.h>

#include <kbd.h>

#include <ddi.h>

#include "i8042.h"

/* Interesting bits for status register */

#define i8042_OUTPUT_FULL  0x1

#define i8042_INPUT_FULL   0x2

#define i8042_MOUSE_DATA   0x20

/* Command constants */

#define i8042_CMD_KBD 0x60

#define i8042_CMD_MOUSE  0xd4

/* Keyboard cmd byte */

#define i8042_KBD_IE        0x1

#define i8042_MOUSE_IE      0x2

#define i8042_KBD_DISABLE   0x10

#define i8042_MOUSE_DISABLE 0x20

#define i8042_KBD_TRANSLATE 0x40

/* Mouse constants */

#define MOUSE_OUT_INIT  0xf4

#define MOUSE_ACK       0xfa

static irq_cmd_t i8042_cmds[] = {

    {

        .cmd = CMD_PIO_READ_8,

        .addr = NULL,   /* will be patched in run-time */

        .dstarg = 1

    },

    {

        .cmd = CMD_BTEST,

        .value = i8042_OUTPUT_FULL,

        .srcarg = 1,

        .dstarg = 3

    },

    {

        .cmd = CMD_PREDICATE,

        .value = 2,

        .srcarg = 3

    },

    {

        .cmd = CMD_PIO_READ_8,

        .addr = NULL,   /* will be patched in run-time */

        .dstarg = 2

    },

    {

        .cmd = CMD_ACCEPT

    }

};

static irq_code_t i8042_kbd = {

    sizeof(i8042_cmds) / sizeof(irq_cmd_t),

    i8042_cmds

};

static uintptr_t i8042_physical;

static uintptr_t i8042_kernel;

static i8042_t * i8042;

static void wait_ready(void) {

    while (pio_read_8(&i8042->status) & i8042_INPUT_FULL)

        ;

}

static void i8042_irq_handler(ipc_callid_t iid, ipc_call_t *call);

int kbd_port_init(void)

{

    int mouseenabled = 0;

    void *vaddr;

    i8042_physical = sysinfo_value("kbd.address.physical");

    i8042_kernel = sysinfo_value("kbd.address.kernel");

    if (pio_enable((void *) i8042_physical, sizeof(i8042_t), &vaddr) != 0)

        return -1;

    i8042 = vaddr;

    async_set_interrupt_received(i8042_irq_handler);

    /* Disable kbd, enable mouse */

    pio_write_8(&i8042->status, i8042_CMD_KBD);

    wait_ready();

    pio_write_8(&i8042->status, i8042_CMD_KBD);

    wait_ready();

    pio_write_8(&i8042->data, i8042_KBD_DISABLE);

    wait_ready();

    /* Flush all current IO */

    while (pio_read_8(&i8042->status) & i8042_OUTPUT_FULL)

        (void) pio_read_8(&i8042->data);

    /* Enable kbd */

    i8042_kbd.cmds[0].addr = (void *) &((i8042_t *) i8042_kernel)->status;

    i8042_kbd.cmds[3].addr = (void *) &((i8042_t *) i8042_kernel)->data;

    ipc_register_irq(sysinfo_value("kbd.inr"), device_assign_devno(), 0, &i8042_kbd);

    int newcontrol = i8042_KBD_IE | i8042_KBD_TRANSLATE;

    if (mouseenabled)

        newcontrol |= i8042_MOUSE_IE;

    pio_write_8(&i8042->status, i8042_CMD_KBD);

    wait_ready();

    pio_write_8(&i8042->data, newcontrol);

    wait_ready();

    return 0;

}

void kbd_port_yield(void)

{

}

void kbd_port_reclaim(void)

{

}

static void i8042_irq_handler(ipc_callid_t iid, ipc_call_t *call)

{

    int status = IPC_GET_ARG1(*call);

    if ((status & i8042_MOUSE_DATA))

        return;

    int scan_code = IPC_GET_ARG2(*call);

    kbd_push_scancode(scan_code);

    return;

}

/**

 * @}

 */