Subversion Repositories Kolibri OS

;

;   This file is part of the Infinity sound AC97 driver.

;   (C) copyright Serge 2006

;   email: infinity_sound@mail.ru

;

;   This program is free software; you can redistribute it and/or modify

;   it under the terms of the GNU General Public License as published by

;   the Free Software Foundation; either version 2 of the License, or

;   (at your option) any later version.

;

;   This program is distributed in the hope that it will be useful,

;   but WITHOUT ANY WARRANTY; without even the implied warranty of

;   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

;   GNU General Public License for more details.

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+PROC_BASE+0xA8],EVENT_NOTIFY

	   jz @f

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

	   mov edi, [p_ev]

	   mov dword [edi], EV_INTR

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

align 4

proc srv_handlerEx stdcall, ioctl:dword

           mov esi, [ioctl]

           test esi, esi

           jz .err

           add esi, new_app_base

           mov edi, [esi+handle]

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

	   jne .fail

           cmp [edi+SRV.size], SRV_SIZE

	   jne .fail

           add [esi+input], new_app_base

           add [esi+output], new_app_base

           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

restore  handle

restore  io_code

restore  input

restore  inp_size

restore  output

restore  out_size

align 4

proc get_service stdcall, sz_name:dword

	   locals

	     srv_ptr  dd ?

	     counter  dd ?

	    endl

	    mov eax, [sz_name]

	    test eax, eax

	    jz .fail

	    mov [srv_ptr], srv_tab

	    mov [counter], 16

@@:

	    stdcall strncmp, [srv_ptr], [sz_name], 16

	    test eax, eax

	    je .ok

	    add [srv_ptr], SRV_SIZE

	    dec [counter]

	    jnz @B

.not_load:

           stdcall find_service, [sz_name]

           test eax, eax

           jz .fail

           stdcall load_lib, eax

           test eax, eax

           jz .fail

            mov [srv_ptr], srv_tab

	    mov [counter], 16

@@:

	    stdcall strncmp, [srv_ptr], [sz_name], 16

	    test eax, eax

	    je .ok

	    add [srv_ptr], SRV_SIZE

	    dec [counter]

	    jnz @B

.fail:

	    xor eax, eax

	    ret

.ok:

	    mov eax, [srv_ptr]

	    ret

endp

align 4

proc find_service stdcall ,sz_name:dword

	   mov eax, [sz_name]

	   test eax, eax

	   jz .fail

           mov esi, services

@@:

           mov eax, [esi]

           test eax, eax

           jz .fail

           push esi

           stdcall strncmp, eax, [sz_name], 16

           pop esi

           test eax, eax

           je .ok

           add esi, 8

           jmp @B

.ok:

           mov eax, [esi+4]

           ret

.fail:

           xor eax, eax

           ret

endp

align 4

proc reg_service stdcall, sz_name:dword, handler:dword

	   locals

	     srv dd ?

	   endl

	   mov eax, [sz_name]

	   test eax, eax

	   jz .fail

	   mov ebx, [handler]

	   test ebx, ebx

	   jz .fail

	   call alloc_service

	   test eax, eax

	   jz .fail

	   mov [srv], eax

	   mov edi, eax

	   mov esi, [sz_name]

	   mov ecx, 16

	   rep movsb

	   mov edi, eax

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

	   mov [edi+SRV.size], SRV_SIZE

	   mov ebx, [handler]

	   mov [edi+SRV.srv_proc], ebx

           mov eax, [srv]

	   ret

.fail:

	   xor eax, eax

	   ret

endp

align 4

proc get_proc stdcall, exp:dword, sz_name:dword

           mov edx, [exp]

.next:

           mov eax, [edx]

           test eax, eax

           jz .end

           push edx

           stdcall strncmp, eax, [sz_name], 16

           pop edx

           test eax, eax

           jz .ok

           add edx,8

           jmp .next

.ok:

           mov eax, [edx+4]

.end:

           ret

endp

align 4

proc link_dll stdcall, exp:dword, imp:dword

           mov esi, [imp]

.next:

           mov eax, [esi]

           test eax, eax

           jz .end

           push esi

           stdcall get_proc, [exp], eax

           pop esi

           test eax, eax

           jz @F

           mov [esi], eax

@@:

           add esi, 4

           jmp .next

.end:

           ret

endp

align 4

proc get_coff_sym stdcall, pSym:dword,count:dword, sz_sym:dword

