Subversion Repositories HelenOS

Rev

Rev 3924 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. /*
  2.  * Copyright (c) 2001-2004 Jakub Jermar
  3.  * Copyright (c) 2006 Josef Cejka
  4.  * All rights reserved.
  5.  *
  6.  * Redistribution and use in source and binary forms, with or without
  7.  * modification, are permitted provided that the following conditions
  8.  * are met:
  9.  *
  10.  * - Redistributions of source code must retain the above copyright
  11.  *   notice, this list of conditions and the following disclaimer.
  12.  * - Redistributions in binary form must reproduce the above copyright
  13.  *   notice, this list of conditions and the following disclaimer in the
  14.  *   documentation and/or other materials provided with the distribution.
  15.  * - The name of the author may not be used to endorse or promote products
  16.  *   derived from this software without specific prior written permission.
  17.  *
  18.  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  19.  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  20.  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  21.  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  22.  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  23.  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  24.  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  25.  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  26.  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  27.  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  28.  */
  29.  
  30. /** @addtogroup kbd
  31.  * @{
  32.  */
  33. /** @file
  34.  */
  35.  
  36. #include <ipc/ipc.h>
  37. #include <async.h>
  38. #include <unistd.h>
  39. #include <sysinfo.h>
  40. #include <kbd_port.h>
  41. #include <kbd.h>
  42. #include "i8042.h"
  43.  
  44. /* Interesting bits for status register */
  45. #define i8042_OUTPUT_FULL  0x1
  46. #define i8042_INPUT_FULL   0x2
  47. #define i8042_MOUSE_DATA   0x20
  48.  
  49. /* Command constants */
  50. #define i8042_CMD_KBD 0x60
  51. #define i8042_CMD_MOUSE  0xd4
  52.  
  53. /* Keyboard cmd byte */
  54. #define i8042_KBD_IE        0x1
  55. #define i8042_MOUSE_IE      0x2
  56. #define i8042_KBD_DISABLE   0x10
  57. #define i8042_MOUSE_DISABLE 0x20
  58. #define i8042_KBD_TRANSLATE 0x40
  59.  
  60. /* Mouse constants */
  61. #define MOUSE_OUT_INIT  0xf4
  62. #define MOUSE_ACK       0xfa
  63.  
  64. static irq_cmd_t i8042_cmds[2] = {
  65.     { CMD_PORT_READ_1, (void *) 0x64, 0, 1 },
  66.     { CMD_PORT_READ_1, (void *) 0x60, 0, 2 }
  67. };
  68.  
  69. static irq_code_t i8042_kbd = {
  70.     2,
  71.     i8042_cmds
  72. };
  73.  
  74. static void wait_ready(void) {
  75.     while (i8042_status_read() & i8042_INPUT_FULL)
  76.         ;
  77. }
  78.  
  79. static void i8042_irq_handler(ipc_callid_t iid, ipc_call_t *call);
  80.  
  81. int kbd_port_init(void)
  82. {
  83. //  int i;
  84.     int mouseenabled = 0;
  85.  
  86.     async_set_interrupt_received(i8042_irq_handler);
  87.     iospace_enable(task_get_id(), (void *) i8042_DATA, 5);
  88.  
  89.     /* Disable kbd, enable mouse */
  90.     i8042_command_write(i8042_CMD_KBD);
  91.     wait_ready();
  92.     i8042_command_write(i8042_CMD_KBD);
  93.     wait_ready();
  94.     i8042_data_write(i8042_KBD_DISABLE);
  95.     wait_ready();
  96.  
  97.     /* Flush all current IO */
  98.     while (i8042_status_read() & i8042_OUTPUT_FULL)
  99.         i8042_data_read();
  100.    
  101.     /* Initialize mouse */
  102. /*  i8042_command_write(i8042_CMD_MOUSE);
  103.     wait_ready();
  104.     i8042_data_write(MOUSE_OUT_INIT);
  105.     wait_ready();
  106.    
  107.     int mouseanswer = 0;
  108.     for (i=0;i < 1000; i++) {
  109.         int status = i8042_status_read();
  110.         if (status & i8042_OUTPUT_FULL) {
  111.             int data = i8042_data_read();
  112.             if (status & i8042_MOUSE_DATA) {
  113.                 mouseanswer = data;
  114.                 break;
  115.             }
  116.         }
  117.         usleep(1000);
  118.     }*/
  119. //  if (mouseanswer == MOUSE_ACK) {
  120. //      /* enable mouse */
  121. //      mouseenabled = 1;
  122. //     
  123. //      ipc_register_irq(sysinfo_value("mouse.inr"), sysinfo_value("mouse.devno"), 0, &i8042_kbd);
  124. //  }
  125.  
  126.     /* Enable kbd */
  127.     ipc_register_irq(sysinfo_value("kbd.inr"), sysinfo_value("kbd.devno"), 0, &i8042_kbd);
  128.  
  129.     int newcontrol = i8042_KBD_IE | i8042_KBD_TRANSLATE;
  130.     if (mouseenabled)
  131.         newcontrol |= i8042_MOUSE_IE;
  132.    
  133.     i8042_command_write(i8042_CMD_KBD);
  134.     wait_ready();
  135.     i8042_data_write(newcontrol);
  136.     wait_ready();
  137.    
  138.     return 0;
  139. }
  140.  
  141. static void i8042_irq_handler(ipc_callid_t iid, ipc_call_t *call)
  142. {
  143.     int status = IPC_GET_ARG1(*call);
  144.  
  145.     if ((status & i8042_MOUSE_DATA))
  146.         return 0;
  147.  
  148.     int scan_code = IPC_GET_ARG2(*call);
  149.  
  150.     kbd_push_scancode(scan_code);
  151.     return 1;
  152. }
  153.  
  154. /**
  155.  * @}
  156.  */
  157.