Subversion Repositories Kolibri OS

;               FEDCBA9876543210

VALID_IRQ   equ 1100111011111000b

ATTCH_IRQ   equ 0000111010101000b

BIT1  EQU 0x00000002

BIT2  EQU 0x00000004

BIT3  EQU 0x00000008

BIT4  EQU 0x00000010

BIT5  EQU 0x00000020

BIT6  EQU 0x00000040

BIT7  EQU 0x00000080

BIT8  EQU 0x00000100

BIT9  EQU 0x00000200

BIT10 EQU 0x00000400

BIT11 EQU 0x00000800

BIT12 EQU 0x00001000

BIT13 EQU 0x00002000

BIT14 EQU 0x00004000

BIT15 EQU 0x00008000

BIT16 EQU 0x00010000

BIT17 EQU 0x00020000

BIT18 EQU 0x00040000

BIT19 EQU 0x00080000

BIT20 EQU 0x00100000

BIT21 EQU 0x00200000

BIT22 EQU 0x00400000

BIT23 EQU 0x00800000

BIT24 EQU 0x00100000

BIT25 EQU 0x02000000

BIT26 EQU 0x04000000

BIT27 EQU 0x08000000

BIT28 EQU 0x10000000

BIT29 EQU 0x20000000

BIT30 EQU 0x40000000

BIT31 EQU 0x80000000

VID_NVIDIA        equ 0x10DE

CTRL_ICH0	  equ 0x2425

CTRL_ICH2	  equ 0x2435

CTRL_ICH3	  equ 0x2445

CTRL_ICH4	  equ 0x24C5

CTRL_ICH5	  equ 0x24D5

CTRL_ICH6	  equ 0x266E

CTRL_ICH7	  equ 0x27DE

CTRL_NFORCE2      equ 0x006A

CTRL_NFORCE3      equ 0x00DA

PCM_OUT_CR_REG	  equ  0x1b	 ; PCM out Control Register

PCM_OUT_LVI_REG   equ  0x15	 ; PCM last valid index

PCM_OUT_SR_REG	  equ  0x16	 ; PCM out Status register

PCM_OUT_PIV_REG   equ  0x1a

PCM_OUT_CIV_REG   equ  0x14	 ; PCM out current index

MC_IN_CR_REG	  equ  0x2b	 ; MIC in Control Register

RR		  equ  BIT1	 ; reset registers.  Nukes all regs

CODEC_AUX_VOL			equ	0x04	;

CODEC_PCM_OUT_REG		equ	18h	; PCM output volume

CODEC_EXT_AUDIO_REG		equ	28h	; extended audio

CODEC_EXT_AUDIO_CTRL_REG	equ	2ah	; extended audio control

CODEC_PCM_FRONT_DACRATE_REG	equ	2ch	; PCM out sample rate

CODEC_PCM_SURND_DACRATE_REG	equ	2eh	; surround sound sample rate

CODEC_PCM_LFE_DACRATE_REG	equ	30h	; LFE sample rate

CTRL_STAT	equ  0x30	 ;   Global Status

CTRL_CAS	equ  0x34	 ;   Codec Access Semiphore

CTRL_CNT_AC_OFF equ  0x00000008  ;   ACLINK Off

CTRL_CNT_WARM	equ  0x00000004  ;   AC97 Warm Reset

CTRL_CNT_COLD	equ  0x00000002  ;   AC97 Cold Reset

CTRL_CNT_GIE	equ  0x00000001  ;   GPI Interrupt Enable

CODEC_REG_ST	      equ 0x26

DEV_STOP	      equ  2

DEV_CALLBACK	      equ  3

DEV_SET_BUFF	      equ  4

DEV_NOTIFY	      equ  5

DEV_SET_MASTERVOL     equ  6

DEV_GET_MASTERVOL     equ  7

DEV_GET_INFO	      equ  8

