WebSVN – Kolibri OS – Diff – /kernel/trunk/drivers/ensoniq.asm


;alpha version
 
format MS COFF
 
 
include 'proc32.inc'
include 'imports.inc'
 
DEBUG	    equ 1
 
REMAP_IRQ   equ 0
 
;irq 0,1,2,8,12,13 íåäîñòóïíû
;               FEDCBA9876543210
VALID_IRQ   equ 1100111011111000b
ATTCH_IRQ   equ 0000111010101000b
 
IRQ_LINE    equ 0
 
CPU_FREQ    equ  2600d
 
BIT0  EQU 0x00000001
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_BDL	  equ  0x10	 ; PCM out buffer descriptors list
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
 
PCM_IN_CR_REG	  equ  0x0b	 ; PCM in Control Register
MC_IN_CR_REG	  equ  0x2b	 ; MIC in Control Register
RR		  equ  BIT1	 ; reset registers.  Nukes all regs
 
CODEC_MASTER_VOL_REG		equ	0x02
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
 
GLOB_CTRL      equ  0x2C	;   Global Control
CTRL_STAT	equ  0x30	 ;   Global Status
CTRL_CAS	equ  0x34	 ;   Codec Access Semiphore
 
CAS_FLAG	equ  0x01	 ;   Codec Access Semiphore Bit
 
CTRL_ST_CREADY	equ  BIT8+BIT9+BIT28 ;   Primary Codec Ready
 
CTRL_ST_RCS	equ  0x00008000  ;   Read Completion Status
 
CTRL_CNT_CRIE	equ  BIT4+BIT5+BIT6  ;   Codecs Resume Interrupt Enable
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_POWERDOWN   equ 0x26
CODEC_REG_ST	      equ 0x26
 
DEV_PLAY	      equ  1
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
 
struc AC_CNTRL		    ;AC controller base class
{ .bus                dd ?
  .devfn              dd ?
 
  .vendor             dd ?
  .dev_id             dd ?
  .pci_cmd            dd ?
  .pci_stat           dd ?
 
  .codec_io_base      dd ?
  .codec_mem_base     dd ?
 
  .ctrl_io_base       dd ?
  .ctrl_mem_base      dd ?
  .cfg_reg            dd ?
  .int_line           dd ?
 
  .vendor_ids         dd ?    ;vendor id string
  .ctrl_ids           dd ?    ;hub id string
 
  .buffer             dd ?
 
  .notify_pos         dd ?
  .notify_task        dd ?
 
  .lvi_reg            dd ?
  .ctrl_setup         dd ?
  .user_callback      dd ?
  .codec_read16       dd ?
  .codec_write16      dd ?
 
  .ctrl_read8         dd ?
  .ctrl_read16        dd ?
  .ctrl_read32        dd ?
 
  .ctrl_write8        dd ?
  .ctrl_write16       dd ?
  .ctrl_write32       dd ?
}
 
struc CODEC		   ;Audio Chip base class
{
  .chip_id            dd ?
  .flags              dd ?
  .status             dd ?
 
  .ac_vendor_ids      dd ?    ;ac vendor id string
  .chip_ids           dd ?    ;chip model string
 
  .shadow_flag        dd ?
                      dd ?
 
  .regs               dw ?     ; codec registers
  .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
 
 
  .reset              dd ?    ;virual
  .set_master_vol     dd ?
}
 
struc CTRL_INFO
{   .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  ?
}
 
struc IOCTL
{  .handle           dd ?
   .io_code          dd ?
   .input            dd ?
   .inp_size         dd ?
   .output           dd ?
   .out_size         dd ?
}
 
virtual at 0
  IOCTL IOCTL
end virtual
 
EVENT_NOTIFY	      equ 0x00000200
 
OS_BASE         equ 0;
SLOT_BASE       equ OS_BASE+0x0080000
new_app_base    equ 0x80000000
 
public START
public service_proc
public version
 
section '.flat' code readable align 16
 
proc START stdcall, state:dword
 
           cmp [state], 1
           jne .stop
 
     if DEBUG
           mov esi, msgDetect
           call SysMsgBoardStr
     end if
 
           call detect_controller
           test eax, eax
           jz .fail
 
     if DEBUG
           mov esi,[ctrl.vendor_ids]
           call SysMsgBoardStr
           mov   esi, [ctrl.ctrl_ids]
           call SysMsgBoardStr
 
     end if
           call init_controller
           test eax, eax
           jz .fail
 
 
           jmp .fail      ;force fail
 
     if DEBUG
           mov esi, msgInitCodec
           call SysMsgBoardStr
     end if
 
           call init_codec
           test eax, eax
           jz .fail
 
     if DEBUG
           mov esi, [codec.ac_vendor_ids]
           call SysMsgBoardStr
 
           mov esi, [codec.chip_ids]
           call SysMsgBoardStr
     end if
 
           call reset_controller
           call setup_codec
 
           mov esi, msgPrimBuff
           call SysMsgBoardStr
 
           call create_primary_buff
 
           mov eax, VALID_IRQ
           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 AttachIntHandler, ebx, ac97_irq
           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
 
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 service_proc stdcall, ioctl:dword
 
           mov edi, [ioctl]
           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   handle
restore   io_code
restore   input
restore   inp_size
restore   output
restore   out_size
 
 
align 4
proc ac97_irq
 
;     if DEBUG
;           mov esi, msgIRQ
;           call SysMsgBoardStr
;     end if
 
 
           cmp [ctrl.user_callback], 0
           je @f
 
           stdcall [ctrl.user_callback], ebx
@@:
           ret
 
.skip:
           mov edx, PCM_OUT_CR_REG
           mov ax, 0x11               ;0x1D
           call [ctrl.ctrl_write8]
           ret
endp
 
align 4
proc create_primary_buff
 
           stdcall KernelAlloc, 0x10000
           mov [ctrl.buffer], eax
 
           mov edi, eax
           mov ecx, 0x10000/4
           xor eax, eax
           cld
           rep stosd
 
           mov eax, [ctrl.buffer]
           call GetPgAddr
 
           mov ebx, 0xC0002000
           mov ecx, 4
           mov edi, pcmout_bdl
