Correct PS/2 mouse detection procedure.

git-svn-id: svn://kolibrios.org@116 a494cfbc-eb01-0410-851d-a64ba20cac60
This commit is contained in:
Ivan Poddubny 2006-08-06 17:05:38 +00:00
parent 3e2bc5b35f
commit bf63dda480

View File

@ -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: MouseSearch_PS2:
jmp .begin
pusha .kb_cmd_c:
mov bl, 0xAD call kb_cmd
call kb_cmd .check:
cmp ah, 1
mov bl,0xa8 ; enable mouse cmd je @f
call kb_cmd ret
cmp ah,1 @@:
je @@DataInputError add esp, 4 ; return address
jmp .DataInputError
mov bl,0xd4 ; for mouse .kb_write_c:
call kb_cmd call kb_write
cmp ah,1 jmp .check
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 ;
mov bl,0x20 ; get command byte .kb_read_c:
call kb_cmd call kb_read
cmp ah,1 jmp .check
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
mov bl,0xd4 ; for mouse ;--------------------------------------------
call kb_cmd .begin:
cmp ah,1 pushad
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 ;íåò ïîäòâåðæäåíèÿ
@@DataInputError: mov bl, 0xAD ; disable keyboard interface
cmp [ps2_mouse_detected],0 call .kb_cmd_c
je @f
mov esi,boot_setmouse_type
call boot_log
@@:
mov bl, 0xAE
call kb_cmd
popa
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