From bf63dda4802e003f3fd1e4f7a18c0b79a6000712 Mon Sep 17 00:00:00 2001
From: Ivan Poddubny <ivan.poddubny@gmail.com>
Date: Sun, 6 Aug 2006 17:05:38 +0000
Subject: [PATCH] Correct PS/2 mouse detection procedure.

git-svn-id: svn://kolibrios.org@116 a494cfbc-eb01-0410-851d-a64ba20cac60
---
 kernel/trunk/detect/ps2mouse.inc | 183 ++++++++++++++++++++-----------
 1 file changed, 121 insertions(+), 62 deletions(-)

diff --git a/kernel/trunk/detect/ps2mouse.inc b/kernel/trunk/detect/ps2mouse.inc
index 800e8f7337..4d99141265 100644
--- a/kernel/trunk/detect/ps2mouse.inc
+++ b/kernel/trunk/detect/ps2mouse.inc
@@ -1,69 +1,128 @@
+; for information on PS2 mouse/keyboard programming
+; refer to http://www.computer-engineering.org/ps2mouse/
+; and http://www.computer-engineering.org/ps2keyboard/
+; respectively
+
 MouseSearch_PS2:
+        jmp .begin
 
-     pusha
-     	mov	bl, 0xAD
-     	call	kb_cmd
-     
-     mov     bl,0xa8                 ; enable mouse cmd
-     call    kb_cmd
-     cmp     ah,1
-     je      @@DataInputError
+.kb_cmd_c:
+        call    kb_cmd
+.check:
+        cmp     ah, 1
+        je      @f
+        ret
+@@:
+        add     esp, 4  ; return address
+        jmp     .DataInputError
 
-     mov     bl,0xd4                 ; for mouse
-     call    kb_cmd
-     cmp     ah,1
-     je      @@DataInputError 
-     mov     al,0xeb                 ; 
-     call    kb_write
-     cmp     ah,1
-     je      @@DataInputError
-     call    kb_read                 ; Acknowledge
-     call    kb_read
-     mov     [ps2_mouse_detected],0
-     test    al,18h
-     jz      @f
-     mov     [ps2_mouse_detected],1
-  @@:   
-     call    kb_read                 ; 
-     call    kb_read                 ; 
+.kb_write_c:
+        call    kb_write
+        jmp     .check
 
-     mov     bl,0x20                 ; get command byte
-     call    kb_cmd
-     cmp     ah,1
-     je      @@DataInputError
-     call    kb_read
-     cmp     ah,1
-     je      @@DataInputError
-     or      al,3                    ; enable interrupt
-     mov     bl,0x60                 ; write command
-     push    eax
-     call    kb_cmd
-     pop     eax
-     call    kb_write
-     cmp     ah,1
-     je      @@DataInputError
+.kb_read_c:
+        call    kb_read
+        jmp     .check
 
-     mov     bl,0xd4                 ; for mouse
-     call    kb_cmd
-     cmp     ah,1
-     je      @@DataInputError
-     mov     al,0xf4                 ; enable mouse device
-     call    kb_write
-     cmp     ah,1
-     je      @@DataInputError
-     call    kb_read           ; read status return
-     cmp     ah,1
-     je      @@DataInputError
-     cmp     AL,0FAh          
-     jnz     @@DataInputError ;нет подтверждения
+;--------------------------------------------
+.begin:
+        pushad
 
-@@DataInputError:
-     cmp     [ps2_mouse_detected],0
-     je      @f
-     mov     esi,boot_setmouse_type
-     call    boot_log
-  @@:
-  	mov	bl, 0xAE
-  	call	kb_cmd
-     popa
+        mov     bl, 0xAD        ; disable keyboard interface
+        call    .kb_cmd_c
 
+        mov     bl, 0xa8        ; enable mouse interface
+        call    .kb_cmd_c
+
+        mov     bl, 0xd4        ; to mouse
+        call    .kb_cmd_c
+        mov     al, 0xFF        ; reset
+        call    .kb_write_c
+        call    .kb_read_c
+        cmp     al, 0xFA        ; ack
+        jne     .no_ack
+
+        ; now the mouse is in Reset Mode
+        ; get the Basic Assurance Test completion code
+        call    .kb_read_c
+        cmp     al, 0xAA
+        jne     .dead_mouse
+        ; get device ID
+        call    .kb_read_c
+        cmp     al, 0x00
+        jne     .unknown_device
+
+        ; reset completed successfully
+
+        ; enable mouse interrupt - IRQ12
+        mov     bl, 0x20        ; read command byte
+        call    .kb_cmd_c
+        call    .kb_read_c
+        or      al, 10b         ; set mouse IRQ bit
+        push    eax
+        mov     bl, 0x60        ; write command byte
+        call    .kb_cmd_c
+        pop     eax
+        call    .kb_write_c
+
+        mov     bl, 0xd4        ; to mouse
+        call    .kb_cmd_c
+        mov     al, 0xf4        ; enable data reporting
+        call    .kb_write_c
+        call    .kb_read_c
+        cmp     al, 0xFA
+        jne     .no_ack
+
+;       jmp     @f
+;.set_sample_rate:
+;       push    eax
+;       mov     bl, 0xd4        ; to mouse
+;       call    .kb_cmd_c
+;       mov     al, 0xF3        ; set sample rate
+;       call    .kb_write_c
+;       call    .kb_read_c      ; ack
+;       pop     eax
+;       call    .kb_write_c
+;       call    .kb_read_c      ; ack
+; @@:
+;       mov     eax, 200
+;       call    .set_sample_rate
+;       mov     eax, 100
+;       call    .set_sample_rate
+;       mov     eax, 80
+;       call    .set_sample_rate
+;       mov     bl, 0xd4
+;       call    .kb_cmd_c
+;       mov     al, 0xF2        ; read device type
+;       call    .kb_write_c
+;       call    .kb_read_c      ; ack
+;       call    .kb_read_c      ; mouse ID
+;       cmp     al, 0x03
+;       jne     .no_scroll
+;       mov     [ps2_mouse_scroll], 1
+;       ; it'll send 4-byte packets instead of 3-byte ones
+;       ; the last byte of a packet represents z-axis movement
+; .no_scroll:
+
+        mov     [ps2_mouse_detected], 1
+        mov     bl, 0xAE        ; enable keyboard interface
+        call    .kb_cmd_c
+
+        mov     esi, boot_setmouse_type
+        call    boot_log
+
+        jmp     .finish
+
+
+.DataInputError:
+.no_ack:
+.dead_mouse:
+.unknown_device:
+        mov     [ps2_mouse_detected],0
+        mov     bl, 0xA7 ; disable mouse interface
+        call    kb_cmd
+        mov     bl, 0xAE ; enable keyboard interface
+        call    kb_cmd
+
+.finish:
+        popad