OSDev.org

Code: Select all

void MouseIRQ() 
{ 
   //LocalData.status = GetByte(); 
   //LocalData.xcoord = GetByte(); 
   //LocalData.ycoord = GetByte(); 
	printdev("\nMouse irq");
 //  readable = 1; 
} 

int KBD_wait_write() { 
    unsigned int timeout = 100000; 
    unsigned char c; 
    while(--timeout) { 
        c = inb(0x64); 
        if(!(c & 2)) { 
            return 0; 
        } 
    } 
    return -1; 
} 

int KBD_write(unsigned char byte) { 
    if(!KBD_wait_write()) { 
        outb(0x60, byte); 
        return 0; 
    } 
    else return -1; 
} 

int KBD_write_cmd(unsigned char byte) { 
    if(!KBD_wait_write()) { 
        outb(0x64, byte); 
        return 0; 
    } 
    else return -1; 
} 

int KBD_write_aux(unsigned char byte) { 
    if(KBD_write_cmd(0xD4) || KBD_write(byte)) return -1; 
    else return 0; 
} 

// return unsigned char if success, -1 if fails 
int KBD_read() { 
    unsigned int timeout = 100000; 
    unsigned char c; 
    while(--timeout) { 
        c = inb(0x64); 
        if(c & 1) { 
            c = inb(0x60); 
            return (unsigned) c; 
        } 
    } 
    return -1; 
} 

int KBD_wait_ack() { 
    unsigned int timeout = 100000; 
    while(--timeout) { 
        unsigned char c = KBD_read(); 
        if(c == 0xFA) return 0; // got ack, we're happy 

        if(!c) { 
            // if we get 0, spend some time and retry 
            int i; 
            for(i = 0; i < 1000; i++) outb(0x80,0x80); 
            continue; 
        } else { 
            printdev("console_input: 0x%2x while expecting ACK\n", c); 
            return -1; 
        } 
    } 
    return -1; 
} 


// init the mouse
static int console_mouse_imps2; 
int InitMouse() 
{ 
   if(KBD_write_cmd(0xA9) || KBD_read() != 0x00) { 
        printdev("PS/2 mouse interface test failed.\n"); 
        return -1; 
    }
	// enable PS/2 mouse 
    KBD_write_cmd(0xA8);
	{
	  // fetch command word 
        if(KBD_write_cmd(0x20)) return -1; 
        int cb = KBD_read(); 
        if(cb < 0) return -1; 
        // set bit1 (aux interrupt), 
        // store the resulting new command word 
        if(KBD_write_cmd(0x60)) return -1; 
        if(KBD_write(cb |= 0x2)) return -1; // <-- only need to set aux-int bit <--
	}
	// Send set defaults 
    if(KBD_write_aux(0xF6) || KBD_wait_ack()) return -1; 

    // Enable data reporting 
    if(KBD_write_aux(0xF4) || KBD_wait_ack()) return -1; 
	
	request_irq(12,MouseIRQ);
	enable_irq(12);
	while(1);
}