@@:
           mov [edi], eax
           mov [edi+4], ebx
 
           mov [edi+32], eax
           mov [edi+4+32], ebx
 
           mov [edi+64], eax
           mov [edi+4+64], ebx
 
           mov [edi+96], eax
           mov [edi+4+96], ebx
 
           mov [edi+128], eax
           mov [edi+4+128], ebx
 
           mov [edi+160], eax
           mov [edi+4+160], ebx
 
           mov [edi+192], eax
           mov [edi+4+192], ebx
 
           mov [edi+224], eax
           mov [edi+4+224], ebx
 
           add eax, 0x4000
           add edi, 8
           loop @B
 
           mov edi, buff_list
           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 eax, 0x4000
           add edi, 4
           loop @B
 
           mov eax, pcmout_bdl
           mov ebx, eax
           call GetPgAddr     ;eax
           and ebx, 0xFFF
           add eax, ebx
 
           mov edx, PCM_OUT_BDL
           call [ctrl.ctrl_write32]
 
           mov eax, 16
           mov [ctrl.lvi_reg], eax
           mov edx, PCM_OUT_LVI_REG
           call [ctrl.ctrl_write8]
           ret
endp
 
align 4
proc detect_controller
         locals
           last_bus dd ?
           bus      dd ?
           devfn    dd ?
         endl
 
           xor eax, eax
           mov [bus], eax
           inc eax
           call PciApi
           cmp eax, -1
           je .err
 
           mov [last_bus], eax
 
.next_bus:
           and [devfn], 0
.next_dev:
           stdcall PciRead32, [bus], [devfn], dword 0
           test eax, eax
           jz .next
           cmp eax, -1
           je .next
 
           mov edi, devices
@@:
           mov ebx, [edi]
           test ebx, ebx
           jz .next
 
           cmp eax, ebx
           je .found
           add edi, 12
           jmp @B
 
.next:
           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 ecx, [devfn]
           mov [ctrl.devfn], ecx
 
           mov edx, eax
           and edx, 0xFFFF
           mov [ctrl.vendor], edx
           shr eax, 16
           mov [ctrl.dev_id], eax
 
           mov ebx, [edi+4]
           mov [ctrl.ctrl_ids], ebx
           mov esi, [edi+8]
           mov [ctrl.ctrl_setup], esi
 
           cmp ebx, 0x1274
           jne @F
           mov [ctrl.vendor_ids], msgEnsoniq
           ret
@@:
           mov [ctrl.vendor_ids], 0     ;something  wrong ?
           ret
.err:
           xor eax, eax
           ret
endp
 
align 4
proc init_controller
 
           mov esi, msgPCIcmd
           call SysMsgBoardStr
 
           stdcall PciRead32, [ctrl.bus], [ctrl.devfn], dword 4
           mov ebx, eax
           and eax, 0xFFFF
           mov [ctrl.pci_cmd], eax
           shr ebx, 16
           mov [ctrl.pci_stat], ebx
 
           call dword2str
           call SysMsgBoardStr
 
           mov esi, msgIObase
           call SysMsgBoardStr
 
           stdcall PciRead32, [ctrl.bus], [ctrl.devfn], dword 0x10
;           and eax, -16
           mov [ctrl.ctrl_io_base], eax
 
           call dword2str
           call SysMsgBoardStr
 
           mov esi, msgIRQline
           call SysMsgBoardStr
 
           stdcall PciRead32, [ctrl.bus], [ctrl.devfn], dword 0x3C
           and eax, 0xFF
           mov [ctrl.int_line], eax
 
           call dword2str
           call SysMsgBoardStr
 
           call [ctrl.ctrl_setup]
           xor eax, eax
           inc eax
           ret
endp
 
align 4
proc set_ICH
           mov [ctrl.codec_read16],  codec_io_r16    ;virtual
           mov [ctrl.codec_write16], codec_io_w16    ;virtual
 
           mov [ctrl.ctrl_read8 ],  ctrl_io_r8      ;virtual
           mov [ctrl.ctrl_read16],  ctrl_io_r16      ;virtual
           mov [ctrl.ctrl_read32],  ctrl_io_r32      ;virtual
 
           mov [ctrl.ctrl_write8 ], ctrl_io_w8      ;virtual
           mov [ctrl.ctrl_write16], ctrl_io_w16      ;virtual
           mov [ctrl.ctrl_write32], ctrl_io_w32      ;virtual
           ret
endp
 
 
 
 
 
align 4
proc reset_controller
 
           xor eax, eax
           mov edx, PCM_IN_CR_REG
           call [ctrl.ctrl_write8]
 
           mov edx, PCM_OUT_CR_REG
           call [ctrl.ctrl_write8]
 
           mov edx, MC_IN_CR_REG
           call [ctrl.ctrl_write8]
 
           mov eax, RR
           mov edx, PCM_IN_CR_REG
           call [ctrl.ctrl_write8]
 
           mov edx, PCM_OUT_CR_REG
           call [ctrl.ctrl_write8]
 
           mov edx, MC_IN_CR_REG
           call [ctrl.ctrl_write8]
           ret
endp
 
align 4
proc init_codec
         locals
           counter dd ?
         endl
 
           mov esi, msgControl
           call SysMsgBoardStr
 
           mov edx, GLOB_CTRL
           call [ctrl.ctrl_read32]
           call dword2str
           call SysMsgBoardStr
 
           mov esi, msgStatus
           call SysMsgBoardStr
 
           mov edx, CTRL_STAT
           call [ctrl.ctrl_read32]
 
           call dword2str
           call SysMsgBoardStr
 
           test eax, CTRL_ST_CREADY
           jnz .ready
 
           call reset_codec
           and eax, eax
           jz .err
 
           xor edx, edx     ;ac_reg_0
           call [ctrl.codec_write16]
 
           xor eax, eax
           mov edx, CODEC_REG_POWERDOWN
           call [ctrl.codec_write16]
 
           mov [counter], 200     ; total 200*5 ms = 1s
.wait:
           mov edx, CODEC_REG_POWERDOWN
           call [ctrl.codec_read16]
           and eax, 0x0F
           cmp eax, 0x0F
           jz .ready
 
           mov eax, 5000   ; wait 5 ms
           call StallExec
           sub [counter] , 1
           jnz .wait
.err:
           xor eax, eax        ; timeout error
           ret
.ready:
           call detect_codec
 
           xor eax, eax
           inc eax
           ret
endp
 
align 4
proc reset_codec
           mov edx, GLOB_CTRL
           call [ctrl.ctrl_read32]
 
           test eax, 0x02
           jz .cold
 
           call warm_reset
           jnc .ok
.cold:
           call cold_reset
           jnc .ok
 
     if DEBUG
           mov esi, msgCFail
           call SysMsgBoardStr
     end if
           xor eax, eax     ; timeout error
           ret
.ok:
     if DEBUG
           mov esi, msgResetOk
           call SysMsgBoardStr
     end if
 
           xor eax, eax
           inc eax
           ret
endp
 
align 4
proc warm_reset
	   locals
	     counter dd ?
	   endl
 
	   mov eax, 0x06
	   mov edx, GLOB_CTRL
	   call [ctrl.ctrl_write32]
 
     if DEBUG
	   mov esi, msgWarm
           call SysMsgBoardStr
     end if
 
	   mov [counter], 10	   ; total 10*100 ms = 1s