{ .bus                dd ?

  .devfn              dd ?

  .dev_id             dd ?

  .pci_cmd            dd ?

  .pci_stat           dd ?

  .codec_mem_base     dd ?

  .ctrl_mem_base      dd ?

  .cfg_reg            dd ?

  .int_line           dd ?

  .ctrl_ids           dd ?    ;hub id string

  .notify_task        dd ?

  .ctrl_setup         dd ?

  .user_callback      dd ?

  .codec_read16       dd ?

  .codec_write16      dd ?

  .ctrl_read16        dd ?

  .ctrl_read32        dd ?

  .ctrl_write16       dd ?

  .ctrl_write32       dd ?

}

{

  .chip_id            dd ?

  .flags              dd ?

  .status             dd ?

  .chip_ids           dd ?    ;chip model string

                      dd ?

  .reg_master_vol     dw ?     ;0x02

  .reg_aux_out_vol    dw ?     ;0x04

  .reg_mone_vol       dw ?     ;0x06

  .reg_master_tone    dw ?     ;0x08

  .reg_beep_vol       dw ?     ;0x0A

  .reg_phone_vol      dw ?     ;0x0C

  .reg_mic_vol        dw ?     ;0x0E

  .reg_line_in_vol    dw ?     ;0x10

  .reg_cd_vol         dw ?     ;0x12

  .reg_video_vol      dw ?     ;0x14

  .reg_aux_in_vol     dw ?     ;0x16

  .reg_pcm_out_vol    dw ?     ;0x18

  .reg_rec_select     dw ?     ;0x1A

  .reg_rec_gain       dw ?     ;0x1C

  .reg_rec_gain_mic   dw ?     ;0x1E

  .reg_gen            dw ?     ;0x20

  .reg_3d_ctrl        dw ?     ;0X22

  .reg_page           dw ?     ;0X24

  .reg_powerdown      dw ?     ;0x26

  .reg_ext_audio      dw ?     ;0x28

  .reg_ext_st         dw ?     ;0x2a

  .reg_pcm_front_rate dw ?     ;0x2c

  .reg_pcm_surr_rate  dw ?     ;0x2e

  .reg_lfe_rate       dw ?     ;0x30

  .reg_pcm_in_rate    dw ?     ;0x32

                      dw ?     ;0x34

  .reg_cent_lfe_vol   dw ?     ;0x36

  .reg_surr_vol       dw ?     ;0x38

  .reg_spdif_ctrl     dw ?     ;0x3A

                      dw ?     ;0x3C

                      dw ?     ;0x3E

                      dw ?     ;0x40

                      dw ?     ;0x42

                      dw ?     ;0x44

                      dw ?     ;0x46

                      dw ?     ;0x48

                      dw ?     ;0x4A

                      dw ?     ;0x4C

                      dw ?     ;0x4E

                      dw ?     ;0x50

                      dw ?     ;0x52

                      dw ?     ;0x54

                      dw ?     ;0x56

                      dw ?     ;0x58

                      dw ?     ;0x5A

                      dw ?     ;0x5C

                      dw ?     ;0x5E

  .reg_page_0         dw ?     ;0x60

  .reg_page_1         dw ?     ;0x62

  .reg_page_2         dw ?     ;0x64

  .reg_page_3         dw ?     ;0x66

  .reg_page_4         dw ?     ;0x68

  .reg_page_5         dw ?     ;0x6A

  .reg_page_6         dw ?     ;0x6C

  .reg_page_7         dw ?     ;0x6E

                      dw ?     ;0x70

                      dw ?     ;0x72

                      dw ?     ;0x74

                      dw ?     ;0x76

                      dw ?     ;0x78

                      dw ?     ;0x7A

  .reg_vendor_id_1    dw ?     ;0x7C

  .reg_vendor_id_2    dw ?     ;0x7E

  .set_master_vol     dd ?

}

{   .pci_cmd	    dd	?

    .irq	    dd	?

    .glob_cntrl     dd	?

    .glob_sta	    dd	?

    .codec_io_base  dd	?

    .ctrl_io_base   dd	?

    .codec_mem_base dd	?

    .ctrl_mem_base  dd	?

    .codec_id       dd  ?

}

{  .handle           dd ?

   .io_code          dd ?

   .input            dd ?

   .inp_size         dd ?

   .output           dd ?

   .out_size         dd ?

}

  IOCTL IOCTL

