Subversion Repositories Kolibri OS

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;

;;                                                              ;;

;; Copyright (C) KolibriOS team 2004-2016. All rights reserved. ;;

;;  Distributed under terms of the GNU General Public License.  ;;

;;                                                              ;;

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;

$Revision: 7136 $

DRV_COMPAT   =  5  ;minimal required drivers version

DRV_CURRENT  =  6  ;current drivers model version

DRV_VERSION = (DRV_COMPAT shl 16) or DRV_CURRENT

PID_KERNEL  = 1    ;os_idle thread

align 4

proc get_notify stdcall, p_ev:dword

.wait:

        mov     ebx, [current_slot]

        test    dword [ebx+APPDATA.event_mask], EVENT_NOTIFY

        jz      @f

        and     dword [ebx+APPDATA.event_mask], not EVENT_NOTIFY

        mov     edi, [p_ev]

        mov     dword [edi], EV_INTR

        mov     eax, [ebx+APPDATA.event]

        mov     dword [edi+4], eax

        ret

@@:

        call    change_task

        jmp     .wait

endp

align 4

proc pci_read32 stdcall, bus:dword, devfn:dword, reg:dword

        push    ebx

        xor     eax, eax

        xor     ebx, ebx

        mov     ah, byte [bus]

        mov     al, 6

        mov     bh, byte [devfn]

        mov     bl, byte [reg]

        call    pci_read_reg

        pop     ebx

        ret

endp

align 4

proc pci_read16 stdcall, bus:dword, devfn:dword, reg:dword

        push    ebx

        xor     eax, eax

        xor     ebx, ebx

        mov     ah, byte [bus]

        mov     al, 5

        mov     bh, byte [devfn]

        mov     bl, byte [reg]

        call    pci_read_reg

        pop     ebx

        ret

endp

align 4

proc pci_read8 stdcall, bus:dword, devfn:dword, reg:dword

        push    ebx

        xor     eax, eax

        xor     ebx, ebx

        mov     ah, byte [bus]

        mov     al, 4

        mov     bh, byte [devfn]

        mov     bl, byte [reg]

        call    pci_read_reg

        pop     ebx

        ret

endp

align 4

proc pci_write8 stdcall, bus:dword, devfn:dword, reg:dword, val:dword

        push    ebx

        xor     eax, eax

        xor     ebx, ebx

        mov     ah, byte [bus]

        mov     al, 8

        mov     bh, byte [devfn]

        mov     bl, byte [reg]

        mov     ecx, [val]

        call    pci_write_reg

        pop     ebx

        ret

endp

align 4

proc pci_write16 stdcall, bus:dword, devfn:dword, reg:dword, val:dword

        push    ebx

        xor     eax, eax

        xor     ebx, ebx

        mov     ah, byte [bus]

        mov     al, 9

        mov     bh, byte [devfn]

        mov     bl, byte [reg]

        mov     ecx, [val]

        call    pci_write_reg

        pop     ebx

        ret

endp

align 4

proc pci_write32 stdcall, bus:dword, devfn:dword, reg:dword, val:dword

        push    ebx

        xor     eax, eax

        xor     ebx, ebx

        mov     ah, byte [bus]

        mov     al, 10

        mov     bh, byte [devfn]

        mov     bl, byte [reg]

        mov     ecx, [val]

        call    pci_write_reg

        pop     ebx

        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 srv_handler stdcall, ioctl:dword

        mov     esi, [ioctl]

        test    esi, esi

        jz      .err

        mov     edi, [esi+handle]

        cmp     [edi+SRV.magic], ' SRV'

        jne     .fail

        cmp     [edi+SRV.size], sizeof.SRV

        jne     .fail

;        stdcall [edi+SRV.srv_proc], esi

        mov     eax, [edi+SRV.srv_proc]

        test    eax, eax

        jz      .fail

        stdcall eax, esi

        ret

.fail:

        xor     eax, eax

        not     eax

        mov     [esi+output], eax

        mov     [esi+out_size], 4

        ret

.err:

        xor     eax, eax

        not     eax

        ret

endp

; param

;  ecx= io_control

;

; retval

;  eax= error code

align 4

srv_handlerEx:

        cmp     ecx, OS_BASE

        jae     .fail

        mov     eax, [ecx+handle]

        cmp     [eax+SRV.magic], ' SRV'

        jne     .fail

        cmp     [eax+SRV.size], sizeof.SRV

        jne     .fail

;        stdcall [eax+SRV.srv_proc], ecx

        mov     eax, [eax+SRV.srv_proc]

        test    eax, eax

        jz      .fail

        stdcall eax, ecx

        ret

.fail:

        or      eax, -1

        ret

restore  handle

restore  io_code

restore  input

restore  inp_size

restore  output

restore  out_size

align 4

proc get_service stdcall, sz_name:dword

        mov     eax, [sz_name]

        test    eax, eax

        jnz     @F

        ret

@@:

        mov     edx, [srv.fd]

@@:

        cmp     edx, srv.fd-SRV.fd

        je      .not_load

        stdcall strncmp, edx, [sz_name], 16

        test    eax, eax

        mov     eax, edx

        je      .nothing

        mov     edx, [edx+SRV.fd]

        jmp     @B

.not_load:

        mov     eax, [sz_name]

        push    edi

        sub     esp, 36

        mov     edi, esp

        mov     dword [edi], '/sys'

        mov     dword [edi+4], '/dri'

        mov     dword [edi+8], 'vers'

        mov     byte [edi+12], '/'

@@:

        mov     dl, [eax]

        mov     [edi+13], dl

        inc     eax

        inc     edi

        test    dl, dl

        jnz     @b

        mov     dword [edi+12], '.sys'

        mov     byte [edi+16], 0

        mov     edi, esp

        stdcall load_pe_driver, edi, 0

        add     esp, 36

        pop     edi

.nothing:

        ret

endp

reg_service:

        xor     eax, eax

        mov     ecx, [esp+8]

        jecxz   .nothing

        push    sizeof.SRV

        push    ecx

        pushd   [esp+12]

        call    reg_service_ex

.nothing:

        ret     8

reg_usb_driver:

        push    sizeof.USBSRV

        pushd   [esp+12]

        pushd   [esp+12]

        call    r