forked from KolibriOS/kolibrios
AGP driver stub
git-svn-id: svn://kolibrios.org@2899 a494cfbc-eb01-0410-851d-a64ba20cac60
This commit is contained in:
hidnplayr
parent
d96e9cc8af
commit
954d3f5012
239
kernel/trunk/drivers/agp.asm
Normal file
239
kernel/trunk/drivers/agp.asm
Normal file
@ -0,0 +1,239 @@
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
;; ;;
|
||||
;; Copyright (C) KolibriOS team 2004-2012. All rights reserved. ;;
|
||||
;; Distributed under terms of the GNU General Public License ;;
|
||||
;; ;;
|
||||
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||||
|
||||
|
||||
format MS COFF
|
||||
|
||||
DEBUG equ 1
|
||||
API_VERSION equ 1
|
||||
|
||||
include 'proc32.inc'
|
||||
include 'imports.inc'
|
||||
|
||||
struc IOCTL
|
||||
{ .handle dd ?
|
||||
.io_code dd ?
|
||||
.input dd ?
|
||||
.inp_size dd ?
|
||||
.output dd ?
|
||||
.out_size dd ?
|
||||
}
|
||||
|
||||
virtual at 0
|
||||
IOCTL IOCTL
|
||||
end virtual
|
||||
|
||||
public START
|
||||
public service_proc
|
||||
public version
|
||||
|
||||
DRV_ENTRY equ 1
|
||||
DRV_EXIT equ -1
|
||||
|
||||
SRV_GETVERSION equ 0
|
||||
SRV_DETECT equ 1
|
||||
|
||||
section '.flat' code readable align 16
|
||||
|
||||
proc START stdcall, state:dword
|
||||
|
||||
cmp [state], 1
|
||||
jne .exit
|
||||
.entry:
|
||||
|
||||
if DEBUG
|
||||
mov esi, msgInit
|
||||
call SysMsgBoardStr
|
||||
end if
|
||||
|
||||
stdcall RegService, my_service, service_proc
|
||||
ret
|
||||
.fail:
|
||||
.exit:
|
||||
xor eax, eax
|
||||
ret
|
||||
endp
|
||||
|
||||
handle equ IOCTL.handle
|
||||
io_code equ IOCTL.io_code
|
||||
input equ IOCTL.input
|
||||
inp_size equ IOCTL.inp_size
|
||||
output equ IOCTL.output
|
||||
out_size equ IOCTL.out_size
|
||||
|
||||
align 4
|
||||
proc service_proc stdcall, ioctl:dword
|
||||
|
||||
mov ebx, [ioctl]
|
||||
mov eax, [ebx+io_code]
|
||||
cmp eax, SRV_GETVERSION
|
||||
jne @F
|
||||
|
||||
mov eax, [ebx+output]
|
||||
cmp [ebx+out_size], 4
|
||||
jne .fail
|
||||
mov [eax], dword API_VERSION
|
||||
xor eax, eax
|
||||
ret
|
||||
@@:
|
||||
mov ebx, [ioctl]
|
||||
mov eax, [ebx+io_code]
|
||||
cmp eax, SRV_DETECT
|
||||
jne @F
|
||||
call detect
|
||||
@@:
|
||||
.fail:
|
||||
or eax, -1
|
||||
ret
|
||||
endp
|
||||
|
||||
restore handle
|
||||
restore io_code
|
||||
restore input
|
||||
restore inp_size
|
||||
restore output
|
||||
restore out_size
|
||||
|
||||
align 4
|
||||
proc detect
|
||||
locals
|
||||
last_bus dd ?
|
||||
endl
|
||||
|
||||
xor eax, eax
|
||||
mov [bus], eax
|
||||
inc eax
|
||||
call PciApi ; get last bus
|
||||
cmp eax, -1
|
||||
je .error
|
||||
|
||||
mov [last_bus], eax
|
||||
|
||||
.next_bus:
|
||||
and [devfn], 0
|
||||
.next_dev:
|
||||
stdcall PciRead16, [bus], [devfn], dword 0x08 ; read class/subclass
|
||||
test eax, eax
|
||||
jz .next
|
||||
cmp eax, -1
|
||||
je .next
|
||||
|
||||
cmp ax, 0x0302 ; display controller - 3d controller
|
||||
je .found
|
||||
|
||||
cmp ax, 0x0380 ; display controller - other display controller
|
||||
je .found
|
||||
|
||||
.next:
|
||||
inc [devfn]
|
||||
cmp [devfn], 256
|
||||
jb .next_dev
|
||||
mov eax, [bus]
|
||||
inc eax
|
||||
mov [bus], eax
|
||||
cmp eax, [last_bus]
|
||||
jna .next_bus
|
||||
xor eax, eax
|
||||
ret
|
||||
|
||||
.found:
|
||||
stdcall PciRead8, [bus], [devfn], dword 0x06 ; read prog IF
|
||||
test al, 1 shl 4 ; got capabilities list?
|
||||
jnz .got_capabilities_list
|
||||
|
||||
.got_capabilities_list:
|
||||
stdcall PciRead8, [bus], [devfn], dword 0x34 ; read capabilities offset
|
||||
and eax, 11111100b ; always dword aligned
|
||||
mov esi, eax
|
||||
|
||||
.read_capability:
|
||||
stdcall PciRead32, [bus], [devfn], esi ; read capability
|
||||
cmp al, 0x02 ; AGP
|
||||
je .got_agp
|
||||
movzx esi, ah ; pointer to next capability
|
||||
test esi, esi
|
||||
jnz .read_capability
|
||||
.error:
|
||||
xor eax, eax
|
||||
inc eax
|
||||
ret
|
||||
|
||||
.got_agp:
|
||||
shl eax, 16
|
||||
mov [revision], al ; high nibble = major revision
|
||||
; low nibble = minor revision
|
||||
add esi, 4
|
||||
and al, 0xf0
|
||||
cmp al, 0x30
|
||||
je .agp_3
|
||||
|
||||
.agp_2:
|
||||
stdcall PciRead32, [bus], [devfn], esi ; read AGP status
|
||||
test al, 100b
|
||||
jnz .100b
|
||||
|
||||
test al, 10b
|
||||
jnz .010b
|
||||
|
||||
test al, 1b
|
||||
jz .error
|
||||
|
||||
.001b:
|
||||
mov [speed], 001b
|
||||
jmp .agp_go
|
||||
|
||||
.010b:
|
||||
mov [speed], 010b
|
||||
jmp .agp_go
|
||||
|
||||
.100b:
|
||||
mov [speed], 100b
|
||||
jmp .agp_go
|
||||
|
||||
.agp_3:
|
||||
stdcall PciRead32, [bus], [devfn], esi ; read AGP status
|
||||
test al, 1 shl 3
|
||||
jz .agp_2
|
||||
and al, 11b
|
||||
mov [speed], al
|
||||
cmp al, 11b
|
||||
jne .agp_go
|
||||
mov [speed], 10b
|
||||
|
||||
.agp_go:
|
||||
add esi, 4
|
||||
stdcall PciRead32, [bus], [devfn], esi ; read AGP cmd
|
||||
and al, not 111b ; set max speed
|
||||
or al, [speed]
|
||||
or eax, 1 shl 8 ; enable AGP
|
||||
stdcall PciWrite32, [bus], [devfn], esi, eax ; write AGP cmd
|
||||
|
||||
ret
|
||||
|
||||
endp
|
||||
|
||||
|
||||
;all initialized data place here
|
||||
|
||||
align 4
|
||||
version dd (5 shl 16) or (API_VERSION and 0xFFFF)
|
||||
|
||||
my_service db 'AGP', 0 ; max 16 chars include zero
|
||||
|
||||
msgInit db 'detect hardware...', 13, 10, 0
|
||||
msgPCI db 'PCI acces not supported', 13, 10, 0
|
||||
msgFail db 'device not found', 13, 10, 0
|
||||
|
||||
section '.data' data readable writable align 16
|
||||
|
||||
;all uninitialized data place here
|
||||
|
||||
revision db ?
|
||||
speed db ?
|
||||
bus dd ?
|
||||
devfn dd ?
|
||||
|
||||
Loading…
Reference in New Issue
Block a user