end virtual

new_app_base	      equ 0x60400000;   0x01000000

PROC_BASE	      equ OS_BASE+0x0080000

public STOP

public service_proc

extrn SysMsgBoardStr

extrn PciApi

extrn PciRead32

extrn PciRead8

extrn PciWrite8

extrn AllocKernelSpace

extrn MapPage

extrn RegService

extrn KernelAlloc

extrn GetPgAddr

extrn GetCurrentTask

     if DEBUG

	   mov esi, msgInit

           call SysMsgBoardStr

     end if

	   test eax, eax

           jz .fail

	   mov esi,[ctrl.vendor_ids]

           call SysMsgBoardStr

	   mov	  esi, [ctrl.ctrl_ids]

           call SysMsgBoardStr

           test eax, eax

           jz .fail

           mov esi, msgInitCodec

           call SysMsgBoardStr

     end if

           test eax, eax

           jz .fail

	   mov esi, [codec.ac_vendor_ids]

           call SysMsgBoardStr

           call SysMsgBoardStr

     end if

           call setup_codec

           call SysMsgBoardStr

;           cmp eax, -1

;           jz .fail

;           call remap_irq

;     end if

           mov ebx, [ctrl.int_line]

           mov esi, msgInvIRQ

           bt eax, ebx

           jnc .fail

           mov eax, ATTCH_IRQ

           mov esi, msgAttchIRQ

           bt eax, ebx

           jnc .fail

           stdcall RegService, sz_sound_srv, service_proc

	   ret

.fail:

     if DEBUG

	   mov esi, msgFail

           call SysMsgBoardStr

     end if

	   xor eax, eax

STOP:

           ret

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

proc service_proc stdcall, ioctl:dword

           mov eax, [edi+io_code]

	   cmp eax, DEV_PLAY

	   jne @F

     if DEBUG

	   mov esi, msgPlay

           call SysMsgBoardStr

     end if

	   call play

	   ret

@@:

	   cmp eax, DEV_STOP

	   jne @F

     if DEBUG

	   mov esi, msgStop

           call SysMsgBoardStr

     end if

	   call stop

	   ret

@@:

	   cmp eax, DEV_CALLBACK

	   jne @F

           mov ebx, [edi+input]

           stdcall set_callback, [ebx]

	   ret

@@:

	   cmp eax, DEV_SET_MASTERVOL

	   jne @F

           mov ebx, [edi+input]

           stdcall set_master_vol, [ebx]

	   ret

@@:

	   cmp eax, DEV_GET_MASTERVOL

	   jne @F

           mov ebx, [edi+output]

           test ebx, ebx

           jz .fail

	   ret

@@:

	   cmp eax, DEV_GET_INFO

	   jne @F

           mov ebx, [edi+output]

	   stdcall get_dev_info, ebx

	   ret

@@:

.fail:

	   xor eax, eax

	   ret

endp

restore   io_code

restore   input

restore   inp_size

restore   output

restore   out_size

proc remap_irq                         ;for Intel chipsets ONLY !!!

	   mov eax, VALID_IRQ

	   bt eax, IRQ_LINE

	   jnc .exit

	   in ax,dx

	   bts ax, IRQ_LINE

	   out dx, aX

	   mov [ctrl.int_line], IRQ_LINE

	   ret

endp

proc ac97_irq

;           mov esi, msgIRQ

;           call SysMsgBoardStr

;     end if

	   mov al, 0x14

	   call [ctrl.ctrl_write8]

	   mov edx, PCM_OUT_SR_REG

	   call [ctrl.ctrl_write16]

	   call [ctrl.ctrl_read8]

	   cmp eax, [civ_val]

	   je .skip

	   dec eax

	   and eax, 0x1F

	   mov [ctrl.lvi_reg], eax

	   call [ctrl.ctrl_write8]

	   mov ax, 0x1D

	   call [ctrl.ctrl_write8]

	   add eax, 2

	   and eax, 31

	   mov ebx, dword [buff_list+eax*4]

	   je @f