.wait:
	   mov eax, 100000	   ; wait 100 ms
	   call StallExec
 
	   mov edx, GLOB_CTRL
	   call [ctrl.ctrl_read32]
	   test eax, 4
	   jz .ok
	   sub [counter], 1
	   jnz .wait
 
     if DEBUG
	   mov esi, msgWRFail
           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
 
align 4
proc cold_reset
	   locals
	     counter dd ?
	   endl
 
	   xor eax, eax
	   mov edx, GLOB_CTRL
	   call [ctrl.ctrl_write32]
 
     if DEBUG
	   mov esi, msgCold
           call SysMsgBoardStr
     end if
 
	   mov eax, 1000000	   ; wait 1 s
	   call StallExec
 
	   mov eax, 2
	   mov edx, GLOB_CTRL
	   call [ctrl.ctrl_write32]
 
	   mov [counter], 10	   ; total 10*100 ms = 1s
.wait:
	   mov eax, 100000	   ; wait 100 ms
	   call StallExec
 
	   mov edx, GLOB_CTRL
	   call [ctrl.ctrl_read32]
	   test eax, 4
	   jz .ok
	   sub [counter], 1
	   jnz .wait
 
     if DEBUG
	   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
 
align 4
play:
           mov eax, 16
           mov [ctrl.lvi_reg], eax
           mov edx, PCM_OUT_LVI_REG
           call [ctrl.ctrl_write8]
 
           mov edx, PCM_OUT_CR_REG
           mov ax, 0x1D
           call [ctrl.ctrl_write8]
           xor eax, eax
           ret
 
align 4
stop:
           mov edx, PCM_OUT_CR_REG
           mov ax, 0x0
           call [ctrl.ctrl_write8]
 
           mov ax, 0x1c
           mov edx, PCM_OUT_SR_REG
           call [ctrl.ctrl_write16]
           xor eax, eax
	   ret
 
align 4
proc get_dev_info stdcall, p_info:dword
	   virtual at esi
	     CTRL_INFO CTRL_INFO
	   end virtual
 
	   mov esi, [p_info]
	   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.irq], eax
	   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 eax, [codec.chip_id]
           mov [CTRL_INFO.codec_id], eax
 
	   mov edx, GLOB_CTRL
           call [ctrl.ctrl_read32]
	   mov [CTRL_INFO.glob_cntrl], eax
 
	   mov edx, CTRL_STAT
           call [ctrl.ctrl_read32]
	   mov [CTRL_INFO.glob_sta], eax
 
	   mov ebx, [ctrl.pci_cmd]
	   mov [CTRL_INFO.pci_cmd], ebx
	   ret
endp
 
align 4
proc set_callback stdcall, handler:dword
	   mov eax, [handler]
	   mov [ctrl.user_callback], eax
	   ret
endp
 
align 4
proc codec_read stdcall, ac_reg:dword	   ; reg = edx, reval = eax
 
	   mov edx, [ac_reg]
 
	   mov ebx, edx
	   shr ebx, 1
	   bt [codec.shadow_flag], ebx
	   jc .use_shadow
 
	   call [ctrl.codec_read16]  ;change edx !!!
	   mov ecx, eax
 
	   mov edx, CTRL_STAT
	   call [ctrl.ctrl_read32]
	   test eax, CTRL_ST_RCS
	   jz .read_ok
 
	   mov edx, CTRL_STAT
	   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
 
align 4
proc codec_write stdcall, ac_reg:dword
	   push eax
	   call check_semafore
	   and eax, eax
	   jz .err
	   pop eax
 
	   mov esi, [ac_reg]
	   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
 
align 4
proc codec_check_ready
 
           mov edx, CTRL_ST
           call [ctrl.ctrl_read32]
           and eax, CTRL_ST_CREADY
           jz .not_ready
 
           xor eax, wax
           inc eax
           ret
.not_ready:
           xor eax, eax
           ret
endp
 
align 4
proc check_semafore
	   local counter:DWORD
 
	   mov [counter], 100
.l1:
	   mov edx, CTRL_CAS
	   call [ctrl.ctrl_read8]
	   and eax, CAS_FLAG
	   jz .ok
 
	   mov eax, 1
	   call StallExec
	   sub [counter], 1
	   jnz .l1
	   xor eax, eax
	   ret
align 4
.ok:
	   xor eax,eax
	   inc eax
	   ret
endp
 
align 4
proc StallExec
	   push ecx
	   push edx
	   push ebx
	   push eax
 
	   mov ecx, CPU_FREQ
	   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 eax
	   pop ebx
	   pop edx
	   pop ecx
	   ret
endp
 
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;          CONTROLLER IO functions
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 
align 4
codec_io_r16:
           add edx, [ctrl.codec_io_base]
           in  ax, dx
           ret
 
 
align 4
codec_io_w16:
           add edx, [ctrl.codec_io_base]
           out dx, ax
           ret
 
 
align 4
ctrl_io_r8:
           add edx, [ctrl.ctrl_io_base]
           in  al, dx
           ret
 
 
align 4
ctrl_io_r16:
          add edx, [ctrl.ctrl_io_base]
          in  ax, dx
          ret
 
 
align 4
ctrl_io_r32:
          add edx, [ctrl.ctrl_io_base]
          in  eax, dx
          ret
 
 
align 4
ctrl_io_w8:
          add edx, [ctrl.ctrl_io_base]
          out dx, al
          ret
 
 
align 4
ctrl_io_w16:
          add edx, [ctrl.ctrl_io_base]
          out dx, ax
          ret
 
 
align 4
ctrl_io_w32:
          add edx, [ctrl.ctrl_io_base]
          out dx, eax
          ret
 
 
 
align 4
dword2str:
          mov  esi, hex_buff
          mov ecx, -8
@@:
          rol eax, 4
          mov ebx, eax
          and ebx, 0x0F
          mov bl, [ebx+hexletters]
          mov [8+esi+ecx], bl
          inc ecx
          jnz @B
          ret
 
hexletters   db '0123456789ABCDEF'
hex_buff     db 8 dup(0),13,10,0
 
 
include "codec.inc"
 
align 4
devices dd (0x5000 shl 16)+0x1274,msgEnsoniq,set_ICH
        dd (0x5880 shl 16)+0x1274,msgVibra128,set_ICH
        dd 0    ;terminator
 
version      dd 0x00040004
 
msgEnsoniq   db 'Ensonic 1371',13,10,0
msgVibra128  db 'Sound Blaster AudioPCI Vibra 128',13,10,0
 
sz_sound_srv db 'SOUND',0
 
