kernel/drivers/char/mouse/ps2.c

   1 #include <build.h>
   2
   3 #ifdef ARCH_i386
   4
   5 #include <system.h>
   6 #include <arch/io.h>
   7 #include <string.h>
   8
   9 #define PS2MOUSE_SAMPLES 0x64   // Samples in second - 0x50 for 80, 0x64 for 100, 0xC8 for 200
  10 #define PS2MOUSE_RESOLUTION 2
  11
  12 #define PS2MOUSE_TIMEOUT                500000
  13 #define PS2MOUSE_ACK                    0xFA
  14 #define PS2MOUSE_PORT                   0x60
  15 #define PS2MOUSE_CTRL                   0x64
  16 #define PS2MOUSE_COMMAND                0xD4
  17 #define PS2MOUSE_COMMAND_RESET          0xFF
  18 #define PS2MOUSE COMMAND_GET_MOUSE_ID   0xF2
  19 #define PS2MOUSE_COMMAND_ENABLE_PACKETS 0xF4
  20 #define PS2MOUSE_COMMAND_SET_SAMPLES    0xF3
  21 #define PS2MOUSE_COMMAND_SET_RESOLUTION 0xE8
  22 #define PS2MOUSE_RESET_ACK              0xAA
  23 #define PS2MOUSE_IRQ                    12
  24
  25 static int cursor_x;
  26 static int cursor_y;
  27 static int cursor_state;
  28
  29 bool ps2mouse_reset ();
  30 bool ps2mouse_command_write (unsigned char command);
  31 bool ps2mouse_write (unsigned char command);
  32 unsigned char ps2mouse_read ();
  33
  34 /* ps2mouse_reset - reset mouse */
  35
  36 bool ps2mouse_reset()
  37 {
  38         int timeout;
  39
  40         for (timeout = 0; timeout < PS2MOUSE_TIMEOUT; timeout ++)
  41         {
  42                 if((inb (PS2MOUSE_CTRL) && 0x02) == 0x02)
  43                         break;
  44                 schedule ();
  45         }
  46
  47         outb (PS2MOUSE_CTRL, PS2MOUSE_COMMAND);
  48         outb (PS2MOUSE_PORT, PS2MOUSE_COMMAND_RESET);
  49
  50         for (timeout = 0; timeout < PS2MOUSE_TIMEOUT; timeout ++)
  51         {
  52                 int read = ps2mouse_read ();
  53                 if (read == PS2MOUSE_RESET_ACK)
  54                         return 1;
  55
  56                 if (read == -1)
  57                         return 0;
  58
  59                 schedule ();
  60         }
  61
  62         return -1;
  63 }
  64
  65 /* ps2mouse_command_write - send a command to mouse */
  66
  67 bool ps2mouse_command_write(unsigned char command)
  68 {
  69         int timeout;
  70
  71         for (timeout = 0; timeout < PS2MOUSE_TIMEOUT; timeout ++)
  72         {
  73                 if((inb (PS2MOUSE_CTRL) && 0x02) == 0x02)
  74                         break;
  75                 schedule ();
  76         }
  77
  78         outb (PS2MOUSE_CTRL, PS2MOUSE_COMMAND);
  79         outb (PS2MOUSE_PORT, command);
  80
  81         for (timeout = 0; timeout < PS2MOUSE_TIMEOUT; timeout ++)
  82         {
  83                 int read = ps2mouse_read ();
  84                 if (read == PS2MOUSE_ACK)
  85                         return 1;
  86
  87                 if (read == -1)
  88                         return 0;
  89
  90                 schedule ();
  91         }
  92
  93         return -1;
  94 }
  95
  96 /* ps2mouse_write - send a command to mouse */
  97
  98 bool ps2mouse_write(unsigned char command)
  99 {
 100         int timeout;
 101
 102         for (timeout = 0; timeout < PS2MOUSE_TIMEOUT; timeout ++)
 103         {
 104                 if((inb (PS2MOUSE_CTRL) && 0x02) == 0x02)
 105                         break;
 106                 schedule ();
 107         }
 108
 109         outb (PS2MOUSE_PORT, command);
 110
 111         for (timeout = 0; timeout < PS2MOUSE_TIMEOUT; timeout ++)
 112         {
 113                 int read = ps2mouse_read ();
 114                 if (read == PS2MOUSE_ACK)
 115                         return 1;
 116
 117                 if (read == -1)
 118                         return 0;
 119
 120                 schedule ();
 121         }
 122
 123         return -1;
 124 }
 125
 126 /* ps2mouse_read - read a value from mouse */
 127
 128 unsigned char ps2mouse_read()
 129 {
 130         int timeout;
 131
 132         for (timeout = 0; timeout < PS2MOUSE_TIMEOUT; timeout ++)
 133         {
 134                 if ((inb (PS2MOUSE_CTRL) && 0x01) != 0x01)
 135                         return inb (PS2MOUSE_PORT);
 136                 schedule ();
 137         }
 138
 139         return -1;
 140 }
 141
 142 void ps2mouse_handler (struct regs *r)
 143 {
 144         kprintf("handler ()\n");
 145
 146 /*      while (inb(0x64) == 0x02)       // Wait until on port 0x64 isn´t 02h
 147                 schedule();
 148
 149         outb(0x64,0xD4);
 150         outb(0x60,0xEB);
 151
 152         while (inb(0x64) == 0x01)       // Wait until on port 0x64 isn´t 01h
 153                 schedule ();
 154
 155         char b1 = inb (0x60);
 156
 157         while (inb(0x64) == 0x01)       // Wait until on port 0x64 isn´t 01h
 158                 schedule ();
 159
 160         char b2 = inb (0x60);
 161
 162         while (inb(0x64) == 0x01)       // Wait until on port 0x64 isn´t 01h
 163                 schedule();
 164
 165         char b3 = inb(0x60);
 166
 167         if ((b1 & (1 << 6)) == 0)
 168                 return;
 169
 170         cursor_x += (int) (char) ((b1 << 6) | (b2 & 0x3f));
 171         cursor_y += (int) (char) (((b1 << 4) & 0xc0) | (b3 & 0x3f));
 172
 173         if (cursor_y < 0)
 174                 cursor_y = 0;
 175
 176         if (cursor_y > 199)
 177                 cursor_y = 199;
 178
 179         if (cursor_x < 0)
 180                 cursor_x = 0;
 181
 182         if (cursor_x > 319)
 183                 cursor_x = 319;
 184
 185         cursor_state = (b1 >> 4) & 3;*/
 186 }
 187
 188 unsigned ps2mouse_init ()
 189 {
 190         unsigned char status_byte = 0xD8;
 191         unsigned char mouse_id;
 192
 193         if(ps2mouse_reset () == -1)
 194                 return -1;
 195
 196         mouse_id = ps2mouse_read ();
 197
 198         ps2mouse_command_write (PS2MOUSE_COMMAND_SET_SAMPLES);
 199         ps2mouse_write (PS2MOUSE_SAMPLES);
 200
 201         ps2mouse_command_write (PS2MOUSE_COMMAND_SET_RESOLUTION);
 202         ps2mouse_write (PS2MOUSE_RESOLUTION);
 203
 204         kprintf ("ps2mouse -> ID: %d \n", mouse_id);
 205
 206         /* irq installing */
 207
 208         irq_install_handler(PS2MOUSE_IRQ, ps2mouse_handler);
 209
 210         timer_wait(1000);
 211
 212         return 1;
 213 }
 214
 215 void ps2mouse_get_status (int *x, int *y, int *state)
 216 {
 217         *x = cursor_x;
 218         *y = cursor_y;
 219         *state = cursor_state;
 220 }
 221
 222 bool ps2mouse_acthandler (unsigned act, char *block, unsigned block_len)
 223 {
 224         switch (act) {
 225                 case DEV_ACT_INIT:
 226                 {
 227                         return ps2mouse_init ();
 228                 }
 229                 break;
 230                 case DEV_ACT_READ:
 231                 {
 232                         return 0;
 233                 }
 234                 break;
 235                 case DEV_ACT_WRITE:
 236                 {
 237                         return 0;
 238                 }
 239                 break;
 240         }
 241
 242         return 0;
 243 }
 244
 245 #endif