Subversion Repositories Kolibri OS

include 'imports.inc'

;               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

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

SLOT_BASE       equ OS_BASE+0x0080000

new_app_base    equ 0x80000000

public service_proc

public version

           jne .stop

           mov esi, msgDetect

           call SysMsgBoardStr

     end if

           test eax, eax

           jz .fail

           mov esi,[ctrl.vendor_ids]

           call SysMsgBoardStr

           mov   esi, [ctrl.ctrl_ids]

           call SysMsgBoardStr

           call init_controller

           test eax, eax

           jz .fail

           jmp .fail          ;force 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

           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

           ret

.stop:

           call stop

           xor eax, eax

           ret

endp

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 eax, [edi+input]

           mov eax, [eax]

           call set_master_vol      ;eax= vol

           ret

@@:

           cmp eax, DEV_GET_MASTERVOL

           jne @F

           mov ebx, [edi+output]

           add ebx, new_app_base

           stdcall get_master_vol, ebx

           ret

;@@:

;           cmp eax, DEV_GET_INFO

;           jne @F

;           mov ebx, [edi+output]

;           stdcall get_dev_info, ebx

;           ret

@@:

.fail:

           or eax, -1

           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

           je @f

@@:

           ret

           mov edx, PCM_OUT_CR_REG

           mov ax, 0x11               ;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

           call GetPgAddr

           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

           mov ebx, eax

           call GetPgAddr     ;eax

           and ebx, 0xFFF

           add eax, ebx

           call [ctrl.ctrl_write32]

           mov [ctrl.lvi_reg], eax

           mov edx, PCM_OUT_LVI_REG

           call [ctrl.ctrl_write8]

           ret

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

           inc [devfn]

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

           ret

@@:

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

           ret

.err:

           xor eax, eax

           ret

endp

proc init_controller

           call SysMsgBoardStr

           mov ebx, eax

           and eax, 0xFFFF

           mov [ctrl.pci_cmd], eax

           shr ebx, 16

           mov [ctrl.pci_stat], ebx

           call SysMsgBoardStr

           call SysMsgBoardStr

           and eax,0xFFFE

           mov [ctrl.codec_io_base], eax

           call SysMsgBoardStr

           call SysMsgBoardStr

           and eax, 0xFF

           mov [ctrl.int_line], eax

           call SysMsgBoardStr

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

	   ret

endp

proc init_codec

	   locals

	     counter dd ?

	   endl

           call SysMsgBoardStr

           call [ctrl.ctrl_read32]

           call dword2str

           call SysMsgBoardStr

           call SysMsgBoardStr

           call [ctrl.ctrl_read32]

           call SysMsgBoardStr

           jnz .ready

	   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

play:

	   mov eax, 16

	   mov [ctrl.lvi_reg], eax

	   mov edx, PCM_OUT_LVI_REG

	   call [ctrl.ctrl_write8]

	   mov ax, 0x1D

	   call [ctrl.ctrl_write8]

           xor eax, eax

	   ret

stop:

	   mov edx, PCM_OUT_CR_REG

           mov ax, 0x0

	   call [ctrl.ctrl_write8]

           mov edx, PCM_OUT_SR_REG

           call [ctrl.ctrl_write16]

           xor eax, eax

	   ret

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

	   ret

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

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