Subversion Repositories HelenOS

Rev

Rev 4344 | Rev 4347 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 4344 Rev 4345
Line 33... Line 33...
33 
 */
 33 
 */
34 
/** @file
 34 
/** @file
35 
 * @brief i8042 port driver.
 35 
 * @brief i8042 port driver.
36 
 */
 36 
 */
37 
 
 37 
 
- 
 
 38 
#include <ddi.h>
- 
 
 39 
#include <libarch/ddi.h>
38 
#include <ipc/ipc.h>
 40 
#include <ipc/ipc.h>
39 
#include <async.h>
 41 
#include <async.h>
40 
#include <unistd.h>
 42 
#include <unistd.h>
41 
#include <sysinfo.h>
 43 
#include <sysinfo.h>
42 
#include <kbd_port.h>
 44 
#include <kbd_port.h>
Line 64... Line 66...
64 
#define MOUSE_ACK       0xfa
 66 
#define MOUSE_ACK       0xfa
65 
 
 67 
 
66 
static irq_cmd_t i8042_cmds[] = {
 68 
static irq_cmd_t i8042_cmds[] = {
67 
    {
 69 
    {
68 
        .cmd = CMD_PIO_READ_8,
 70 
        .cmd = CMD_PIO_READ_8,
69 
        .addr = (void *) 0x64,
 71 
        .addr = NULL,   /* will be patched in run-time */
70 
        .dstarg = 1
 72 
        .dstarg = 1
71 
    },
 73 
    },
72 
    {
 74 
    {
73 
        .cmd = CMD_BTEST,
 75 
        .cmd = CMD_BTEST,
74 
        .value = i8042_OUTPUT_FULL,
 76 
        .value = i8042_OUTPUT_FULL,
Line 80... Line 82...
80 
        .value = 2,
 82 
        .value = 2,
81 
        .srcarg = 3
 83 
        .srcarg = 3
82 
    },
 84 
    },
83 
    {
 85 
    {
84 
        .cmd = CMD_PIO_READ_8,
 86 
        .cmd = CMD_PIO_READ_8,
85 
        .addr = (void *) 0x60,
 87 
        .addr = NULL,   /* will be patched in run-time */
86 
        .dstarg = 2
 88 
        .dstarg = 2
87 
    },
 89 
    },
88 
    {
 90 
    {
89 
        .cmd = CMD_ACCEPT
 91 
        .cmd = CMD_ACCEPT
90 
    }
 92 
    }
Line 93... Line 95...
93 
static irq_code_t i8042_kbd = {
 95 
static irq_code_t i8042_kbd = {
94 
    sizeof(i8042_cmds) / sizeof(irq_cmd_t),
 96 
    sizeof(i8042_cmds) / sizeof(irq_cmd_t),
95 
    i8042_cmds
 97 
    i8042_cmds
96 
};
 98 
};
97 
 
 99 
 
- 
 
 100 
static uintptr_t i8042_physical;
- 
 
 101 
static uintptr_t i8042_kernel;
- 
 
 102 
static i8042_t * i8042;
- 
 
 103 
 
98 
static void wait_ready(void) {
 104 
static void wait_ready(void) {
99 
    while (i8042_status_read() & i8042_INPUT_FULL)
 105 
    while (pio_read_8(&i8042->status) & i8042_INPUT_FULL)
100 
        ;
 106 
        ;
101 
}
 107 
}
102 
 
 108 
 
103 
static void i8042_irq_handler(ipc_callid_t iid, ipc_call_t *call);
 109 
static void i8042_irq_handler(ipc_callid_t iid, ipc_call_t *call);
104 
 
 110 
 
105 
int kbd_port_init(void)
 111 
int kbd_port_init(void)
106 
{
 112 
{
107 
//  int i;
 - 
 
108 
    int mouseenabled = 0;
 113 
    int mouseenabled = 0;
- 
 
 114 
    void *vaddr;
- 
 
 115 
 
- 
 
 116 
    i8042_physical = sysinfo_value("kbd.address.physical");
- 
 
 117 
    i8042_kernel = sysinfo_value("kbd.address.kernel");
- 
 
 118 
    if (pio_enable((void *) i8042_physical, sizeof(i8042_t), &vaddr) != 0)
- 
 
 119 
        return -1;
- 
 
 120 
    i8042 = vaddr;
109 
 
 121 
 
110 
    async_set_interrupt_received(i8042_irq_handler);
 122 
    async_set_interrupt_received(i8042_irq_handler);
111 
    iospace_enable(task_get_id(), (void *) i8042_DATA, 5);
 - 
 
112 
 
 123 
 
113 
    /* Disable kbd, enable mouse */
 124 
    /* Disable kbd, enable mouse */
114 
    i8042_command_write(i8042_CMD_KBD);
 125 
    pio_write_8(&i8042->status, i8042_CMD_KBD);
115 
    wait_ready();
 126 
    wait_ready();
116 
    i8042_command_write(i8042_CMD_KBD);
 127 
    pio_write_8(&i8042->status, i8042_CMD_KBD);
117 
    wait_ready();
 128 
    wait_ready();
118 
    i8042_data_write(i8042_KBD_DISABLE);
 129 
    pio_write_8(&i8042->data, i8042_KBD_DISABLE);
119 
    wait_ready();
 130 
    wait_ready();
120 
 
 131 
 
121 
    /* Flush all current IO */
 132 
    /* Flush all current IO */
122 
    while (i8042_status_read() & i8042_OUTPUT_FULL)
 133 
    while (pio_read_8(&i8042->status) & i8042_OUTPUT_FULL)
123 
        i8042_data_read();
 - 
 
124 
   
 - 
 
125 
    /* Initialize mouse */
 - 
 
126 
/*  i8042_command_write(i8042_CMD_MOUSE);
 134 
        (void) pio_read_8(&i8042->data);
127 
    wait_ready();
 - 
 
128 
    i8042_data_write(MOUSE_OUT_INIT);
 - 
 
129 
    wait_ready();
 - 
 
130 
   
 135 
   
131 
    int mouseanswer = 0;
 - 
 
132 
    for (i=0;i < 1000; i++) {
 - 
 
133 
        int status = i8042_status_read();
 - 
 
134 
        if (status & i8042_OUTPUT_FULL) {
 - 
 
135 
            int data = i8042_data_read();
 - 
 
136 
            if (status & i8042_MOUSE_DATA) {
 - 
 
137 
                mouseanswer = data;
 - 
 
138 
                break;
 - 
 
139 
            }
 - 
 
140 
        }
 - 
 
141 
        usleep(1000);
 - 
 
142 
    }*/
 - 
 
143 
//  if (mouseanswer == MOUSE_ACK) {
 - 
 
144 
//      /* enable mouse */
 - 
 
145 
//      mouseenabled = 1;
 - 
 
146 
//     
- 
 
147 
//      ipc_register_irq(sysinfo_value("mouse.inr"), sysinfo_value("mouse.devno"), 0, &i8042_kbd);
 - 
 
148 
//  }
 - 
 
149 
 
 - 
 
150 
    /* Enable kbd */
 136 
    /* Enable kbd */
- 
 
 137 
    i8042_kbd.cmds[0].addr = &((i8042_t *) i8042_kernel)->status;
- 
 
 138 
    i8042_kbd.cmds[3].addr = &((i8042_t *) i8042_kernel)->data;
151 
    ipc_register_irq(sysinfo_value("kbd.inr"), sysinfo_value("kbd.devno"), 0, &i8042_kbd);
 139 
    ipc_register_irq(sysinfo_value("kbd.inr"), sysinfo_value("kbd.devno"), 0, &i8042_kbd);
152 
 
 140 
 
153 
    int newcontrol = i8042_KBD_IE | i8042_KBD_TRANSLATE;
 141 
    int newcontrol = i8042_KBD_IE | i8042_KBD_TRANSLATE;
154 
    if (mouseenabled)
 142 
    if (mouseenabled)
155 
        newcontrol |= i8042_MOUSE_IE;
 143 
        newcontrol |= i8042_MOUSE_IE;
156 
   
 144 
   
157 
    i8042_command_write(i8042_CMD_KBD);
 145 
    pio_write_8(&i8042->status, i8042_CMD_KBD);
158 
    wait_ready();
 146 
    wait_ready();
159 
    i8042_data_write(newcontrol);
 147 
    pio_write_8(&i8042->data, newcontrol);
160 
    wait_ready();
 148 
    wait_ready();
161 
   
 149 
   
162 
    return 0;
 150 
    return 0;
163 
}
 151 
}
164 
 
 152 
 
165 
static void i8042_irq_handler(ipc_callid_t iid, ipc_call_t *call)
 153 
static void i8042_irq_handler(ipc_callid_t iid, ipc_call_t *call)
166 
{
 154 
{
167 
    int status = IPC_GET_ARG1(*call);
 155 
    int status = IPC_GET_ARG1(*call);
168 
 
 156 
 
169 
    if ((status & i8042_MOUSE_DATA))
 157 
    if ((status & i8042_MOUSE_DATA))
170 
        return 0;
 158 
        return;
171 
 
 159 
 
172 
    int scan_code = IPC_GET_ARG2(*call);
 160 
    int scan_code = IPC_GET_ARG2(*call);
173 
 
 161 
 
174 
    kbd_push_scancode(scan_code);
 162 
    kbd_push_scancode(scan_code);
175 
    return 1;
 163 
    return;
176 
}
 164 
}
177 
 
 165 
 
178 
/**
 166 
/**
179 
 * @}
 167 
 * @}
180 
 */
 168 
 */