@@:

	   stdcall strncmp, [pSym], [sz_sym], 8

	   test eax,eax

	   jz .ok

	   add [pSym], 18

	   dec [count]

	   jnz @b

	   xor eax, eax

	   ret

.ok:

	   mov ebx, [pSym]

	   mov eax, [ebx+8]

	   ret

endp

align 4

proc load_lib stdcall, name:dword

	   locals

	     lib   dd ?

	     base  dd ?

	     pSym  dd ?

	   endl

	   mov eax, [name]

	   mov	  ebx, 1		 ;index of first block

           mov    ecx, 32                ;number of blocks

	   mov	  edx, TMP_BUFF 	 ;temp area

	   mov	  esi, 12		 ;file name length

	   call   fileread		;read file from RD

	   cmp	  eax,0

	   jne	  .err

;           mov eax, [TMP_BUFF+CFH.pSymTable]

;           add eax, TMP_BUFF

;           mov [pSym], eax

;           mov [TMP_BUFF+20+CFS.VirtualAddress], eax

	   stdcall kernel_alloc, [TMP_BUFF+20+CFS.SizeOfRawData]

	   mov [base], eax

           test eax, eax

           jnz @f

@@:

	   mov [TMP_BUFF+20+CFS.VirtualAddress], eax

	   mov ebx, [TMP_BUFF+CFH.pSymTable]

	   add ebx, TMP_BUFF

	   mov [pSym], ebx

	   stdcall LinkSection, TMP_BUFF, TMP_BUFF+20, ebx

	   mov edi, [base]

           test edi, edi

           jnz @f

@@:

	   mov esi, [TMP_BUFF+20+CFS.PtrRawData]

	   add esi, TMP_BUFF

	   mov ecx, [TMP_BUFF+20+CFS.SizeOfRawData]

	   rep movsb

	   call alloc_dll

           test eax, eax

           jnz @f

@@:

	   mov [lib], eax

	   mov edi, eax

	   mov esi, [name]

	   mov ecx, 16

	   rep movsb

	   stdcall get_coff_sym,[pSym],[TMP_BUFF+CFH.nSymbols],szSTART

	   mov edi, [lib]

	   add eax, [base]

	   mov [edi+LIB.lib_start], eax

	   mov ebx, [base]

	   mov [edi+LIB.lib_base], ebx

	   stdcall get_coff_sym,[pSym],[TMP_BUFF+CFH.nSymbols], szEXPORTS

	   mov edi, [lib]

	   add eax, [base]

	   mov [edi+LIB.export], eax

	   stdcall get_coff_sym,[pSym],[TMP_BUFF+CFH.nSymbols], szIMPORTS

	   mov edi, [lib]

	   add eax, [base]

	   mov [edi+LIB.import], eax

	   stdcall link_dll, kernel_export, eax

	   mov edi, [lib]

           call [edi+LIB.lib_start]

	   mov eax, [lib]

	   ret

.err:

	   xor eax, eax

	   ret

endp

align 4

proc LinkSection stdcall, pCoff:dword, pSec:dword, pSym:dword

	   locals

	     pCode     dd ?

	   endl

	   mov esi, [pSec]

	   mov eax, [esi+CFS.PtrRawData]

	   add eax, [pCoff]

	   mov [pCode], eax

	   mov edi, [esi+CFS.PtrReloc]

	   add edi, [pCoff]

	   movzx edx, [esi+CFS.NumReloc]

	   mov eax, edx

	   lea edx, [edx+edx*8]

	   add edx, eax

	   add edx, edi

.l_0:

	   cmp edi, edx

	   jae .exit

	   mov ebx, [edi+CRELOC.SymIndex]

	   add ebx,ebx

	   lea ebx,[ebx+ebx*8]

	   add ebx, [pSym]

	   mov ecx, [ebx+CSYM.Value]

	   add ecx, [esi+CFS.VirtualAddress]

	   mov eax, [edi+CRELOC.VirtualAddress]

	   add eax, [pCode]

	   add [eax], ecx

	   add edi, 10

	   jmp .l_0

.exit:

	   ret

endp

proc get_curr_task

           mov eax,[CURRENT_TASK]

           shl eax, 8

           ret

endp

drv_sound      db 'UNISOUNDOBJ', 0

drv_infinity   db 'INFINITYOBJ', 0

szSound        db 'SOUND',0

szInfinity     db 'INFINITY',0

szSTART        db 'START',0

szEXPORTS      db 'EXPORTS',0

szIMPORTS      db 'IMPORTS',0

align 16

services:

           dd szSound,    drv_sound

           dd szInfinity, drv_infinity

           dd 0