kolibrios-fun/drivers/mouse/commouse.asm

340 lines
7.9 KiB
NASM
Raw Normal View History

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;; ;;
;; Copyright (C) KolibriOS team 2004-2014. All rights reserved. ;;
;; Distributed under terms of the GNU General Public License ;;
;; ;;
;; Includes source code by Kulakov Vladimir Gennadievich. ;;
;; Modified by Mario79 and Rus. ;;
;; 02.12.2009 <Lrz> ;;
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
format PE DLL native
entry START
CURRENT_API = 0x0200
COMPATIBLE_API = 0x0100
API_VERSION = (COMPATIBLE_API shl 16) + CURRENT_API
__DEBUG__ = 1
__DEBUG_LEVEL__ = 2
section '.flat' readable writable executable
include '../proc32.inc'
include '../struct.inc'
include '../macros.inc'
include '../fdo.inc'
; Serial data packet format:
; D6 D5 D4 D3 D2 D1 D0
; 1st byte 1 LB RB Y7 Y6 X7 X6
; 2nd byte 0 X5 X4 X3 X2 X1 X0
; 3rd byte 0 Y5 Y4 Y3 Y2 Y1 Y0
; optional: (logitech extension protocol)
; 4th byte 0 MB 0 0 0 0 0
struct com_mouse_data
port dw ?
offset db ?
data rb 3
ends
;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;; ;;
;; proc START ;;
;; ;;
;; (standard driver proc) ;;
;;;;;;;;;;;;;;;;;;;;;;;;;;;;
proc START c, reason:dword, cmdline:dword
cmp [reason], DRV_ENTRY
jne .fail
DEBUGF 2,"Loading serial mouse driver\n"
stdcall init_mouse, 0x3f8, 4
stdcall init_mouse, 0x2f8, 3
stdcall init_mouse, 0x3e8, 4
stdcall init_mouse, 0x2e8, 3
invoke RegService, my_service, service_proc
ret
.fail:
xor eax, eax
ret
endp
proc service_proc stdcall, ioctl:dword
mov ebx, [ioctl]
mov eax, [ebx + IOCTL.io_code]
cmp eax, 0 ;SRV_GETVERSION
jne .fail
mov eax, [ebx + IOCTL.output]
cmp [ebx + IOCTL.out_size], 4
jne .fail
mov [eax], dword API_VERSION
xor eax, eax
ret
.fail:
or eax, -1
ret
endp
proc init_mouse stdcall port, irq
DEBUGF 1, "Trying to init serial mouse on port 0x%x\n", [port]
xor ebx, ebx ; reserve port area
mov ecx, [port]
lea edx, [ecx + 7]
push ebp
invoke ReservePortArea
pop ebp
test eax, eax
jnz .fail
DEBUGF 1, "Reserved port area\n"
mov bx, word[port]
; Set the speed to 1200 baud
mov dx, bx
add dx, 3
in al, dx
or al, 80h ; set DLAB bit
out dx, al
mov dx, bx
mov al, 60h ; 1200 baud
out dx, al
inc dx
mov al, 0
out dx, al
; Use 7 bit words, 1 stop bit, no parity control, reset DLAB bit
mov dx, bx
add dx, 3
mov al, 00000010b
out dx, al
; Disable interrupts
mov dx, bx
inc dx
mov al, 0
out dx, al
; Check if a MS type serial mouse is connected
; Disable power and mouse interrupts
mov dx, bx
add dx, 4 ; modem control register
mov al, 0 ; reset DTR, RTS, and OUT2
out dx, al
; Wait 5 ticks (0.2s)
mov esi, 200
invoke Sleep
; Power on the mouse
mov al, 1
out dx, al
; Wait 5 ticks (0.2s)
mov esi, 200
invoke Sleep
; Clear data register
mov dx, bx
in al, dx
; set DTR, DTS and OUT2
add dx, 4
mov al, 1011b
out dx, al
mov ecx, 0x1FFFF
; Poll port
.loop:
dec ecx
jz .fail
; Check if identification byte is available
mov dx, bx
add dx, 5
in al, dx
test al, 1 ; data ready?
jz .loop
; Read data byte
mov dx, bx
in al, dx
cmp al, 'M'
jne .free
DEBUGF 2, "Serial mouse detected on port 0x%x\n", [port]
; Create data struct
invoke Kmalloc, sizeof.com_mouse_data
test eax, eax
jz .fail
DEBUGF 1, "Structure 0x%x allocated\n", eax
mov bx, word[port]
mov [eax + com_mouse_data.port], bx
mov [eax + com_mouse_data.offset], 0
; Attach int handler
invoke AttachIntHandler, [irq], irq_handler, eax
test eax, eax
jz .fail
DEBUGF 1, "Attached int handler\n"
; Enable interrupts
mov dx, word[port]
inc dx
mov al, 1
out dx, al
xor eax, eax
ret
.free:
DEBUGF 1, "Freeing port area\n"
xor ebx, ebx
inc ebx ; free port area
mov ecx, [port]
lea edx, [ecx + 7]
push ebp
invoke ReservePortArea
pop ebp
.fail:
DEBUGF 1, "Failed\n"
or eax, -1
ret
endp
irq_handler:
push esi
mov esi, [esp+2*4]
.read_loop:
mov dx, [esi + com_mouse_data.port]
add dx, 5
in al, dx
test al, 1 ; data ready?
jz .end
; read data
sub dx, 5
in al, dx
and al, 01111111b ; clear MSB (use 7 bit words)
test al, 01000000b ; First byte indicator set?
jnz .FirstByte
; Check which data byte we are reading
cmp [esi + com_mouse_data.offset], 1
jb .SecondByte
je .ThirdByte
ja .FourthByte
; read first data byte
.FirstByte:
mov [esi + com_mouse_data.data+0], al
mov [esi + com_mouse_data.offset], 0
jmp .read_loop
; read second data byte
.SecondByte:
mov [esi + com_mouse_data.data+1], al
inc [esi + com_mouse_data.offset]
jmp .read_loop
; read third data byte
.ThirdByte:
mov [esi + com_mouse_data.data+2], al
inc [esi + com_mouse_data.offset]
; Data packet is complete, parse it and set mouse data
; Left and Right Buttons
mov al, [esi + com_mouse_data.data+0]
mov ah, al
shr al, 3 ; right mouse button
and al, 2 ;
shr ah, 5 ; left mouse button
and ah, 1 ;
add al, ah
movzx eax, al
mov [BTN_DOWN], eax
; X coordinate
mov al, [esi + com_mouse_data.data+0]
shl al, 6
or al, [esi + com_mouse_data.data+1]
movsx eax, al
mov [MOUSE_X], eax
; Y coordinate
mov al, [esi + com_mouse_data.data+0]
and al, 00001100b
shl al, 4
or al, [esi + com_mouse_data.data+2]
movsx eax, al
neg eax
mov [MOUSE_Y], eax
invoke SetMouseData, [BTN_DOWN], [MOUSE_X], [MOUSE_Y], 0, 0
pop esi
mov al, 1
ret
.FourthByte:
inc [esi + com_mouse_data.offset]
test al, 00100000b
jz .end
or [BTN_DOWN], 100b
invoke SetMouseData, [BTN_DOWN], [MOUSE_X], [MOUSE_Y], 0, 0
.end:
pop esi
mov al, 1
ret
; End of code
data fixups
end data
include '../peimport.inc'
my_service db 'commouse',0 ; max 16 chars include zero
include_debug_strings
MOUSE_X dd ?
MOUSE_Y dd ?
BTN_DOWN dd ?