@@:

	   ret

	   mov edx, PCM_OUT_CR_REG

	   mov ax, 0x1D

	   call [ctrl.ctrl_write8]

	   ret

endp

proc create_primary_buff

	   mov [ctrl.buffer], eax

	   mov ecx, 0x10000/4

	   xor eax, eax

           cld

	   rep stosd

	   mov ecx, 4

	   mov edi, pcmout_bdl

@@:

	   mov [edi], eax

	   mov [edi+4], ebx

	   mov [edi+4+32], ebx

	   mov [edi+4+64], ebx

	   mov [edi+4+96], ebx

	   mov [edi+4+128], ebx

	   mov [edi+4+160], ebx

	   mov [edi+4+192], ebx

	   mov [edi+4+224], ebx

	   add edi, 8

	   loop @B

	   mov eax, [ctrl.buffer]

	   mov ecx, 4

@@:

	   mov [edi], eax

	   mov [edi+16], eax

	   mov [edi+32], eax

	   mov [edi+48], eax

	   mov [edi+64], eax

	   mov [edi+80], eax

	   mov [edi+96], eax

	   mov [edi+112], eax

	   add edi, 4

	   loop @B

           stdcall GetPgAddr, ecx

	   and ecx, 0xFFF

	   add eax, ecx

	   call [ctrl.ctrl_write32]

	   mov [ctrl.lvi_reg], eax

	   mov edx, PCM_OUT_LVI_REG

	   call [ctrl.ctrl_write8]

endp

proc detect_controller

	   locals

	     last_bus dd ?

	     bus      dd ?

	     devfn    dd ?

	   endl

	   mov [bus], eax

	   inc eax

           call PciApi

	   cmp eax, -1

	   je .err

	   and [devfn], 0

.next_dev:

           stdcall PciRead32, [bus], [devfn], dword 0

	   test eax, eax

	   jz .next

	   cmp eax, -1

	   je .next

@@:

	   mov ebx, [edi]

	   test ebx, ebx

	   jz .next

	   je .found

	   add edi, 12

	   jmp @B

	   cmp [devfn], 256

	   jb  .next_dev

	   mov eax, [bus]

	   inc eax

	   mov [bus], eax

	   cmp eax, [last_bus]

	   jna .next_bus

	   xor eax, eax

	   ret

.found:

	   mov ebx, [bus]

	   mov [ctrl.bus], ebx

	   mov [ctrl.devfn], ecx

	   and edx, 0xFFFF

	   mov [ctrl.vendor], edx

	   shr eax, 16

	   mov [ctrl.dev_id], eax

	   mov [ctrl.ctrl_ids], ebx

	   mov esi, [edi+8]

	   mov [ctrl.ctrl_setup], esi

           jne @F

	   mov [ctrl.vendor_ids], msg_Intel

           ret

@@:

           cmp ebx, VID_NVIDIA

           jne @F

           mov [ctrl.vendor_ids], msg_NVidia

@@:

           mov [ctrl.vendor_ids], 0     ;something  wrong ?

	   ret

.err:

	   xor eax, eax

	   ret

endp

proc get_LPC_bus                ;for Intel chipsets ONLY !!!

	   locals

	     last_bus dd ?

	     bus      dd ?

	   endl

	   mov [bus], eax

	   inc eax

	   call [PciApi]

	   cmp eax, -1

	   je .err

.next_bus:

           stdcall PciRead32, [bus], dword 0xF8, dword 0

	   test eax, eax

	   jz .next

	   cmp eax, -1

	   je .next

	   je .found

.next:

	   mov eax, [bus]

	   inc eax

	   cmp eax, [last_bus]

	   mov [bus], eax

	   jna .next_bus

.err:

	   xor eax, eax

	   dec eax

	   ret

.found:

	   mov eax, [bus]

	   ret

endp