msgDetect    db 'detect hardware...',13,10,0
msgFail      db 'device not found',13,10,0
msgAttchIRQ  db 'IRQ line not supported', 13,10, 0
msgInvIRQ    db 'IRQ line not assigned or invalid', 13,10, 0
msgPlay      db 'start play', 13,10,0
msgStop      db 'stop play',  13,10,0
msgNotify    db 'call notify',13,10,0
msgIRQ       db 'AC97 IRQ', 13,10,0
msgInitCtrl  db 'init controller',13,10,0
msgInitCodec db 'init codec',13,10,0
msgPrimBuff  db 'create primary buffer',13,10,0
msgReg       db 'set service handler',13,10,0
msgOk        db 'service installed',13,10,0
msgCold      db 'cold reset',13,10,0
msgWarm      db 'warm reset',13,10,0
msgWRFail    db 'warm reset failed',13,10,0
msgCRFail    db 'cold reset failed',13,10,0
msgCFail     db 'codec not ready',13,10,0
msgResetOk   db 'reset complete',13,10,0
msgStatus    db 'global status   ',0
msgControl   db 'global control  ',0
msgPCIcmd    db 'PCI command     ',0
msgIObase    db 'IO base         ',0
msgIRQline   db 'IRQ line        ',0
 
section '.data' data readable writable align 16
 
pcmout_bdl       rq 32
buff_list        rd 32
 
codec CODEC
ctrl AC_CNTRL
 
lpc_bus  rd 1
civ_val  rd 1

