180 lines
4.1 KiB
NASM
180 lines
4.1 KiB
NASM
|
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||
|
|
;; ;;
|
||
|
|
;; Copyright (C) KolibriOS team 2004-2015. All rights reserved. ;;
|
||
|
|
;; Distributed under terms of the GNU General Public License ;;
|
||
|
|
;; ;;
|
||
|
|
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
||
|
|
|
||
|
|
;driver sceletone
|
||
|
|
|
||
|
|
format PE DLL native 0.05
|
||
|
|
entry START
|
||
|
|
|
||
|
|
DEBUG = 1
|
||
|
|
__DEBUG__ = 1
|
||
|
|
__DEBUG_LEVEL__ = 1 ; 1 = verbose, 2 = errors only
|
||
|
|
|
||
|
|
|
||
|
|
API_VERSION = 0 ;debug
|
||
|
|
|
||
|
|
STRIDE = 4 ;size of row in devices table
|
||
|
|
|
||
|
|
SRV_GETVERSION = 0
|
||
|
|
|
||
|
|
section '.flat' code readable writable executable
|
||
|
|
|
||
|
|
include 'proc32.inc'
|
||
|
|
include 'struct.inc'
|
||
|
|
include 'macros.inc'
|
||
|
|
include 'peimport.inc'
|
||
|
|
include 'fdo.inc'
|
||
|
|
|
||
|
|
proc START c, state:dword, cmdline:dword
|
||
|
|
|
||
|
|
cmp [state], 1
|
||
|
|
jne .exit
|
||
|
|
.entry:
|
||
|
|
|
||
|
|
push esi
|
||
|
|
DEBUGF 1,"Loading vortex86EX GPIO driver\n"
|
||
|
|
call detect
|
||
|
|
pop esi
|
||
|
|
test eax, eax
|
||
|
|
jz .fail
|
||
|
|
|
||
|
|
; Set crossbar base address register in southbridge
|
||
|
|
invoke PciWrite16, [bus], [dev], 64h, 0x0A00 or 1
|
||
|
|
|
||
|
|
; Set GPIO base address register in southbridge
|
||
|
|
invoke PciWrite16, [bus], [dev], 62h, 0xF100 or 1
|
||
|
|
|
||
|
|
; Enable GPIO0-9
|
||
|
|
mov dx, 0xf100
|
||
|
|
mov eax, 0x000001ff
|
||
|
|
out dx, eax
|
||
|
|
|
||
|
|
mov ecx, 10
|
||
|
|
mov dx, 0xf104
|
||
|
|
mov ax, 0xf200
|
||
|
|
.gpio_init:
|
||
|
|
; Set GPIO data port base address
|
||
|
|
out dx, ax
|
||
|
|
add ax, 2
|
||
|
|
add dx, 2
|
||
|
|
; Set GPIO direction base address
|
||
|
|
out dx, ax
|
||
|
|
add ax, 2
|
||
|
|
add dx, 2
|
||
|
|
; loop
|
||
|
|
dec ecx
|
||
|
|
jnz .gpio_init
|
||
|
|
|
||
|
|
; Set GPIO0 pin 0 as output
|
||
|
|
mov al, 0x01
|
||
|
|
mov dx, 0xf202
|
||
|
|
out dx, al
|
||
|
|
|
||
|
|
; Set GPIO4 pin 0 as output
|
||
|
|
mov al, 0x01
|
||
|
|
mov dx, 0xf212
|
||
|
|
out dx, al
|
||
|
|
|
||
|
|
invoke RegService, my_service, service_proc
|
||
|
|
ret
|
||
|
|
.fail:
|
||
|
|
.exit:
|
||
|
|
xor eax, eax
|
||
|
|
ret
|
||
|
|
endp
|
||
|
|
|
||
|
|
proc service_proc stdcall, ioctl:dword
|
||
|
|
|
||
|
|
mov ebx, [ioctl]
|
||
|
|
mov eax, [ebx+IOCTL.io_code]
|
||
|
|
cmp eax, SRV_GETVERSION
|
||
|
|
jne @F
|
||
|
|
|
||
|
|
mov eax, [ebx+IOCTL.output]
|
||
|
|
cmp [ebx+IOCTL.out_size], 4
|
||
|
|
jne .fail
|
||
|
|
mov dword [eax], API_VERSION
|
||
|
|
xor eax, eax
|
||
|
|
ret
|
||
|
|
@@:
|
||
|
|
cmp eax, 1 ; read GPIO P0
|
||
|
|
jne @f
|
||
|
|
mov dx, 0xf200
|
||
|
|
in al, dx
|
||
|
|
ret
|
||
|
|
@@:
|
||
|
|
cmp eax, 2 ; write GPIO P0
|
||
|
|
jne @f
|
||
|
|
|
||
|
|
mov eax, [ebx + IOCTL.input]
|
||
|
|
mov dx, 0xf200
|
||
|
|
out dx, al
|
||
|
|
xor eax, eax
|
||
|
|
ret
|
||
|
|
@@:
|
||
|
|
.fail:
|
||
|
|
or eax, -1
|
||
|
|
ret
|
||
|
|
endp
|
||
|
|
|
||
|
|
|
||
|
|
proc detect
|
||
|
|
push ebx
|
||
|
|
invoke GetPCIList
|
||
|
|
mov ebx, eax
|
||
|
|
.next_dev:
|
||
|
|
mov eax, [eax+PCIDEV.fd]
|
||
|
|
cmp eax, ebx
|
||
|
|
jz .err
|
||
|
|
mov edx, [eax+PCIDEV.vendor_device_id]
|
||
|
|
|
||
|
|
mov esi, devices
|
||
|
|
@@:
|
||
|
|
cmp dword [esi], 0
|
||
|
|
jz .next_dev
|
||
|
|
cmp edx, [esi]
|
||
|
|
jz .found
|
||
|
|
|
||
|
|
add esi, STRIDE
|
||
|
|
jmp @B
|
||
|
|
|
||
|
|
.found:
|
||
|
|
movzx ebx, [eax+PCIDEV.devfn]
|
||
|
|
mov [dev], ebx
|
||
|
|
movzx ebx, [eax+PCIDEV.bus]
|
||
|
|
mov [bus], ebx
|
||
|
|
xor eax, eax
|
||
|
|
inc eax
|
||
|
|
pop ebx
|
||
|
|
ret
|
||
|
|
.err:
|
||
|
|
DEBUGF 1,"Could not find vortex86EX south bridge!\n"
|
||
|
|
xor eax, eax
|
||
|
|
pop ebx
|
||
|
|
ret
|
||
|
|
endp
|
||
|
|
|
||
|
|
DEVICE_ID = 6011h
|
||
|
|
VENDOR_ID = 17F3h
|
||
|
|
|
||
|
|
;all initialized data place here
|
||
|
|
|
||
|
|
align 4
|
||
|
|
devices dd (DEVICE_ID shl 16)+VENDOR_ID
|
||
|
|
dd 0 ;terminator
|
||
|
|
|
||
|
|
my_service db '86DUINO-GPIO',0 ;max 16 chars include zero
|
||
|
|
|
||
|
|
include_debug_strings ; All data wich FDO uses will be included here
|
||
|
|
|
||
|
|
dev dd ?
|
||
|
|
bus dd ?
|
||
|
|
|
||
|
|
align 4
|
||
|
|
data fixups
|
||
|
|
end data
|