proc init_controller

	   mov ebx, eax

	   and eax, 0xFFFF

	   mov [ctrl.pci_cmd], eax

	   shr ebx, 16

	   mov [ctrl.pci_stat], ebx

	   and eax,0xFFFE

	   mov [ctrl.codec_io_base], eax

	   and eax, 0xFFC0

	   mov [ctrl.ctrl_io_base], eax

	   mov [ctrl.codec_mem_base], eax

	   mov [ctrl.ctrl_mem_base], eax

	   and eax, 0xFF

	   mov [ctrl.int_line], eax

	   and eax, 0xFF

	   mov [ctrl.cfg_reg], eax

	   xor eax, eax

	   inc eax

	   ret

endp

proc set_ICH

	   mov [ctrl.codec_read16],  codec_io_r16    ;virtual

	   mov [ctrl.codec_write16], codec_io_w16    ;virtual

	   mov [ctrl.ctrl_read16],  ctrl_io_r16      ;virtual

	   mov [ctrl.ctrl_read32],  ctrl_io_r32      ;virtual

	   mov [ctrl.ctrl_write16], ctrl_io_w16      ;virtual

	   mov [ctrl.ctrl_write32], ctrl_io_w32      ;virtual

	   ret

endp

PG_NOCACHE           equ 0x018

proc set_ICH4

           stdcall AllocKernelSpace, dword 0x2000

	   mov edi, eax

           stdcall MapPage, edi,[ctrl.codec_mem_base],PG_SW+PG_NOCACHE

	   mov [ctrl.codec_mem_base], edi

	   add edi, 0x1000

           stdcall MapPage, edi, [ctrl.ctrl_mem_base],PG_SW+PG_NOCACHE

	   mov [ctrl.ctrl_mem_base], edi

	   mov [ctrl.codec_write16], codec_mem_w16    ;virtual

	   mov [ctrl.ctrl_read16],  ctrl_mem_r16      ;virtual

	   mov [ctrl.ctrl_read32],  ctrl_mem_r32      ;virtual

	   mov [ctrl.ctrl_write16], ctrl_mem_w16      ;virtual

	   mov [ctrl.ctrl_write32], ctrl_mem_w32      ;virtual

	   ret

endp

proc reset_controller

	   mov edx, PCM_IN_CR_REG

	   call [ctrl.ctrl_write8]

	   call [ctrl.ctrl_write8]

	   call [ctrl.ctrl_write8]

	   mov edx, PCM_IN_CR_REG

	   call [ctrl.ctrl_write8]

	   call [ctrl.ctrl_write8]

	   call [ctrl.ctrl_write8]

endp

proc init_codec

	   locals

	     counter dd ?

	   endl

	   and eax, eax

	   jz .err

	   call [ctrl.codec_write16]

	   mov edx, CODEC_REG_POWERDOWN

	   call [ctrl.codec_write16]

.wait:

	   mov edx, CODEC_REG_POWERDOWN

	   call [ctrl.codec_read16]

	   and eax, 0x0F

	   cmp eax, 0x0F

	   jz .ready

	   call StallExec

	   sub [counter] , 1

	   jnz .wait

.err:

	   xor eax, eax        ; timeout error

	   ret

.ready:

	   call detect_codec

	   inc eax

	   ret

endp

proc reset_codec

	   mov edx, GLOB_CTRL

	   call [ctrl.ctrl_read32]

           jz .cold

           jnc .ok

.cold:

	   call cold_reset

	   jnc .ok

	   mov esi, msgCFail

           call SysMsgBoardStr

     end if

	   xor eax, eax 	   ; timeout error

	   ret

.ok:

     if DEBUG

           mov esi, msgResetOk

           call SysMsgBoardStr

     end if

	   inc eax

	   ret

endp

proc warm_reset

	   locals

	     counter dd ?

	   endl

	   mov edx, GLOB_CTRL

	   call [ctrl.ctrl_write32]

	   mov esi, msgWarm

           call SysMsgBoardStr

     end if

.wait:

	   mov eax, 100000	   ; wait 100 ms

	   call StallExec

	   call [ctrl.ctrl_read32]

	   test eax, 4

	   jz .ok

	   sub [counter], 1

	   jnz .wait

	   mov esi, msgWRFail

           call SysMsgBoardStr

     end if

	   ret

