forked from KolibriOS/kolibrios
344 lines
8.0 KiB
NASM
344 lines
8.0 KiB
NASM
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
|
;; ;;
|
|
;; Copyright (C) KolibriOS team 2004-2015. 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 AUX2
|
|
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
|
|
|
|
; Power on the mouse
|
|
add dx, 4
|
|
mov al, 1011b ; set DTR, DTS and AUX2
|
|
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, 10b ;
|
|
shr ah, 5 ; left mouse button
|
|
and ah, 1b ;
|
|
or al, ah
|
|
and [BTN_DOWN], not 11b
|
|
or byte[BTN_DOWN], al
|
|
|
|
; 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:
|
|
cmp [esi + com_mouse_data.offset], 2
|
|
jne .end
|
|
inc [esi + com_mouse_data.offset]
|
|
|
|
and [BTN_DOWN], not 100b
|
|
test al, 00100000b
|
|
jz @f
|
|
or byte[BTN_DOWN], 100b
|
|
@@:
|
|
invoke SetMouseData, [BTN_DOWN], 0, 0, 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 ? |