Rev 406	Rev 412
1	;alpha version	1	;alpha version
2		2
3	format MS COFF	3	format MS COFF
4		4
5		5
6	include 'proc32.inc'	6	include 'proc32.inc'
7	include 'imports.inc'	7	include 'imports.inc'
8		8
9	DEBUG equ 1	9	DEBUG equ 1
10		10
11	REMAP_IRQ equ 0	11	REMAP_IRQ equ 0
12		12
13	;irq 0,1,2,8,12,13 íåäîñòóïíû	13	;irq 0,1,2,8,12,13 íåäîñòóïíû
14	; FEDCBA9876543210	14	; FEDCBA9876543210
15	VALID_IRQ equ 1100111011111000b	15	VALID_IRQ equ 1100111011111000b
16	ATTCH_IRQ equ 0000111010101000b	16	ATTCH_IRQ equ 0000111010101000b
17		17
18	IRQ_LINE equ 0	18	IRQ_LINE equ 0
19		19
20	CPU_FREQ equ 2600d	20	CPU_FREQ equ 2600d
21		21
22	BIT0 EQU 0x00000001	22	BIT0 EQU 0x00000001
23	BIT1 EQU 0x00000002	23	BIT1 EQU 0x00000002
24	BIT2 EQU 0x00000004	24	BIT2 EQU 0x00000004
25	BIT3 EQU 0x00000008	25	BIT3 EQU 0x00000008
26	BIT4 EQU 0x00000010	26	BIT4 EQU 0x00000010
27	BIT5 EQU 0x00000020	27	BIT5 EQU 0x00000020
28	BIT6 EQU 0x00000040	28	BIT6 EQU 0x00000040
29	BIT7 EQU 0x00000080	29	BIT7 EQU 0x00000080
30	BIT8 EQU 0x00000100	30	BIT8 EQU 0x00000100
31	BIT9 EQU 0x00000200	31	BIT9 EQU 0x00000200
32	BIT10 EQU 0x00000400	32	BIT10 EQU 0x00000400
33	BIT11 EQU 0x00000800	33	BIT11 EQU 0x00000800
34	BIT12 EQU 0x00001000	34	BIT12 EQU 0x00001000
35	BIT13 EQU 0x00002000	35	BIT13 EQU 0x00002000
36	BIT14 EQU 0x00004000	36	BIT14 EQU 0x00004000
37	BIT15 EQU 0x00008000	37	BIT15 EQU 0x00008000
38	BIT16 EQU 0x00010000	38	BIT16 EQU 0x00010000
39	BIT17 EQU 0x00020000	39	BIT17 EQU 0x00020000
40	BIT18 EQU 0x00040000	40	BIT18 EQU 0x00040000
41	BIT19 EQU 0x00080000	41	BIT19 EQU 0x00080000
42	BIT20 EQU 0x00100000	42	BIT20 EQU 0x00100000
43	BIT21 EQU 0x00200000	43	BIT21 EQU 0x00200000
44	BIT22 EQU 0x00400000	44	BIT22 EQU 0x00400000
45	BIT23 EQU 0x00800000	45	BIT23 EQU 0x00800000
46	BIT24 EQU 0x00100000	46	BIT24 EQU 0x00100000
47	BIT25 EQU 0x02000000	47	BIT25 EQU 0x02000000
48	BIT26 EQU 0x04000000	48	BIT26 EQU 0x04000000
49	BIT27 EQU 0x08000000	49	BIT27 EQU 0x08000000
50	BIT28 EQU 0x10000000	50	BIT28 EQU 0x10000000
51	BIT29 EQU 0x20000000	51	BIT29 EQU 0x20000000
52	BIT30 EQU 0x40000000	52	BIT30 EQU 0x40000000
53	BIT31 EQU 0x80000000	53	BIT31 EQU 0x80000000
54		54
55		55
56	PCM_OUT_BDL equ 0x10 ; PCM out buffer descriptors list	56	PCM_OUT_BDL equ 0x10 ; PCM out buffer descriptors list
57	PCM_OUT_CR_REG equ 0x1b ; PCM out Control Register	57	PCM_OUT_CR_REG equ 0x1b ; PCM out Control Register
58	PCM_OUT_LVI_REG equ 0x15 ; PCM last valid index	58	PCM_OUT_LVI_REG equ 0x15 ; PCM last valid index
59	PCM_OUT_SR_REG equ 0x16 ; PCM out Status register	59	PCM_OUT_SR_REG equ 0x16 ; PCM out Status register
60	PCM_OUT_PIV_REG equ 0x1a	60	PCM_OUT_PIV_REG equ 0x1a
61	PCM_OUT_CIV_REG equ 0x14 ; PCM out current index	61	PCM_OUT_CIV_REG equ 0x14 ; PCM out current index
62		62
63	PCM_IN_CR_REG equ 0x0b ; PCM in Control Register	63	PCM_IN_CR_REG equ 0x0b ; PCM in Control Register
64	MC_IN_CR_REG equ 0x2b ; MIC in Control Register	64	MC_IN_CR_REG equ 0x2b ; MIC in Control Register
65	RR equ BIT1 ; reset registers. Nukes all regs	65	RR equ BIT1 ; reset registers. Nukes all regs
66		66
67	CODEC_MASTER_VOL_REG equ 0x02	67	CODEC_MASTER_VOL_REG equ 0x02
68	CODEC_AUX_VOL equ 0x04 ;	68	CODEC_AUX_VOL equ 0x04 ;
69	CODEC_PCM_OUT_REG equ 18h ; PCM output volume	69	CODEC_PCM_OUT_REG equ 18h ; PCM output volume
70	CODEC_EXT_AUDIO_REG equ 28h ; extended audio	70	CODEC_EXT_AUDIO_REG equ 28h ; extended audio
71	CODEC_EXT_AUDIO_CTRL_REG equ 2ah ; extended audio control	71	CODEC_EXT_AUDIO_CTRL_REG equ 2ah ; extended audio control
72	CODEC_PCM_FRONT_DACRATE_REG equ 2ch ; PCM out sample rate	72	CODEC_PCM_FRONT_DACRATE_REG equ 2ch ; PCM out sample rate
73	CODEC_PCM_SURND_DACRATE_REG equ 2eh ; surround sound sample rate	73	CODEC_PCM_SURND_DACRATE_REG equ 2eh ; surround sound sample rate
74	CODEC_PCM_LFE_DACRATE_REG equ 30h ; LFE sample rate	74	CODEC_PCM_LFE_DACRATE_REG equ 30h ; LFE sample rate
75		75
76	GLOB_CTRL equ 0x2C ; Global Control	76	GLOB_CTRL equ 0x2C ; Global Control
77	CTRL_STAT equ 0x30 ; Global Status	77	CTRL_STAT equ 0x30 ; Global Status
78	CTRL_CAS equ 0x34 ; Codec Access Semiphore	78	CTRL_CAS equ 0x34 ; Codec Access Semiphore
79		79
80	CAS_FLAG equ 0x01 ; Codec Access Semiphore Bit	80	CAS_FLAG equ 0x01 ; Codec Access Semiphore Bit
81		81
82	CTRL_ST_CREADY equ BIT8+BIT9+BIT28 ; Primary Codec Ready	82	CTRL_ST_CREADY equ BIT8+BIT9+BIT28 ; Primary Codec Ready
83		83
84	CTRL_ST_RCS equ 0x00008000 ; Read Completion Status	84	CTRL_ST_RCS equ 0x00008000 ; Read Completion Status
85		85
86	CTRL_CNT_CRIE equ BIT4+BIT5+BIT6 ; Codecs Resume Interrupt Enable	86	CTRL_CNT_CRIE equ BIT4+BIT5+BIT6 ; Codecs Resume Interrupt Enable
87	CTRL_CNT_AC_OFF equ 0x00000008 ; ACLINK Off	87	CTRL_CNT_AC_OFF equ 0x00000008 ; ACLINK Off
88	CTRL_CNT_WARM equ 0x00000004 ; AC97 Warm Reset	88	CTRL_CNT_WARM equ 0x00000004 ; AC97 Warm Reset
89	CTRL_CNT_COLD equ 0x00000002 ; AC97 Cold Reset	89	CTRL_CNT_COLD equ 0x00000002 ; AC97 Cold Reset
90	CTRL_CNT_GIE equ 0x00000001 ; GPI Interrupt Enable	90	CTRL_CNT_GIE equ 0x00000001 ; GPI Interrupt Enable
91		91
92	CODEC_REG_POWERDOWN equ 0x26	92	CODEC_REG_POWERDOWN equ 0x26
93	CODEC_REG_ST equ 0x26	93	CODEC_REG_ST equ 0x26
94		94
95	DEV_PLAY equ 1	95	DEV_PLAY equ 1
96	DEV_STOP equ 2	96	DEV_STOP equ 2
97	DEV_CALLBACK equ 3	97	DEV_CALLBACK equ 3
98	DEV_SET_BUFF equ 4	98	DEV_SET_BUFF equ 4
99	DEV_NOTIFY equ 5	99	DEV_NOTIFY equ 5
100	DEV_SET_MASTERVOL equ 6	100	DEV_SET_MASTERVOL equ 6
101	DEV_GET_MASTERVOL equ 7	101	DEV_GET_MASTERVOL equ 7
102	DEV_GET_INFO equ 8	102	DEV_GET_INFO equ 8
103		103
104	struc AC_CNTRL ;AC controller base class	104	struc AC_CNTRL ;AC controller base class
105	{ .bus dd ?	105	{ .bus dd ?
106	.devfn dd ?	106	.devfn dd ?
107		107
108	.vendor dd ?	108	.vendor dd ?
109	.dev_id dd ?	109	.dev_id dd ?
110	.pci_cmd dd ?	110	.pci_cmd dd ?
111	.pci_stat dd ?	111	.pci_stat dd ?
112		112
113	.codec_io_base dd ?	113	.codec_io_base dd ?
114	.codec_mem_base dd ?	114	.codec_mem_base dd ?
115		115
116	.ctrl_io_base dd ?	116	.ctrl_io_base dd ?
117	.ctrl_mem_base dd ?	117	.ctrl_mem_base dd ?
118	.cfg_reg dd ?	118	.cfg_reg dd ?
119	.int_line dd ?	119	.int_line dd ?
120		120
121	.vendor_ids dd ? ;vendor id string	121	.vendor_ids dd ? ;vendor id string
122	.ctrl_ids dd ? ;hub id string	122	.ctrl_ids dd ? ;hub id string
123		123
124	.buffer dd ?	124	.buffer dd ?
125		125
126	.notify_pos dd ?	126	.notify_pos dd ?
127	.notify_task dd ?	127	.notify_task dd ?
128		128
129	.lvi_reg dd ?	129	.lvi_reg dd ?
130	.ctrl_setup dd ?	130	.ctrl_setup dd ?
131	.user_callback dd ?	131	.user_callback dd ?
132	.codec_read16 dd ?	132	.codec_read16 dd ?
133	.codec_write16 dd ?	133	.codec_write16 dd ?
134		134
135	.ctrl_read8 dd ?	135	.ctrl_read8 dd ?
136	.ctrl_read16 dd ?	136	.ctrl_read16 dd ?
137	.ctrl_read32 dd ?	137	.ctrl_read32 dd ?
138		138
139	.ctrl_write8 dd ?	139	.ctrl_write8 dd ?
140	.ctrl_write16 dd ?	140	.ctrl_write16 dd ?
141	.ctrl_write32 dd ?	141	.ctrl_write32 dd ?
142	}	142	}
143		143
144	struc CODEC ;Audio Chip base class	144	struc CODEC ;Audio Chip base class
145	{	145	{
146	.chip_id dd ?	146	.chip_id dd ?
147	.flags dd ?	147	.flags dd ?
148	.status dd ?	148	.status dd ?
149		149
150	.ac_vendor_ids dd ? ;ac vendor id string	150	.ac_vendor_ids dd ? ;ac vendor id string
151	.chip_ids dd ? ;chip model string	151	.chip_ids dd ? ;chip model string
152		152
153	.shadow_flag dd ?	153	.shadow_flag dd ?
154	dd ?	154	dd ?
155		155
156	.regs dw ? ; codec registers	156	.regs dw ? ; codec registers
157	.reg_master_vol dw ? ;0x02	157	.reg_master_vol dw ? ;0x02
158	.reg_aux_out_vol dw ? ;0x04	158	.reg_aux_out_vol dw ? ;0x04
159	.reg_mone_vol dw ? ;0x06	159	.reg_mone_vol dw ? ;0x06
160	.reg_master_tone dw ? ;0x08	160	.reg_master_tone dw ? ;0x08
161	.reg_beep_vol dw ? ;0x0A	161	.reg_beep_vol dw ? ;0x0A
162	.reg_phone_vol dw ? ;0x0C	162	.reg_phone_vol dw ? ;0x0C
163	.reg_mic_vol dw ? ;0x0E	163	.reg_mic_vol dw ? ;0x0E
164	.reg_line_in_vol dw ? ;0x10	164	.reg_line_in_vol dw ? ;0x10
165	.reg_cd_vol dw ? ;0x12	165	.reg_cd_vol dw ? ;0x12
166	.reg_video_vol dw ? ;0x14	166	.reg_video_vol dw ? ;0x14
167	.reg_aux_in_vol dw ? ;0x16	167	.reg_aux_in_vol dw ? ;0x16
168	.reg_pcm_out_vol dw ? ;0x18	168	.reg_pcm_out_vol dw ? ;0x18
169	.reg_rec_select dw ? ;0x1A	169	.reg_rec_select dw ? ;0x1A
170	.reg_rec_gain dw ? ;0x1C	170	.reg_rec_gain dw ? ;0x1C
171	.reg_rec_gain_mic dw ? ;0x1E	171	.reg_rec_gain_mic dw ? ;0x1E
172	.reg_gen dw ? ;0x20	172	.reg_gen dw ? ;0x20
173	.reg_3d_ctrl dw ? ;0X22	173	.reg_3d_ctrl dw ? ;0X22
174	.reg_page dw ? ;0X24	174	.reg_page dw ? ;0X24
175	.reg_powerdown dw ? ;0x26	175	.reg_powerdown dw ? ;0x26
176	.reg_ext_audio dw ? ;0x28	176	.reg_ext_audio dw ? ;0x28
177	.reg_ext_st dw ? ;0x2a	177	.reg_ext_st dw ? ;0x2a
178	.reg_pcm_front_rate dw ? ;0x2c	178	.reg_pcm_front_rate dw ? ;0x2c
179	.reg_pcm_surr_rate dw ? ;0x2e	179	.reg_pcm_surr_rate dw ? ;0x2e
180	.reg_lfe_rate dw ? ;0x30	180	.reg_lfe_rate dw ? ;0x30
181	.reg_pcm_in_rate dw ? ;0x32	181	.reg_pcm_in_rate dw ? ;0x32
182	dw ? ;0x34	182	dw ? ;0x34
183	.reg_cent_lfe_vol dw ? ;0x36	183	.reg_cent_lfe_vol dw ? ;0x36
184	.reg_surr_vol dw ? ;0x38	184	.reg_surr_vol dw ? ;0x38
185	.reg_spdif_ctrl dw ? ;0x3A	185	.reg_spdif_ctrl dw ? ;0x3A
186	dw ? ;0x3C	186	dw ? ;0x3C
187	dw ? ;0x3E	187	dw ? ;0x3E
188	dw ? ;0x40	188	dw ? ;0x40
189	dw ? ;0x42	189	dw ? ;0x42
190	dw ? ;0x44	190	dw ? ;0x44
191	dw ? ;0x46	191	dw ? ;0x46
192	dw ? ;0x48	192	dw ? ;0x48
193	dw ? ;0x4A	193	dw ? ;0x4A
194	dw ? ;0x4C	194	dw ? ;0x4C
195	dw ? ;0x4E	195	dw ? ;0x4E
196	dw ? ;0x50	196	dw ? ;0x50
197	dw ? ;0x52	197	dw ? ;0x52
198	dw ? ;0x54	198	dw ? ;0x54
199	dw ? ;0x56	199	dw ? ;0x56
200	dw ? ;0x58	200	dw ? ;0x58
201	dw ? ;0x5A	201	dw ? ;0x5A
202	dw ? ;0x5C	202	dw ? ;0x5C
203	dw ? ;0x5E	203	dw ? ;0x5E
204	.reg_page_0 dw ? ;0x60	204	.reg_page_0 dw ? ;0x60
205	.reg_page_1 dw ? ;0x62	205	.reg_page_1 dw ? ;0x62
206	.reg_page_2 dw ? ;0x64	206	.reg_page_2 dw ? ;0x64
207	.reg_page_3 dw ? ;0x66	207	.reg_page_3 dw ? ;0x66
208	.reg_page_4 dw ? ;0x68	208	.reg_page_4 dw ? ;0x68
209	.reg_page_5 dw ? ;0x6A	209	.reg_page_5 dw ? ;0x6A
210	.reg_page_6 dw ? ;0x6C	210	.reg_page_6 dw ? ;0x6C
211	.reg_page_7 dw ? ;0x6E	211	.reg_page_7 dw ? ;0x6E
212	dw ? ;0x70	212	dw ? ;0x70
213	dw ? ;0x72	213	dw ? ;0x72
214	dw ? ;0x74	214	dw ? ;0x74
215	dw ? ;0x76	215	dw ? ;0x76
216	dw ? ;0x78	216	dw ? ;0x78
217	dw ? ;0x7A	217	dw ? ;0x7A
218	.reg_vendor_id_1 dw ? ;0x7C	218	.reg_vendor_id_1 dw ? ;0x7C
219	.reg_vendor_id_2 dw ? ;0x7E	219	.reg_vendor_id_2 dw ? ;0x7E
220		220
221		221
222	.reset dd ? ;virual	222	.reset dd ? ;virual
223	.set_master_vol dd ?	223	.set_master_vol dd ?
224	}	224	}
225		225
226	struc CTRL_INFO	226	struc CTRL_INFO
227	{ .pci_cmd dd ?	227	{ .pci_cmd dd ?
228	.irq dd ?	228	.irq dd ?
229	.glob_cntrl dd ?	229	.glob_cntrl dd ?
230	.glob_sta dd ?	230	.glob_sta dd ?
231	.codec_io_base dd ?	231	.codec_io_base dd ?
232	.ctrl_io_base dd ?	232	.ctrl_io_base dd ?
233	.codec_mem_base dd ?	233	.codec_mem_base dd ?
234	.ctrl_mem_base dd ?	234	.ctrl_mem_base dd ?
235	.codec_id dd ?	235	.codec_id dd ?
236	}	236	}
237		237
238	struc IOCTL	238	struc IOCTL
239	{ .handle dd ?	239	{ .handle dd ?
240	.io_code dd ?	240	.io_code dd ?
241	.input dd ?	241	.input dd ?
242	.inp_size dd ?	242	.inp_size dd ?
243	.output dd ?	243	.output dd ?
244	.out_size dd ?	244	.out_size dd ?
245	}	245	}
246		246
247	virtual at 0	247	virtual at 0
248	IOCTL IOCTL	248	IOCTL IOCTL
249	end virtual	249	end virtual
250		250
251	EVENT_NOTIFY equ 0x00000200	251	EVENT_NOTIFY equ 0x00000200
252		252
253	OS_BASE equ 0;	253	OS_BASE equ 0;
254	SLOT_BASE equ OS_BASE+0x0080000	254	SLOT_BASE equ OS_BASE+0x0080000
255	new_app_base equ 0x80000000	255	new_app_base equ 0x80000000
256		256
257	public START	257	public START
258	public service_proc	258	public service_proc
259	public version	259	public version
260		260
261	section '.flat' code readable align 16	261	section '.flat' code readable align 16
262		262
263	proc START stdcall, state:dword	263	proc START stdcall, state:dword
264		264
265	cmp [state], 1	265	cmp [state], 1
266	jne .stop	266	jne .stop
267		267
268	if DEBUG	268	if DEBUG
269	mov esi, msgDetect	269	mov esi, msgDetect
270	call SysMsgBoardStr	270	call SysMsgBoardStr
271	end if	271	end if
272		272
273	call detect_controller	273	call detect_controller
274	test eax, eax	274	test eax, eax
275	jz .fail	275	jz .fail
276		276
277	if DEBUG	277	if DEBUG
278	mov esi,[ctrl.vendor_ids]	278	mov esi,[ctrl.vendor_ids]
279	call SysMsgBoardStr	279	call SysMsgBoardStr
280	mov esi, [ctrl.ctrl_ids]	280	mov esi, [ctrl.ctrl_ids]
281	call SysMsgBoardStr	281	call SysMsgBoardStr
282		282
283	end if	283	end if
284	call init_controller	284	call init_controller
285	test eax, eax	285	test eax, eax
286	jz .fail	286	jz .fail
287	jmp .fail ;force fail	287
288		-
-		288	jmp .fail ;force fail
289		289
290	if DEBUG	290	if DEBUG
291	mov esi, msgInitCodec	291	mov esi, msgInitCodec
292	call SysMsgBoardStr	292	call SysMsgBoardStr
293	end if	293	end if
294		294
295	call init_codec	295	call init_codec
296	test eax, eax	296	test eax, eax
297	jz .fail	297	jz .fail
298		298
299	if DEBUG	299	if DEBUG
300	mov esi, [codec.ac_vendor_ids]	300	mov esi, [codec.ac_vendor_ids]
301	call SysMsgBoardStr	301	call SysMsgBoardStr
302		302
303	mov esi, [codec.chip_ids]	303	mov esi, [codec.chip_ids]
304	call SysMsgBoardStr	304	call SysMsgBoardStr
305	end if	305	end if
306		306
307	call reset_controller	307	call reset_controller
308	call setup_codec	308	call setup_codec
309		309
310	mov esi, msgPrimBuff	310	mov esi, msgPrimBuff
311	call SysMsgBoardStr	311	call SysMsgBoardStr
312		312
313	call create_primary_buff	313	call create_primary_buff
314		314
315	mov eax, VALID_IRQ	315	mov eax, VALID_IRQ
316	mov ebx, [ctrl.int_line]	316	mov ebx, [ctrl.int_line]
317	mov esi, msgInvIRQ	317	mov esi, msgInvIRQ
318	bt eax, ebx	318	bt eax, ebx
319	jnc .fail	319	jnc .fail
320	mov eax, ATTCH_IRQ	320	mov eax, ATTCH_IRQ
321	mov esi, msgAttchIRQ	321	mov esi, msgAttchIRQ
322	bt eax, ebx	322	bt eax, ebx
323	jnc .fail	323	jnc .fail
324		324
325	stdcall AttachIntHandler, ebx, ac97_irq	325	stdcall AttachIntHandler, ebx, ac97_irq
326	stdcall RegService, sz_sound_srv, service_proc	326	stdcall RegService, sz_sound_srv, service_proc
327	ret	327	ret
328	.fail:	328	.fail:
329	if DEBUG	329	if DEBUG
330	mov esi, msgFail	330	mov esi, msgFail
331	call SysMsgBoardStr	331	call SysMsgBoardStr
332	end if	332	end if
333	xor eax, eax	333	xor eax, eax
334	ret	334	ret
335	.stop:	335	.stop:
336	call stop	336	call stop
337	xor eax, eax	337	xor eax, eax
338	ret	338	ret
339	endp	339	endp
340		340
341	handle equ IOCTL.handle	341	handle equ IOCTL.handle
342	io_code equ IOCTL.io_code	342	io_code equ IOCTL.io_code
343	input equ IOCTL.input	343	input equ IOCTL.input
344	inp_size equ IOCTL.inp_size	344	inp_size equ IOCTL.inp_size
345	output equ IOCTL.output	345	output equ IOCTL.output
346	out_size equ IOCTL.out_size	346	out_size equ IOCTL.out_size
347		347
348	align 4	348	align 4
349	proc service_proc stdcall, ioctl:dword	349	proc service_proc stdcall, ioctl:dword
350		350
351	mov edi, [ioctl]	351	mov edi, [ioctl]
352	mov eax, [edi+io_code]	352	mov eax, [edi+io_code]
353	cmp eax, DEV_PLAY	353	cmp eax, DEV_PLAY
354	jne @F	354	jne @F
355	if DEBUG	355	if DEBUG
356	mov esi, msgPlay	356	mov esi, msgPlay
357	call SysMsgBoardStr	357	call SysMsgBoardStr
358	end if	358	end if
359	call play	359	call play
360	ret	360	ret
361	@@:	361	@@:
362	cmp eax, DEV_STOP	362	cmp eax, DEV_STOP
363	jne @F	363	jne @F
364	if DEBUG	364	if DEBUG
365	mov esi, msgStop	365	mov esi, msgStop
366	call SysMsgBoardStr	366	call SysMsgBoardStr
367	end if	367	end if
368	call stop	368	call stop
369	ret	369	ret
370	@@:	370	@@:
371	cmp eax, DEV_CALLBACK	371	cmp eax, DEV_CALLBACK
372	jne @F	372	jne @F
373	mov ebx, [edi+input]	373	mov ebx, [edi+input]
374	stdcall set_callback, [ebx]	374	stdcall set_callback, [ebx]
375	ret	375	ret
376	@@:	376	@@:
377	cmp eax, DEV_SET_MASTERVOL	377	cmp eax, DEV_SET_MASTERVOL
378	jne @F	378	jne @F
379	mov eax, [edi+input]	379	mov eax, [edi+input]
380	mov eax, [eax]	380	mov eax, [eax]
381	call set_master_vol ;eax= vol	381	call set_master_vol ;eax= vol
382	ret	382	ret
383	@@:	383	@@:
384	cmp eax, DEV_GET_MASTERVOL	384	cmp eax, DEV_GET_MASTERVOL
385	jne @F	385	jne @F
386	mov ebx, [edi+output]	386	mov ebx, [edi+output]
387	add ebx, new_app_base	387	add ebx, new_app_base
388	stdcall get_master_vol, ebx	388	stdcall get_master_vol, ebx
389	ret	389	ret
390	;@@:	390	;@@:
391	; cmp eax, DEV_GET_INFO	391	; cmp eax, DEV_GET_INFO
392	; jne @F	392	; jne @F
393	; mov ebx, [edi+output]	393	; mov ebx, [edi+output]
394	; stdcall get_dev_info, ebx	394	; stdcall get_dev_info, ebx
395	; ret	395	; ret
396	@@:	396	@@:
397	.fail:	397	.fail:
398	or eax, -1	398	or eax, -1
399	ret	399	ret
400	endp	400	endp
401		401
402	restore handle	402	restore handle
403	restore io_code	403	restore io_code
404	restore input	404	restore input
405	restore inp_size	405	restore inp_size
406	restore output	406	restore output
407	restore out_size	407	restore out_size
408		408
409		409
410	align 4	410	align 4
411	proc ac97_irq	411	proc ac97_irq
412		412
413	; if DEBUG	413	; if DEBUG
414	; mov esi, msgIRQ	414	; mov esi, msgIRQ
415	; call SysMsgBoardStr	415	; call SysMsgBoardStr
416	; end if	416	; end if
417		417
418		418
419	cmp [ctrl.user_callback], 0	419	cmp [ctrl.user_callback], 0
420	je @f	420	je @f
421		421
422	stdcall [ctrl.user_callback], ebx	422	stdcall [ctrl.user_callback], ebx
423	@@:	423	@@:
424	ret	424	ret
425		425
426	.skip:	426	.skip:
427	mov edx, PCM_OUT_CR_REG	427	mov edx, PCM_OUT_CR_REG
428	mov ax, 0x11 ;0x1D	428	mov ax, 0x11 ;0x1D
429	call [ctrl.ctrl_write8]	429	call [ctrl.ctrl_write8]
430	ret	430	ret
431	endp	431	endp
432		432
433	align 4	433	align 4
434	proc create_primary_buff	434	proc create_primary_buff
435		435
436	stdcall KernelAlloc, 0x10000	436	stdcall KernelAlloc, 0x10000
437	mov [ctrl.buffer], eax	437	mov [ctrl.buffer], eax
438		438
439	mov edi, eax	439	mov edi, eax
440	mov ecx, 0x10000/4	440	mov ecx, 0x10000/4
441	xor eax, eax	441	xor eax, eax
442	cld	442	cld
443	rep stosd	443	rep stosd
444		444
445	mov eax, [ctrl.buffer]	445	mov eax, [ctrl.buffer]
446	call GetPgAddr	446	call GetPgAddr
447		447
448	mov ebx, 0xC0002000	448	mov ebx, 0xC0002000
449	mov ecx, 4	449	mov ecx, 4
450	mov edi, pcmout_bdl	450	mov edi, pcmout_bdl
451	@@:	451	@@:
452	mov [edi], eax	452	mov [edi], eax
453	mov [edi+4], ebx	453	mov [edi+4], ebx
454		454
455	mov [edi+32], eax	455	mov [edi+32], eax
456	mov [edi+4+32], ebx	456	mov [edi+4+32], ebx
457		457
458	mov [edi+64], eax	458	mov [edi+64], eax
459	mov [edi+4+64], ebx	459	mov [edi+4+64], ebx
460		460
461	mov [edi+96], eax	461	mov [edi+96], eax
462	mov [edi+4+96], ebx	462	mov [edi+4+96], ebx
463		463
464	mov [edi+128], eax	464	mov [edi+128], eax
465	mov [edi+4+128], ebx	465	mov [edi+4+128], ebx
466		466
467	mov [edi+160], eax	467	mov [edi+160], eax
468	mov [edi+4+160], ebx	468	mov [edi+4+160], ebx
469		469
470	mov [edi+192], eax	470	mov [edi+192], eax
471	mov [edi+4+192], ebx	471	mov [edi+4+192], ebx
472		472
473	mov [edi+224], eax	473	mov [edi+224], eax
474	mov [edi+4+224], ebx	474	mov [edi+4+224], ebx
475		475
476	add eax, 0x4000	476	add eax, 0x4000
477	add edi, 8	477	add edi, 8
478	loop @B	478	loop @B
479		479
480	mov edi, buff_list	480	mov edi, buff_list
481	mov eax, [ctrl.buffer]	481	mov eax, [ctrl.buffer]
482	mov ecx, 4	482	mov ecx, 4
483	@@:	483	@@:
484	mov [edi], eax	484	mov [edi], eax
485	mov [edi+16], eax	485	mov [edi+16], eax
486	mov [edi+32], eax	486	mov [edi+32], eax
487	mov [edi+48], eax	487	mov [edi+48], eax
488	mov [edi+64], eax	488	mov [edi+64], eax
489	mov [edi+80], eax	489	mov [edi+80], eax
490	mov [edi+96], eax	490	mov [edi+96], eax
491	mov [edi+112], eax	491	mov [edi+112], eax
492		492
493	add eax, 0x4000	493	add eax, 0x4000
494	add edi, 4	494	add edi, 4
495	loop @B	495	loop @B
496		496
497	mov eax, pcmout_bdl	497	mov eax, pcmout_bdl
498	mov ebx, eax	498	mov ebx, eax
499	call GetPgAddr ;eax	499	call GetPgAddr ;eax

Subversion Repositories Kolibri OS

(root)/kernel/trunk/drivers/ensoniq.asm – Rev 406 → 412