.ok:

	   mov edx, CTRL_STAT

	   call [ctrl.ctrl_read32]

	   and eax, CTRL_ST_CREADY

           jz .fail

           clc

	   ret

.fail:

           stc

	   ret

endp

proc cold_reset

	   locals

	     counter dd ?

	   endl

	   mov edx, GLOB_CTRL

	   call [ctrl.ctrl_write32]

	   mov esi, msgCold

           call SysMsgBoardStr

     end if

	   call StallExec

	   mov edx, GLOB_CTRL

	   call [ctrl.ctrl_write32]

.wait:

	   mov eax, 100000	   ; wait 100 ms

	   call StallExec

	   call [ctrl.ctrl_read32]

	   test eax, 4

	   jz .ok

	   sub [counter], 1

	   jnz .wait

	   mov esi, msgCRFail

           call SysMsgBoardStr

     end if

	   stc

	   ret

.ok:

	   mov edx, CTRL_STAT

	   call [ctrl.ctrl_read32]

	   and eax, CTRL_ST_CREADY

           jz .fail

           clc

	   ret

.fail:

           stc

	   ret

endp

proc play

	   mov [ctrl.lvi_reg], eax

	   mov edx, PCM_OUT_LVI_REG

	   call [ctrl.ctrl_write8]

	   mov ax, 0x1D

	   call [ctrl.ctrl_write8]

	   ret

endp

proc stop

	   mov edx, PCM_OUT_CR_REG

	   mov ax, 0x14

	   call [ctrl.ctrl_write8]

	   mov [ctrl.lvi_reg], eax

	   mov edx, PCM_OUT_LVI_REG

	   call [ctrl.ctrl_write8]

endp

proc get_dev_info stdcall, p_info:dword

	   virtual at esi

	     CTRL_INFO CTRL_INFO

	   end virtual

	   mov eax, [ctrl.int_line]

	   mov ebx, [ctrl.codec_io_base]

	   mov ecx, [ctrl.ctrl_io_base]

	   mov edx, [ctrl.codec_mem_base]

	   mov edi, [ctrl.ctrl_mem_base]

	   mov [CTRL_INFO.codec_io_base], ebx

	   mov [CTRL_INFO.ctrl_io_base], ecx

	   mov [CTRL_INFO.codec_mem_base], edx

	   mov [CTRL_INFO.ctrl_mem_base], edi

           mov [CTRL_INFO.codec_id], eax

           call [ctrl.ctrl_read32]

	   mov [CTRL_INFO.glob_cntrl], eax

           call [ctrl.ctrl_read32]

	   mov [CTRL_INFO.glob_sta], eax

	   mov [CTRL_INFO.pci_cmd], ebx

endp

proc set_callback stdcall, handler:dword

	   mov eax, [handler]

	   mov [ctrl.user_callback], eax

	   ret

endp

proc codec_read stdcall, ac_reg:dword	   ; reg = edx, reval = eax

	   shr ebx, 1

	   bt [codec.shadow_flag], ebx

	   jc .use_shadow

	   mov ecx, eax

	   call [ctrl.ctrl_read32]

	   test eax, CTRL_ST_RCS

	   jz .read_ok

	   call [ctrl.ctrl_write32]

	   xor eax,eax

	   not eax		;timeout

	   ret

.read_ok:

	   mov edx, [ac_reg]

	   mov [codec.regs+edx], cx

	   bts [codec.shadow_flag], ebx

	   mov eax, ecx

	   ret

.use_shadow:

	   movzx eax, word [codec.regs+edx]

	   ret

endp

proc codec_write stdcall, ac_reg:dword

	   push eax

	   call check_semafore

	   and eax, eax

	   jz .err

	   pop eax

	   mov edx, esi

	   call [ctrl.codec_write16]

	   mov [codec.regs+esi], ax

	   shr esi, 1

	   bts [codec.shadow_flag], esi

	   ret

.err:

	   pop eax

	   ret

endp

proc codec_check_ready

	  call [ctrl.ctrl_read32]

	  and eax, CTRL_ST_CREADY

	  jz .not_ready