Subversion Repositories Kolibri OS

$Revision: 431 $

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

;;                                                              ;;

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

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

;;                                                              ;;

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

DRV_ENTRY    equ  1

DRV_EXIT     equ -1

DRV_COMPAT   equ  4  ;minimal required drivers version

DRV_CURRENT  equ  4  ;current drivers model version

DRV_VERSION equ (DRV_COMPAT shl 16) or DRV_CURRENT

align 4

proc attach_int_handler stdcall, irq:dword, handler:dword

	 mov ebx, [irq]        ;irq num

	 test ebx, ebx

	 jz .err

	 mov eax, [handler]

	 test eax, eax

	 jz .err

	 mov [irq_tab+ebx*4], eax

         stdcall enable_irq, [irq]

	 ret

.err:

	 xor eax, eax

	 ret

endp

align 4

proc  detach_int_handler

	   ret

endp

align 4

proc enable_irq stdcall, irq_line:dword

           mov ebx, [irq_line]

           mov edx, 0x21

           cmp ebx, 8

           jb @F

           mov edx, 0xA1

           sub ebx,8

@@:

           in al,dx

           btr eax, ebx

           out dx, al

           ret

endp

align 16

;; proc irq_serv

irq_serv:

.irq_1:

	   push eax

	   mov eax, 1

	   jmp .main

align 4

.irq_2:

	   push eax

	   mov eax, 2

	   jmp .main

align 4

.irq_3:

	   push eax

	   mov eax, 3

	   jmp .main

align 4

.irq_4:

	   push eax

	   mov eax, 4

	   jmp .main

align 4

.irq_5:

	   push eax

	   mov eax, 5

	   jmp .main

align 4

.irq_6:

	   push eax

	   mov eax, 6

	   jmp .main

align 4

.irq_7:

	   push eax

	   mov eax, 7

	   jmp .main

align 4

.irq_8:

	   push eax

	   mov eax, 8

	   jmp .main

align 4

.irq_9:

	   push eax

	   mov eax, 9

	   jmp .main

align 4

.irq_10:

	   push eax

	   mov eax, 10

	   jmp .main

align 4

.irq_11:

	   push eax

	   mov eax, 11

	   jmp .main

align 4

.irq_12:

	   push eax

	   mov eax, 12

	   jmp .main

align 4

.irq_13:

	   push eax

	   mov eax, 13

	   jmp .main

align 4

.irq_14:

	   push eax

	   mov eax, 14

	   jmp .main

align 4

.irq_15:

	   push eax

	   mov eax, 15

	   jmp .main

align 16

.main:

	   save_ring3_context

	   mov	 bx, os_data

	   mov	 ds, bx

	   mov	 es, bx

	   mov ebx, [irq_tab+eax*4]

	   test ebx, ebx

	   jz .exit

           call ebx

.exit:

	   restore_ring3_context

           cmp eax, 8

	   mov al, 0x20

           jb @f

	   out 0xa0, al

@@:

           out 0x20, al

           pop eax

	   iret

align 4

proc get_notify stdcall, p_ev:dword

.wait:

           mov ebx,[CURRENT_TASK]

           shl ebx,8

           test dword [ebx+SLOT_BASE+0xA8],EVENT_NOTIFY

	   jz @f

           and dword [ebx+SLOT_BASE+0xA8], not EVENT_NOTIFY

	   mov edi, [p_ev]

	   mov dword [edi], EV_INTR

           mov eax, [ebx+SLOT_BASE+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

	   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

	   ret

endp

align 4

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

	   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

	   ret

endp

align 4

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

	   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

	   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], SRV_SIZE

	   jne .fail

           stdcall [edi+SRV.srv_proc], 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

;  ebx= io_control

;

; retval

;  eax= error code

align 4

srv_handlerEx:

           test ebx, ebx

           jz .fail

           add ebx, new_app_base

           mov eax, [ebx+handle]

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

	   jne .fail

           cmp [eax+SRV.size], SRV_SIZE

	   jne .fail