Subversion Repositories Kolibri OS

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

CTRL_SIS          equ 0x7012

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  0x18	 ; PCM out Status register

PCM_OUT_PIV_REG   equ  0x1a	 ; PCM out prefetched index

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 0

  .devfn	      dd 0

  .dev_id	      dd 0

  .pci_cmd	      dd 0

  .pci_stat	      dd 0

  .codec_mem_base     dd 0

  .ctrl_mem_base      dd 0

  .cfg_reg	      dd 0

  .int_line	      dd 0

  .ctrl_ids	      dd 0    ;hub id string

  .notify_task	      dd 0

  .ctrl_setup	      dd 0

  .user_callback      dd 0

  .codec_read16       dd 0

  .codec_write16      dd 0

  .ctrl_read16	      dd 0

  .ctrl_read32	      dd 0

  .ctrl_write16       dd 0

  .ctrl_write32       dd 0

}

{

  .chip_id	      dd 0

  .flags	      dd 0

  .status	      dd 0

  .chip_ids	      dd 0    ;chip model string

		      dd 0

  .reg_master_vol     dw 0     ;0x02

  .reg_aux_out_vol    dw 0     ;0x04

  .reg_mone_vol       dw 0     ;0x06

  .reg_master_tone    dw 0     ;0x08

  .reg_beep_vol       dw 0     ;0x0A

  .reg_phone_vol      dw 0     ;0x0C

  .reg_mic_vol	      dw 0     ;0x0E

  .reg_line_in_vol    dw 0     ;0x10

  .reg_cd_vol	      dw 0     ;0x12

  .reg_video_vol      dw 0     ;0x14

  .reg_aux_in_vol     dw 0     ;0x16

  .reg_pcm_out_vol    dw 0     ;0x18

  .reg_rec_select     dw 0     ;0x1A

  .reg_rec_gain       dw 0     ;0x1C

  .reg_rec_gain_mic   dw 0     ;0x1E

  .reg_gen	      dw 0     ;0x20

  .reg_3d_ctrl	      dw 0     ;0X22

  .reg_page	      dw 0     ;0X24

  .reg_powerdown      dw 0     ;0x26

  .reg_ext_audio      dw 0     ;0x28

  .reg_ext_st	      dw 0     ;0x2a

  .reg_pcm_front_rate dw 0     ;0x2c

  .reg_pcm_surr_rate  dw 0     ;0x2e

  .reg_lfe_rate       dw 0     ;0x30

  .reg_pcm_in_rate    dw 0     ;0x32

		      dw 0     ;0x34

  .reg_cent_lfe_vol   dw 0     ;0x36

  .reg_surr_vol       dw 0     ;0x38

  .reg_spdif_ctrl     dw 0     ;0x3A

		      dw 0     ;0x3C

		      dw 0     ;0x3E

		      dw 0     ;0x40

		      dw 0     ;0x42

		      dw 0     ;0x44

		      dw 0     ;0x46

		      dw 0     ;0x48

		      dw 0     ;0x4A

		      dw 0     ;0x4C

		      dw 0     ;0x4E

		      dw 0     ;0x50

		      dw 0     ;0x52

		      dw 0     ;0x54

		      dw 0     ;0x56

		      dw 0     ;0x58

		      dw 0     ;0x5A

		      dw 0     ;0x5C

		      dw 0     ;0x5E

  .reg_page_0	      dw 0     ;0x60

  .reg_page_1	      dw 0     ;0x62

  .reg_page_2	      dw 0     ;0x64

  .reg_page_3	      dw 0     ;0x66

  .reg_page_4	      dw 0     ;0x68

  .reg_page_5	      dw 0     ;0x6A

  .reg_page_6	      dw 0     ;0x6C

  .reg_page_7	      dw 0     ;0x6E

		      dw 0     ;0x70

		      dw 0     ;0x72

		      dw 0     ;0x74

		      dw 0     ;0x76

		      dw 0     ;0x78

		      dw 0     ;0x7A

  .reg_vendor_id_1    dw 0     ;0x7C

  .reg_vendor_id_2    dw 0     ;0x7E

  .set_master_vol     dd 0

}

{   .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 START

public IMPORTS

     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]

     end if

	   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]

	   call [SysMsgBoardStr]

   if DEBUG

	   mov esi, msgFail

	   call   [SysMsgBoardStr]

   end if

	   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 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

           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]

           call [ctrl.ctrl_read32]

           and eax, not 0x000000C0

           mov edx, GLOB_CTRL

           call [ctrl.ctrl_write32]

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 [ctrl.vendor_ids], msg_SIS

	   mov [ctrl.ctrl_setup], esi

.err:

	   xor eax, eax

	   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_SIS

	   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

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:

           xor eax, eax

	   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

           xor eax, eax

           mov [civ_val], eax

           mov edx, PCM_OUT_CIV_REG

	   call [ctrl.ctrl_write8]

	   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

	  inc eax

	  ret

.not_ready:

	  xor eax, eax

	  ret

endp

proc check_semafore

	   local counter:DWORD

.l1:

	   mov edx, CTRL_CAS

	   call [ctrl.ctrl_read8]

	   and eax, CAS_FLAG

	   jz .ok

	   call StallExec

	   sub [counter], 1

	   jnz .l1

	   xor eax, eax

	   ret

align 4

.ok:

	   xor eax,eax

	   inc eax

	   ret

endp

proc StallExec

	   push ecx

	   push edx

	   push ebx

	   push eax

	   mul ecx

	   mov ebx, eax       ;low

	   mov ecx, edx       ;high

	   rdtsc

	   add ebx, eax

	   adc ecx,edx

@@:

	   rdtsc

	   sub eax, ebx

	   sbb edx, ecx

	   jb @B

	   pop ebx

	   pop edx

	   pop ecx

	   ret

endp

;          CONTROLLER IO functions

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

proc codec_io_r16

	add edx, [ctrl.codec_io_base]

	in  ax, dx

	ret

endp

proc codec_io_w16

	add edx, [ctrl.codec_io_base]

	out dx, ax

	ret

endp

proc ctrl_io_r8

	add edx, [ctrl.ctrl_io_base]

	in  al, dx

	ret

endp

proc ctrl_io_r16

	add edx, [ctrl.ctrl_io_base]

	in  ax, dx

	ret

endp

proc ctrl_io_r32

	add edx, [ctrl.ctrl_io_base]

	in  eax, dx

	ret

endp

proc ctrl_io_w8

	add edx, [ctrl.ctrl_io_base]

	out dx, al

	ret

endp

proc ctrl_io_w16

	add edx, [ctrl.ctrl_io_base]

	out dx, ax

	ret

endp

proc ctrl_io_w32

	add edx, [ctrl.ctrl_io_base]

	out dx, eax

	ret

endp

pcmout_bdl	 dq 32 dup(0)

buff_list	 dd 32 dup(0)

ctrl AC_CNTRL

codec CODEC

devices dd (CTRL_SIS  shl 16)+VID_SIS,msg_AC, set_SIS

	dd 0

imp_table:

IMPORTS:

SysMsgBoardStr	   dd szSysMsgBoardStr

PciApi		   dd szPciApi