Subversion Repositories Kolibri OS

Compare Revisions

Regard whitespace Rev 5557 → Rev 5558

/drivers/gpio/86duino-gpio.asm
0,0 → 1,179
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;; ;;
;; 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