WebSVN – Kolibri OS – Diff – /drivers/audio/fm801.asm


;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;;                                                              ;;
;; Copyright (C) KolibriOS team 2004-2015. All rights reserved. ;;
;; Distributed under terms of the GNU General Public License    ;;
;;                                                              ;;
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 
format PE DLL native 0.05
entry START
 
DEBUG           equ 1
DEBUG_IRQ       equ 0
 
API_VERSION     equ 0x01000100
 
USE_COM_IRQ     equ 0    ;make irq 3 and irq 4 available for PCI devices
 
;irq 0,1,2,8,12,13 недоступны
;                   FEDCBA9876543210
VALID_IRQ       equ 1100111011111000b
ATTCH_IRQ       equ 0000111010100000b
 
if USE_COM_IRQ
ATTCH_IRQ       equ 0000111010111000b
end if
 
CPU_FREQ        equ  2000d
 
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
 
VID_FM801         equ 0x1319
CTRL_FM801        equ 0x0801
 
FM_PCM_VOLUME         equ 0x00
FM_FM_VOLUME          equ 0x02
FM_I2S_VOLUME         equ 0x04
FM_RECORD_SOURCE      equ 0x06
 
FM_PLAY_CTL           equ 0x08
FM_PLAY_RATE_MASK     equ 0x0f00
FM_PLAY_BUF1_LAST     equ 0x0001
FM_PLAY_BUF2_LAST     equ 0x0002
FM_PLAY_START         equ 0x0020
FM_PLAY_PAUSE         equ 0x0040
FM_PLAY_STOPNOW       equ 0x0080
FM_PLAY_16BIT         equ 0x4000
FM_PLAY_STEREO        equ 0x8000
 
FM_PLAY_DMALEN        equ 0x0a
FM_PLAY_DMABUF1       equ 0x0c
FM_PLAY_DMABUF2       equ 0x10
 
FM_REC_CTL            equ 0x14
FM_REC_RATE_MASK      equ 0x0f00
FM_REC_BUF1_LAST      equ 0x0001
FM_REC_BUF2_LAST      equ 0x0002
FM_REC_START          equ 0x0020
FM_REC_PAUSE          equ 0x0040
FM_REC_STOPNOW        equ 0x0080
FM_REC_16BIT          equ 0x4000
FM_REC_STEREO         equ 0x8000
 
FM_REC_DMALEN         equ 0x16
FM_REC_DMABUF1        equ 0x18
FM_REC_DMABUF2        equ 0x1c
 
FM_CODEC_CTL          equ 0x22
FM_VOLUME             equ 0x26
FM_VOLUME_MUTE        equ 0x8000
 
FM_CODEC_CMD          equ 0x2a
FM_CODEC_CMD_READ     equ 0x0080
FM_CODEC_CMD_VALID    equ 0x0100
FM_CODEC_CMD_BUSY     equ 0x0200
 
FM_CODEC_DATA         equ 0x2c
 
FM_IO_CTL             equ 0x52
FM_CARD_CTL           equ 0x54
 
FM_INTMASK            equ 0x56
FM_INTMASK_PLAY       equ 0x0001
FM_INTMASK_REC        equ 0x0002
FM_INTMASK_VOL        equ 0x0040
FM_INTMASK_MPU        equ 0x0080
 
FM_INTSTATUS          equ 0x5a
FM_INTSTATUS_PLAY     equ 0x0100
FM_INTSTATUS_REC      equ 0x0200
FM_INTSTATUS_VOL      equ 0x4000
FM_INTSTATUS_MPU      equ 0x8000
 
CODEC_MASTER_VOL_REG         equ 0x02 ;
CODEC_AUX_VOL                equ 0x04 ;
CODEC_PCM_OUT_REG            equ 0x18 ; PCM output volume
CODEC_EXT_AUDIO_REG          equ 0x28 ; extended audio
CODEC_EXT_AUDIO_CTRL_REG     equ 0x2a ; extended audio control
CODEC_PCM_FRONT_DACRATE_REG  equ 0x2c ; PCM out sample rate
CODEC_PCM_SURND_DACRATE_REG  equ 0x2e ; surround sound sample rate
CODEC_PCM_LFE_DACRATE_REG    equ 0x30 ; LFE sample rate
 
SRV_GETVERSION        equ  0
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 ?
}
 
EVENT_NOTIFY      equ 0x00000200
 
section '.flat' code readable writable executable
include '../struct.inc'
include '../macros.inc'
include '../proc32.inc'
include '../peimport.inc'
 
proc START c uses ebx esi edi, state:dword, cmdline:dword
 
        cmp     [state], 1
        jne     .stop
 
     if DEBUG
        mov     eax, START
        call    dword2str
        invoke  SysMsgBoardStr
        mov     esi, msgInit
        invoke  SysMsgBoardStr
     end if
 
        call    detect_controller
        test    eax, eax
        jz      .fail
 
     if DEBUG
        mov     esi, [ctrl.vendor_ids]
        invoke  SysMsgBoardStr
        mov     esi, [ctrl.ctrl_ids]
        invoke  SysMsgBoardStr
 
     end if
 
        call    init_controller
        test    eax, eax
        jz      .fail
 
        call    init_codec
        test    eax, eax
        jz      .fail
 
        call    reset_controller
        call    setup_codec
 
        mov     esi, msgPrimBuff
        invoke  SysMsgBoardStr
        call    create_primary_buff
 
        mov     esi, msgDone
        invoke  SysMsgBoardStr
 
        mov     eax, VALID_IRQ
        mov     ebx, [ctrl.int_line]
        mov     esi, msgInvIRQ
        bt      eax, ebx
        jnc     .fail_msg
        mov     eax, ATTCH_IRQ
        mov     esi, msgAttchIRQ
        bt      eax, ebx
        jnc     .fail_msg
 
        invoke  AttachIntHandler, ebx, ac97_irq, dword 0
.reg:
 
        invoke  RegService, sz_sound_srv, service_proc
        ret
.fail:
   if DEBUG
        mov     esi, msgFail
        invoke  SysMsgBoardStr
   end if
        xor     eax, eax
        ret
.fail_msg:
        invoke  SysMsgBoardStr
        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, SRV_GETVERSION
        jne     @F
 
        mov     eax, [edi+output]
        cmp     [edi+out_size], 4
        jne     .fail
 
        mov     [eax], dword API_VERSION
        xor     eax, eax
        ret
@@:
        cmp     eax, DEV_PLAY
        jne     @F
     if DEBUG
        mov     esi, msgPlay
        invoke  SysMsgBoardStr
     end if
        call    play
        ret
@@:
        cmp     eax, DEV_STOP
        jne     @F
     if DEBUG
        mov     esi, msgStop
        invoke  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]
        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 fill_buffer
 
        cmp     [ctrl.user_callback], 0
        je      .exit
 
        mov     esi, [ctrl.buffer]
        mov     eax, int_flip_flop
        inc     dword [eax]
        test    dword [eax], 1
        je      @f
        add     esi, 0x4000
@@:
        stdcall [ctrl.user_callback], esi
 
        mov     edx, FM_PLAY_DMABUF1
        mov     eax, [buffer_pgaddr]
        mov     esi, int_flip_flop
        test    dword [esi], 1
        je      @f
        mov     edx, FM_PLAY_DMABUF2
        add     eax, 0x4000
@@:
        call    [ctrl.ctrl_write32]
 
.exit:
        ret
endp
 
align 4
proc ac97_irq
 
     if DEBUG_IRQ
        mov     esi, msgIRQ
        invoke  SysMsgBoardStr
     end if
 
        mov     edx, FM_INTSTATUS
        call    [ctrl.ctrl_read16]
 
        test    eax, FM_INTSTATUS_PLAY
        je      .exit
 
        push    eax
        call    fill_buffer
        pop     eax
 
.exit:
        mov     edx, FM_INTSTATUS
        call    [ctrl.ctrl_write16]
 
        ret
endp
 
align 4
proc create_primary_buff
 
        invoke  KernelAlloc, 0x10000
        mov     [ctrl.buffer], eax
 
        mov     edi, eax
        mov     ecx, 0x10000/4
        xor     eax, eax
        cld
        rep stosd
 
        mov     eax, [ctrl.buffer]
        invoke  GetPgAddr
        mov     [buffer_pgaddr], eax
 
        ret
endp
 
align 4
proc detect_controller
           locals
             last_bus dd ?
             bus      dd ?
             devfn    dd ?
           endl
 
        xor     eax, eax
        mov     [bus], eax
        inc     eax
        invoke  PciApi
        cmp     eax, -1
        je      .err
 
        mov     [last_bus], eax
 
.next_bus:
        and     [devfn], 0
.next_dev:
        invoke  PciRead32, [bus], [devfn], dword 0
        test    eax, eax
        jz      .next
        cmp     eax, -1
        je      .next
 
        push    eax
        invoke  PciRead32, [bus], [devfn], dword 0x09
        and     eax, 0xffffff
        cmp     eax, 0x060100 ;pci-isa
        jne     .no_bridge
 
        mov     eax, [bus]
        mov     [brg_bus], eax
        mov     eax, [devfn]
        mov     [brg_devfn], eax
.no_bridge:
        pop     eax
 
        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     [ctrl.vendor_ids], msg_FM
 
        mov     esi, [edi+8]
        mov     [ctrl.ctrl_setup], esi
        ret
.err:
        xor     eax, eax
        ret
endp
 
align 4
proc init_controller
 
        invoke  PciRead32, [ctrl.bus], [ctrl.devfn], 4
        mov     ebx, eax
        and     eax, 0xFFFF
        mov     [ctrl.pci_cmd], eax
        shr     ebx, 16
        mov     [ctrl.pci_stat], ebx
 
        mov     esi, msgPciCmd
        invoke  SysMsgBoardStr
        call    dword2str
        invoke  SysMsgBoardStr
 
        mov     esi, msgPciStat
        invoke  SysMsgBoardStr
        mov     eax, [ctrl.pci_stat]
        call    dword2str
        invoke  SysMsgBoardStr
 
        mov     esi, msgCtrlIsaIo
        invoke  SysMsgBoardStr
 
        invoke  PciRead32, [ctrl.bus], [ctrl.devfn], 0x10
 
        call    dword2str
        invoke  SysMsgBoardStr
 
        and     eax, 0xFFFE
        mov     [ctrl.ctrl_io_base], eax
 
        mov     esi, msgIrqNum
        invoke  SysMsgBoardStr
 
        invoke  PciRead32, [ctrl.bus], [ctrl.devfn], 0x3C
        and     eax, 0xFF
        mov     [ctrl.int_line], eax
 
        call    dword2str
        invoke  SysMsgBoardStr
 
        call    [ctrl.ctrl_setup]
        xor     eax, eax
        inc     eax
        ret
endp
 
align 4
proc set_FM
        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
 
        mov     esi, msgInitCtrl
        invoke  SysMsgBoardStr
 
        mov     edx, FM_CARD_CTL
        call    [ctrl.ctrl_read8]
        push    eax
        or      al, 1
        mov     edx, FM_CARD_CTL
        call    [ctrl.ctrl_write8]
        mov     eax, 10
        call    StallExec
        pop     eax
        and     al, 0xFE
        mov     edx, FM_CARD_CTL
        call    [ctrl.ctrl_write8]
        mov     eax, 10
        call    StallExec
 
        mov     eax, 0x0404
        mov     edx, FM_PCM_VOLUME
        call    [ctrl.ctrl_write16]
        mov     edx, FM_FM_VOLUME
        call    [ctrl.ctrl_write16]
        mov     edx, FM_I2S_VOLUME
        call    [ctrl.ctrl_write16]
 
        mov     edx, FM_INTMASK
        call    [ctrl.ctrl_read16]
        and     eax, not FM_INTMASK_PLAY
        or      eax, FM_INTMASK_REC or FM_INTMASK_MPU or FM_INTMASK_VOL
        mov     edx, FM_INTMASK
        call    [ctrl.ctrl_write16]
 
        mov     eax, FM_INTMASK_PLAY or FM_INTMASK_REC or FM_INTMASK_MPU or FM_INTMASK_VOL
        mov     edx, FM_INTSTATUS
        call    [ctrl.ctrl_write16]
 
        ret
endp
 
align 4
proc init_codec
 
        mov     esi, msgInitCodec
        invoke  SysMsgBoardStr
 
        mov     al, FM_CODEC_CMD_READ
        mov     edx, FM_CODEC_CMD
        call    [ctrl.ctrl_write8]
 
        call    reset_codec
 
        call    detect_codec
 
        xor     eax, eax
        inc     eax
        ret
endp
 
align 4
proc reset_codec
 
        mov     ecx, 255
.L1:
        mov     edx, FM_CODEC_CMD
        call    [ctrl.ctrl_read16]
        test    ah, FM_CODEC_CMD_VALID shr 8
        jne     .L2
        loop    .L1
.L2:
        mov     edx, FM_CODEC_CTL
        call    [ctrl.ctrl_read8]
        push    eax
        or      al, 0x20
        mov     edx, FM_CODEC_CTL
        call    [ctrl.ctrl_write8]
        pop     eax
        and     al, 0xDF
        mov     edx, FM_CODEC_CTL
        call    [ctrl.ctrl_write8]
 
        xor     eax, eax
        inc     eax
        ret
endp
 
align 4
play:
        mov     eax, 0x4000-1
        mov     edx, FM_PLAY_DMALEN
        call    [ctrl.ctrl_write16]
 
        call    fill_buffer
 
        mov     eax, FM_PLAY_START or FM_PLAY_STOPNOW or FM_PLAY_STEREO or FM_PLAY_16BIT or 0xA00
        mov     edx, FM_PLAY_CTL
        call    [ctrl.ctrl_write16]
 
        xor     eax, eax
        ret
 
align 4
stop:
        mov     edx, FM_PLAY_CTL
        call    [ctrl.ctrl_read16]
        and     eax, not (FM_PLAY_START or FM_PLAY_STOPNOW)
        or      eax, FM_PLAY_BUF1_LAST or FM_PLAY_BUF2_LAST
        mov     edx, FM_PLAY_CTL
        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     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
 
.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
 
        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
endp
 
align 4
proc check_semafore
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
proc codec_io_r16
 
        push    edx
        mov     ecx, 255
.L1:
        mov     edx, FM_CODEC_CMD
        call    [ctrl.ctrl_read16]
        test    ah, FM_CODEC_CMD_BUSY shr 8
        je      .L2
        loop    .L1
.L2:
        pop     eax
        or      al, FM_CODEC_CMD_READ
        mov     edx, FM_CODEC_CMD
        call    [ctrl.ctrl_write8]
 
        mov     ecx, 255
.L3:
        mov     edx, FM_CODEC_CMD
        call    [ctrl.ctrl_read16]
        test    ah, FM_CODEC_CMD_VALID shr 8
        jne     .L4
        loop    .L3
.L4:
        mov     edx, FM_CODEC_DATA
        call    [ctrl.ctrl_read16]
 
        ret
endp
 
align 4
proc codec_io_w16
 
        push    edx
        push    eax
        mov     ecx, 255
.L1:
        mov     edx, FM_CODEC_CMD
        call    [ctrl.ctrl_read16]
        test    ah, FM_CODEC_CMD_BUSY shr 8
        je      .L2
        loop    .L1
.L2:
        pop     eax
        mov     edx, FM_CODEC_DATA
        call    [ctrl.ctrl_write16]
 
        pop     eax
        mov     edx, FM_CODEC_CMD
        call    [ctrl.ctrl_write16]
 
        ret
endp
 
align 4
proc ctrl_io_r8
        add     edx, [ctrl.ctrl_io_base]
        in      al, dx
        ret
endp
 
align 4
proc ctrl_io_r16
        add     edx, [ctrl.ctrl_io_base]
        in      ax, dx
        ret
endp
 
align 4
proc ctrl_io_r32
        add     edx, [ctrl.ctrl_io_base]
        in      eax, dx
        ret
endp
 
align 4
proc ctrl_io_w8
        add     edx, [ctrl.ctrl_io_base]
        out     dx, al
        ret
endp
 
align 4
proc ctrl_io_w16
        add     edx, [ctrl.ctrl_io_base]
        out     dx, ax
        ret
endp
 
align 4
proc ctrl_io_w32
        add     edx, [ctrl.ctrl_io_base]
        out     dx, eax
        ret
endp
 
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
brg_bus      dd ?
brg_devfn    dd ?
include "codec.inc"
 
align 4
devices dd (CTRL_FM801 shl 16)+VID_FM801, msg_FM801, set_FM
        dd 0
 
msg_FM801    db 'FM801 AC97 controller',13,10, 0
msg_FM       db 'Forte Media',13,10, 0
 
sz_sound_srv db 'SOUND',0
 
msgInit       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 ...',0
msgDone       db 'done',13,10,0
;msgReg       db 'set service handler',13,10,0
;msgOk        db 'service installed',13,10,0
;msgStatus    db 'global status   ',0
;msgControl   db 'global control  ',0
msgPciCmd     db 'PCI command     ',0
msgPciStat    db 'PCI status      ',0
msgCtrlIsaIo  db 'controller io base   ',0
msgIrqNum     db 'IRQ default          ',0
;msgIrqMap    db 'AC97 irq map as      ',0
 
align 4
data fixups
end data
 
codec CODEC
ctrl AC_CNTRL
 
int_flip_flop      rd 1
buffer_pgaddr      rd 1

Rev 5077	Rev 5363
1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;	1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
2	;; ;;	2	;; ;;
3	;; Copyright (C) KolibriOS team 2004-2014. All rights reserved. ;;	3	;; Copyright (C) KolibriOS team 2004-2015. All rights reserved. ;;
4	;; Distributed under terms of the GNU General Public License ;;	4	;; Distributed under terms of the GNU General Public License ;;
5	;; ;;	5	;; ;;
6	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;	6	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
7		7
8	format PE DLL native 0.05	8	format PE DLL native 0.05
9	entry START	9	entry START
10		10
11	DEBUG equ 1	11	DEBUG equ 1
12	DEBUG_IRQ equ 0	12	DEBUG_IRQ equ 0
13		13
14	API_VERSION equ 0x01000100	14	API_VERSION equ 0x01000100
15		15
16	USE_COM_IRQ equ 0 ;make irq 3 and irq 4 available for PCI devices	16	USE_COM_IRQ equ 0 ;make irq 3 and irq 4 available for PCI devices
17		17
18	;irq 0,1,2,8,12,13 недоступны	18	;irq 0,1,2,8,12,13 недоступны
19	; FEDCBA9876543210	19	; FEDCBA9876543210
20	VALID_IRQ equ 1100111011111000b	20	VALID_IRQ equ 1100111011111000b
21	ATTCH_IRQ equ 0000111010100000b	21	ATTCH_IRQ equ 0000111010100000b
22		22
23	if USE_COM_IRQ	23	if USE_COM_IRQ
24	ATTCH_IRQ equ 0000111010111000b	24	ATTCH_IRQ equ 0000111010111000b
25	end if	25	end if
26		26
27	CPU_FREQ equ 2000d	27	CPU_FREQ equ 2000d
28		28
29	BIT0 EQU 0x00000001	29	BIT0 EQU 0x00000001
30	BIT1 EQU 0x00000002	30	BIT1 EQU 0x00000002
31	BIT2 EQU 0x00000004	31	BIT2 EQU 0x00000004
32	BIT3 EQU 0x00000008	32	BIT3 EQU 0x00000008
33	BIT4 EQU 0x00000010	33	BIT4 EQU 0x00000010
34	BIT5 EQU 0x00000020	34	BIT5 EQU 0x00000020
35	BIT6 EQU 0x00000040	35	BIT6 EQU 0x00000040
36	BIT7 EQU 0x00000080	36	BIT7 EQU 0x00000080
37	BIT8 EQU 0x00000100	37	BIT8 EQU 0x00000100
38	BIT9 EQU 0x00000200	38	BIT9 EQU 0x00000200
39	BIT10 EQU 0x00000400	39	BIT10 EQU 0x00000400
40	BIT11 EQU 0x00000800	40	BIT11 EQU 0x00000800
41	BIT12 EQU 0x00001000	41	BIT12 EQU 0x00001000
42	BIT13 EQU 0x00002000	42	BIT13 EQU 0x00002000
43	BIT14 EQU 0x00004000	43	BIT14 EQU 0x00004000
44	BIT15 EQU 0x00008000	44	BIT15 EQU 0x00008000
45	BIT16 EQU 0x00010000	45	BIT16 EQU 0x00010000
46	BIT17 EQU 0x00020000	46	BIT17 EQU 0x00020000
47	BIT18 EQU 0x00040000	47	BIT18 EQU 0x00040000
48	BIT19 EQU 0x00080000	48	BIT19 EQU 0x00080000
49	BIT20 EQU 0x00100000	49	BIT20 EQU 0x00100000
50	BIT21 EQU 0x00200000	50	BIT21 EQU 0x00200000
51	BIT22 EQU 0x00400000	51	BIT22 EQU 0x00400000
52	BIT23 EQU 0x00800000	52	BIT23 EQU 0x00800000
53	BIT24 EQU 0x00100000	53	BIT24 EQU 0x00100000
54	BIT25 EQU 0x02000000	54	BIT25 EQU 0x02000000
55	BIT26 EQU 0x04000000	55	BIT26 EQU 0x04000000
56	BIT27 EQU 0x08000000	56	BIT27 EQU 0x08000000
57	BIT28 EQU 0x10000000	57	BIT28 EQU 0x10000000
58	BIT29 EQU 0x20000000	58	BIT29 EQU 0x20000000
59	BIT30 EQU 0x40000000	59	BIT30 EQU 0x40000000
60	BIT31 EQU 0x80000000	60	BIT31 EQU 0x80000000
61		61
62	VID_FM801 equ 0x1319	62	VID_FM801 equ 0x1319
63	CTRL_FM801 equ 0x0801	63	CTRL_FM801 equ 0x0801
64		64
65	FM_PCM_VOLUME equ 0x00	65	FM_PCM_VOLUME equ 0x00
66	FM_FM_VOLUME equ 0x02	66	FM_FM_VOLUME equ 0x02
67	FM_I2S_VOLUME equ 0x04	67	FM_I2S_VOLUME equ 0x04
68	FM_RECORD_SOURCE equ 0x06	68	FM_RECORD_SOURCE equ 0x06
69		69
70	FM_PLAY_CTL equ 0x08	70	FM_PLAY_CTL equ 0x08
71	FM_PLAY_RATE_MASK equ 0x0f00	71	FM_PLAY_RATE_MASK equ 0x0f00
72	FM_PLAY_BUF1_LAST equ 0x0001	72	FM_PLAY_BUF1_LAST equ 0x0001
73	FM_PLAY_BUF2_LAST equ 0x0002	73	FM_PLAY_BUF2_LAST equ 0x0002
74	FM_PLAY_START equ 0x0020	74	FM_PLAY_START equ 0x0020
75	FM_PLAY_PAUSE equ 0x0040	75	FM_PLAY_PAUSE equ 0x0040
76	FM_PLAY_STOPNOW equ 0x0080	76	FM_PLAY_STOPNOW equ 0x0080
77	FM_PLAY_16BIT equ 0x4000	77	FM_PLAY_16BIT equ 0x4000
78	FM_PLAY_STEREO equ 0x8000	78	FM_PLAY_STEREO equ 0x8000
79		79
80	FM_PLAY_DMALEN equ 0x0a	80	FM_PLAY_DMALEN equ 0x0a
81	FM_PLAY_DMABUF1 equ 0x0c	81	FM_PLAY_DMABUF1 equ 0x0c
82	FM_PLAY_DMABUF2 equ 0x10	82	FM_PLAY_DMABUF2 equ 0x10
83		83
84	FM_REC_CTL equ 0x14	84	FM_REC_CTL equ 0x14
85	FM_REC_RATE_MASK equ 0x0f00	85	FM_REC_RATE_MASK equ 0x0f00
86	FM_REC_BUF1_LAST equ 0x0001	86	FM_REC_BUF1_LAST equ 0x0001
87	FM_REC_BUF2_LAST equ 0x0002	87	FM_REC_BUF2_LAST equ 0x0002
88	FM_REC_START equ 0x0020	88	FM_REC_START equ 0x0020
89	FM_REC_PAUSE equ 0x0040	89	FM_REC_PAUSE equ 0x0040
90	FM_REC_STOPNOW equ 0x0080	90	FM_REC_STOPNOW equ 0x0080
91	FM_REC_16BIT equ 0x4000	91	FM_REC_16BIT equ 0x4000
92	FM_REC_STEREO equ 0x8000	92	FM_REC_STEREO equ 0x8000
93		93
94	FM_REC_DMALEN equ 0x16	94	FM_REC_DMALEN equ 0x16
95	FM_REC_DMABUF1 equ 0x18	95	FM_REC_DMABUF1 equ 0x18
96	FM_REC_DMABUF2 equ 0x1c	96	FM_REC_DMABUF2 equ 0x1c
97		97
98	FM_CODEC_CTL equ 0x22	98	FM_CODEC_CTL equ 0x22
99	FM_VOLUME equ 0x26	99	FM_VOLUME equ 0x26
100	FM_VOLUME_MUTE equ 0x8000	100	FM_VOLUME_MUTE equ 0x8000
101		101
102	FM_CODEC_CMD equ 0x2a	102	FM_CODEC_CMD equ 0x2a
103	FM_CODEC_CMD_READ equ 0x0080	103	FM_CODEC_CMD_READ equ 0x0080
104	FM_CODEC_CMD_VALID equ 0x0100	104	FM_CODEC_CMD_VALID equ 0x0100
105	FM_CODEC_CMD_BUSY equ 0x0200	105	FM_CODEC_CMD_BUSY equ 0x0200
106		106
107	FM_CODEC_DATA equ 0x2c	107	FM_CODEC_DATA equ 0x2c
108		108
109	FM_IO_CTL equ 0x52	109	FM_IO_CTL equ 0x52
110	FM_CARD_CTL equ 0x54	110	FM_CARD_CTL equ 0x54
111		111
112	FM_INTMASK equ 0x56	112	FM_INTMASK equ 0x56
113	FM_INTMASK_PLAY equ 0x0001	113	FM_INTMASK_PLAY equ 0x0001
114	FM_INTMASK_REC equ 0x0002	114	FM_INTMASK_REC equ 0x0002
115	FM_INTMASK_VOL equ 0x0040	115	FM_INTMASK_VOL equ 0x0040
116	FM_INTMASK_MPU equ 0x0080	116	FM_INTMASK_MPU equ 0x0080
117		117
118	FM_INTSTATUS equ 0x5a	118	FM_INTSTATUS equ 0x5a
119	FM_INTSTATUS_PLAY equ 0x0100	119	FM_INTSTATUS_PLAY equ 0x0100
120	FM_INTSTATUS_REC equ 0x0200	120	FM_INTSTATUS_REC equ 0x0200
121	FM_INTSTATUS_VOL equ 0x4000	121	FM_INTSTATUS_VOL equ 0x4000
122	FM_INTSTATUS_MPU equ 0x8000	122	FM_INTSTATUS_MPU equ 0x8000
123		123
124	CODEC_MASTER_VOL_REG equ 0x02 ;	124	CODEC_MASTER_VOL_REG equ 0x02 ;
125	CODEC_AUX_VOL equ 0x04 ;	125	CODEC_AUX_VOL equ 0x04 ;
126	CODEC_PCM_OUT_REG equ 0x18 ; PCM output volume	126	CODEC_PCM_OUT_REG equ 0x18 ; PCM output volume
127	CODEC_EXT_AUDIO_REG equ 0x28 ; extended audio	127	CODEC_EXT_AUDIO_REG equ 0x28 ; extended audio
128	CODEC_EXT_AUDIO_CTRL_REG equ 0x2a ; extended audio control	128	CODEC_EXT_AUDIO_CTRL_REG equ 0x2a ; extended audio control
129	CODEC_PCM_FRONT_DACRATE_REG equ 0x2c ; PCM out sample rate	129	CODEC_PCM_FRONT_DACRATE_REG equ 0x2c ; PCM out sample rate
130	CODEC_PCM_SURND_DACRATE_REG equ 0x2e ; surround sound sample rate	130	CODEC_PCM_SURND_DACRATE_REG equ 0x2e ; surround sound sample rate
131	CODEC_PCM_LFE_DACRATE_REG equ 0x30 ; LFE sample rate	131	CODEC_PCM_LFE_DACRATE_REG equ 0x30 ; LFE sample rate
132		132
133	SRV_GETVERSION equ 0	133	SRV_GETVERSION equ 0
134	DEV_PLAY equ 1	134	DEV_PLAY equ 1
135	DEV_STOP equ 2	135	DEV_STOP equ 2
136	DEV_CALLBACK equ 3	136	DEV_CALLBACK equ 3
137	DEV_SET_BUFF equ 4	137	DEV_SET_BUFF equ 4
138	DEV_NOTIFY equ 5	138	DEV_NOTIFY equ 5
139	DEV_SET_MASTERVOL equ 6	139	DEV_SET_MASTERVOL equ 6
140	DEV_GET_MASTERVOL equ 7	140	DEV_GET_MASTERVOL equ 7
141	DEV_GET_INFO equ 8	141	DEV_GET_INFO equ 8
142		142
143	struc AC_CNTRL ;AC controller base class	143	struc AC_CNTRL ;AC controller base class
144	{ .bus dd ?	144	{ .bus dd ?
145	.devfn dd ?	145	.devfn dd ?
146		146
147	.vendor dd ?	147	.vendor dd ?
148	.dev_id dd ?	148	.dev_id dd ?
149	.pci_cmd dd ?	149	.pci_cmd dd ?
150	.pci_stat dd ?	150	.pci_stat dd ?
151		151
152	.codec_io_base dd ?	152	.codec_io_base dd ?
153	.codec_mem_base dd ?	153	.codec_mem_base dd ?
154		154
155	.ctrl_io_base dd ?	155	.ctrl_io_base dd ?
156	.ctrl_mem_base dd ?	156	.ctrl_mem_base dd ?
157	.cfg_reg dd ?	157	.cfg_reg dd ?
158	.int_line dd ?	158	.int_line dd ?
159		159
160	.vendor_ids dd ? ;vendor id string	160	.vendor_ids dd ? ;vendor id string
161	.ctrl_ids dd ? ;hub id string	161	.ctrl_ids dd ? ;hub id string
162		162
163	.buffer dd ?	163	.buffer dd ?
164		164
165	.notify_pos dd ?	165	.notify_pos dd ?
166	.notify_task dd ?	166	.notify_task dd ?
167		167
168	.lvi_reg dd ?	168	.lvi_reg dd ?
169	.ctrl_setup dd ?	169	.ctrl_setup dd ?
170	.user_callback dd ?	170	.user_callback dd ?
171	.codec_read16 dd ?	171	.codec_read16 dd ?
172	.codec_write16 dd ?	172	.codec_write16 dd ?
173		173
174	.ctrl_read8 dd ?	174	.ctrl_read8 dd ?
175	.ctrl_read16 dd ?	175	.ctrl_read16 dd ?
176	.ctrl_read32 dd ?	176	.ctrl_read32 dd ?
177		177
178	.ctrl_write8 dd ?	178	.ctrl_write8 dd ?
179	.ctrl_write16 dd ?	179	.ctrl_write16 dd ?
180	.ctrl_write32 dd ?	180	.ctrl_write32 dd ?
181	}	181	}
182		182
183	struc CODEC ;Audio Chip base class	183	struc CODEC ;Audio Chip base class
184	{	184	{
185	.chip_id dd ?	185	.chip_id dd ?
186	.flags dd ?	186	.flags dd ?
187	.status dd ?	187	.status dd ?
188		188
189	.ac_vendor_ids dd ? ;ac vendor id string	189	.ac_vendor_ids dd ? ;ac vendor id string
190	.chip_ids dd ? ;chip model string	190	.chip_ids dd ? ;chip model string
191		191
192	.shadow_flag dd ?	192	.shadow_flag dd ?
193	dd ?	193	dd ?
194		194
195	.regs dw ? ; codec registers	195	.regs dw ? ; codec registers
196	.reg_master_vol dw ? ;0x02	196	.reg_master_vol dw ? ;0x02
197	.reg_aux_out_vol dw ? ;0x04	197	.reg_aux_out_vol dw ? ;0x04
198	.reg_mone_vol dw ? ;0x06	198	.reg_mone_vol dw ? ;0x06
199	.reg_master_tone dw ? ;0x08	199	.reg_master_tone dw ? ;0x08
200	.reg_beep_vol dw ? ;0x0A	200	.reg_beep_vol dw ? ;0x0A
201	.reg_phone_vol dw ? ;0x0C	201	.reg_phone_vol dw ? ;0x0C
202	.reg_mic_vol dw ? ;0x0E	202	.reg_mic_vol dw ? ;0x0E
203	.reg_line_in_vol dw ? ;0x10	203	.reg_line_in_vol dw ? ;0x10
204	.reg_cd_vol dw ? ;0x12	204	.reg_cd_vol dw ? ;0x12
205	.reg_video_vol dw ? ;0x14	205	.reg_video_vol dw ? ;0x14
206	.reg_aux_in_vol dw ? ;0x16	206	.reg_aux_in_vol dw ? ;0x16
207	.reg_pcm_out_vol dw ? ;0x18	207	.reg_pcm_out_vol dw ? ;0x18
208	.reg_rec_select dw ? ;0x1A	208	.reg_rec_select dw ? ;0x1A
209	.reg_rec_gain dw ? ;0x1C	209	.reg_rec_gain dw ? ;0x1C
210	.reg_rec_gain_mic dw ? ;0x1E	210	.reg_rec_gain_mic dw ? ;0x1E
211	.reg_gen dw ? ;0x20	211	.reg_gen dw ? ;0x20
212	.reg_3d_ctrl dw ? ;0X22	212	.reg_3d_ctrl dw ? ;0X22
213	.reg_page dw ? ;0X24	213	.reg_page dw ? ;0X24
214	.reg_powerdown dw ? ;0x26	214	.reg_powerdown dw ? ;0x26
215	.reg_ext_audio dw ? ;0x28	215	.reg_ext_audio dw ? ;0x28
216	.reg_ext_st dw ? ;0x2a	216	.reg_ext_st dw ? ;0x2a
217	.reg_pcm_front_rate dw ? ;0x2c	217	.reg_pcm_front_rate dw ? ;0x2c
218	.reg_pcm_surr_rate dw ? ;0x2e	218	.reg_pcm_surr_rate dw ? ;0x2e
219	.reg_lfe_rate dw ? ;0x30	219	.reg_lfe_rate dw ? ;0x30
220	.reg_pcm_in_rate dw ? ;0x32	220	.reg_pcm_in_rate dw ? ;0x32
221	dw ? ;0x34	221	dw ? ;0x34
222	.reg_cent_lfe_vol dw ? ;0x36	222	.reg_cent_lfe_vol dw ? ;0x36
223	.reg_surr_vol dw ? ;0x38	223	.reg_surr_vol dw ? ;0x38
224	.reg_spdif_ctrl dw ? ;0x3A	224	.reg_spdif_ctrl dw ? ;0x3A
225	dw ? ;0x3C	225	dw ? ;0x3C
226	dw ? ;0x3E	226	dw ? ;0x3E
227	dw ? ;0x40	227	dw ? ;0x40
228	dw ? ;0x42	228	dw ? ;0x42
229	dw ? ;0x44	229	dw ? ;0x44
230	dw ? ;0x46	230	dw ? ;0x46
231	dw ? ;0x48	231	dw ? ;0x48
232	dw ? ;0x4A	232	dw ? ;0x4A
233	dw ? ;0x4C	233	dw ? ;0x4C
234	dw ? ;0x4E	234	dw ? ;0x4E
235	dw ? ;0x50	235	dw ? ;0x50
236	dw ? ;0x52	236	dw ? ;0x52
237	dw ? ;0x54	237	dw ? ;0x54
238	dw ? ;0x56	238	dw ? ;0x56
239	dw ? ;0x58	239	dw ? ;0x58
240	dw ? ;0x5A	240	dw ? ;0x5A
241	dw ? ;0x5C	241	dw ? ;0x5C
242	dw ? ;0x5E	242	dw ? ;0x5E
243	.reg_page_0 dw ? ;0x60	243	.reg_page_0 dw ? ;0x60
244	.reg_page_1 dw ? ;0x62	244	.reg_page_1 dw ? ;0x62
245	.reg_page_2 dw ? ;0x64	245	.reg_page_2 dw ? ;0x64
246	.reg_page_3 dw ? ;0x66	246	.reg_page_3 dw ? ;0x66
247	.reg_page_4 dw ? ;0x68	247	.reg_page_4 dw ? ;0x68
248	.reg_page_5 dw ? ;0x6A	248	.reg_page_5 dw ? ;0x6A
249	.reg_page_6 dw ? ;0x6C	249	.reg_page_6 dw ? ;0x6C
250	.reg_page_7 dw ? ;0x6E	250	.reg_page_7 dw ? ;0x6E
251	dw ? ;0x70	251	dw ? ;0x70
252	dw ? ;0x72	252	dw ? ;0x72
253	dw ? ;0x74	253	dw ? ;0x74
254	dw ? ;0x76	254	dw ? ;0x76
255	dw ? ;0x78	255	dw ? ;0x78
256	dw ? ;0x7A	256	dw ? ;0x7A
257	.reg_vendor_id_1 dw ? ;0x7C	257	.reg_vendor_id_1 dw ? ;0x7C
258	.reg_vendor_id_2 dw ? ;0x7E	258	.reg_vendor_id_2 dw ? ;0x7E
259		259
260		260
261	.reset dd ? ;virual	261	.reset dd ? ;virual
262	.set_master_vol dd ?	262	.set_master_vol dd ?
263	}	263	}
264		264
265	struc CTRL_INFO	265	struc CTRL_INFO
266	{ .pci_cmd dd ?	266	{ .pci_cmd dd ?
267	.irq dd ?	267	.irq dd ?
268	.glob_cntrl dd ?	268	.glob_cntrl dd ?
269	.glob_sta dd ?	269	.glob_sta dd ?
270	.codec_io_base dd ?	270	.codec_io_base dd ?
271	.ctrl_io_base dd ?	271	.ctrl_io_base dd ?
272	.codec_mem_base dd ?	272	.codec_mem_base dd ?
273	.ctrl_mem_base dd ?	273	.ctrl_mem_base dd ?
274	.codec_id dd ?	274	.codec_id dd ?
275	}	275	}
276		276
277	EVENT_NOTIFY equ 0x00000200	277	EVENT_NOTIFY equ 0x00000200
278		278
279	section '.flat' code readable writable executable	279	section '.flat' code readable writable executable
280	include '../struct.inc'	280	include '../struct.inc'
281	include '../macros.inc'	281	include '../macros.inc'
282	include '../proc32.inc'	282	include '../proc32.inc'
283	include '../peimport.inc'	283	include '../peimport.inc'
284		284
285	proc START c uses ebx esi edi, state:dword, cmdline:dword	285	proc START c uses ebx esi edi, state:dword, cmdline:dword
286		286
287	cmp [state], 1	287	cmp [state], 1
288	jne .stop	288	jne .stop
289		289
290	if DEBUG	290	if DEBUG
291	mov eax, START	291	mov eax, START
292	call dword2str	292	call dword2str
293	invoke SysMsgBoardStr	293	invoke SysMsgBoardStr
294	mov esi, msgInit	294	mov esi, msgInit
295	invoke SysMsgBoardStr	295	invoke SysMsgBoardStr
296	end if	296	end if
297		297
298	call detect_controller	298	call detect_controller
299	test eax, eax	299	test eax, eax
300	jz .fail	300	jz .fail
301		301
302	if DEBUG	302	if DEBUG
303	mov esi, [ctrl.vendor_ids]	303	mov esi, [ctrl.vendor_ids]
304	invoke SysMsgBoardStr	304	invoke SysMsgBoardStr
305	mov esi, [ctrl.ctrl_ids]	305	mov esi, [ctrl.ctrl_ids]
306	invoke SysMsgBoardStr	306	invoke SysMsgBoardStr
307		307
308	end if	308	end if
309		309
310	call init_controller	310	call init_controller
311	test eax, eax	311	test eax, eax
312	jz .fail	312	jz .fail
313		313
314	call init_codec	314	call init_codec
315	test eax, eax	315	test eax, eax
316	jz .fail	316	jz .fail
317		317
318	call reset_controller	318	call reset_controller
319	call setup_codec	319	call setup_codec
320		320
321	mov esi, msgPrimBuff	321	mov esi, msgPrimBuff
322	invoke SysMsgBoardStr	322	invoke SysMsgBoardStr
323	call create_primary_buff	323	call create_primary_buff
324		324
325	mov esi, msgDone	325	mov esi, msgDone
326	invoke SysMsgBoardStr	326	invoke SysMsgBoardStr
327		327
328	mov eax, VALID_IRQ	328	mov eax, VALID_IRQ
329	mov ebx, [ctrl.int_line]	329	mov ebx, [ctrl.int_line]
330	mov esi, msgInvIRQ	330	mov esi, msgInvIRQ
331	bt eax, ebx	331	bt eax, ebx
332	jnc .fail_msg	332	jnc .fail_msg
333	mov eax, ATTCH_IRQ	333	mov eax, ATTCH_IRQ
334	mov esi, msgAttchIRQ	334	mov esi, msgAttchIRQ
335	bt eax, ebx	335	bt eax, ebx
336	jnc .fail_msg	336	jnc .fail_msg
337		337
338	invoke AttachIntHandler, ebx, ac97_irq, dword 0	338	invoke AttachIntHandler, ebx, ac97_irq, dword 0
339	.reg:	339	.reg:
340		340
341	invoke RegService, sz_sound_srv, service_proc	341	invoke RegService, sz_sound_srv, service_proc
342	ret	342	ret
343	.fail:	343	.fail:
344	if DEBUG	344	if DEBUG
345	mov esi, msgFail	345	mov esi, msgFail
346	invoke SysMsgBoardStr	346	invoke SysMsgBoardStr
347	end if	347	end if
348	xor eax, eax	348	xor eax, eax
349	ret	349	ret
350	.fail_msg:	350	.fail_msg:
351	invoke SysMsgBoardStr	351	invoke SysMsgBoardStr
352	xor eax, eax	352	xor eax, eax
353	ret	353	ret
354	.stop:	354	.stop:
355	call stop	355	call stop
356	xor eax, eax	356	xor eax, eax
357	ret	357	ret
358	endp	358	endp
359		359
360	handle equ IOCTL.handle	360	handle equ IOCTL.handle
361	io_code equ IOCTL.io_code	361	io_code equ IOCTL.io_code
362	input equ IOCTL.input	362	input equ IOCTL.input
363	inp_size equ IOCTL.inp_size	363	inp_size equ IOCTL.inp_size
364	output equ IOCTL.output	364	output equ IOCTL.output
365	out_size equ IOCTL.out_size	365	out_size equ IOCTL.out_size
366		366
367	align 4	367	align 4
368	proc service_proc stdcall, ioctl:dword	368	proc service_proc stdcall, ioctl:dword
369		369
370	mov edi, [ioctl]	370	mov edi, [ioctl]
371	mov eax, [edi+io_code]	371	mov eax, [edi+io_code]
372		372
373	cmp eax, SRV_GETVERSION	373	cmp eax, SRV_GETVERSION
374	jne @F	374	jne @F
375		375
376	mov eax, [edi+output]	376	mov eax, [edi+output]
377	cmp [edi+out_size], 4	377	cmp [edi+out_size], 4
378	jne .fail	378	jne .fail
379		379
380	mov [eax], dword API_VERSION	380	mov [eax], dword API_VERSION
381	xor eax, eax	381	xor eax, eax
382	ret	382	ret
383	@@:	383	@@:
384	cmp eax, DEV_PLAY	384	cmp eax, DEV_PLAY
385	jne @F	385	jne @F
386	if DEBUG	386	if DEBUG
387	mov esi, msgPlay	387	mov esi, msgPlay
388	invoke SysMsgBoardStr	388	invoke SysMsgBoardStr
389	end if	389	end if
390	call play	390	call play
391	ret	391	ret
392	@@:	392	@@:
393	cmp eax, DEV_STOP	393	cmp eax, DEV_STOP
394	jne @F	394	jne @F
395	if DEBUG	395	if DEBUG
396	mov esi, msgStop	396	mov esi, msgStop
397	invoke SysMsgBoardStr	397	invoke SysMsgBoardStr
398	end if	398	end if
399	call stop	399	call stop
400	ret	400	ret
401	@@:	401	@@:
402	cmp eax, DEV_CALLBACK	402	cmp eax, DEV_CALLBACK
403	jne @F	403	jne @F
404	mov ebx, [edi+input]	404	mov ebx, [edi+input]
405	stdcall set_callback, [ebx]	405	stdcall set_callback, [ebx]
406	ret	406	ret
407	@@:	407	@@:
408	cmp eax, DEV_SET_MASTERVOL	408	cmp eax, DEV_SET_MASTERVOL
409	jne @F	409	jne @F
410	mov eax, [edi+input]	410	mov eax, [edi+input]
411	mov eax, [eax]	411	mov eax, [eax]
412	call set_master_vol ;eax= vol	412	call set_master_vol ;eax= vol
413	ret	413	ret
414	@@:	414	@@:
415	cmp eax, DEV_GET_MASTERVOL	415	cmp eax, DEV_GET_MASTERVOL
416	jne @F	416	jne @F
417	mov ebx, [edi+output]	417	mov ebx, [edi+output]
418	stdcall get_master_vol, ebx	418	stdcall get_master_vol, ebx
419	ret	419	ret
420	;@@:	420	;@@:
421	; cmp eax, DEV_GET_INFO	421	; cmp eax, DEV_GET_INFO
422	; jne @F	422	; jne @F
423	; mov ebx, [edi+output]	423	; mov ebx, [edi+output]
424	; stdcall get_dev_info, ebx	424	; stdcall get_dev_info, ebx
425	; ret	425	; ret
426	@@:	426	@@:
427	.fail:	427	.fail:
428	or eax, -1	428	or eax, -1
429	ret	429	ret
430	endp	430	endp
431		431
432	restore handle	432	restore handle
433	restore io_code	433	restore io_code
434	restore input	434	restore input
435	restore inp_size	435	restore inp_size
436	restore output	436	restore output
437	restore out_size	437	restore out_size
438		438
439	align 4	439	align 4
440	proc fill_buffer	440	proc fill_buffer
441		441
442	cmp [ctrl.user_callback], 0	442	cmp [ctrl.user_callback], 0
443	je .exit	443	je .exit
444		444
445	mov esi, [ctrl.buffer]	445	mov esi, [ctrl.buffer]
446	mov eax, int_flip_flop	446	mov eax, int_flip_flop
447	inc dword [eax]	447	inc dword [eax]
448	test dword [eax], 1	448	test dword [eax], 1
449	je @f	449	je @f
450	add esi, 0x4000	450	add esi, 0x4000
451	@@:	451	@@:
452	stdcall [ctrl.user_callback], esi	452	stdcall [ctrl.user_callback], esi
453		453
454	mov edx, FM_PLAY_DMABUF1	454	mov edx, FM_PLAY_DMABUF1
455	mov eax, [buffer_pgaddr]	455	mov eax, [buffer_pgaddr]
456	mov esi, int_flip_flop	456	mov esi, int_flip_flop
457	test dword [esi], 1	457	test dword [esi], 1
458	je @f	458	je @f
459	mov edx, FM_PLAY_DMABUF2	459	mov edx, FM_PLAY_DMABUF2
460	add eax, 0x4000	460	add eax, 0x4000
461	@@:	461	@@:
462	call [ctrl.ctrl_write32]	462	call [ctrl.ctrl_write32]
463		463
464	.exit:	464	.exit:
465	ret	465	ret
466	endp	466	endp
467		467
468	align 4	468	align 4
469	proc ac97_irq	469	proc ac97_irq
470		470
471	if DEBUG_IRQ	471	if DEBUG_IRQ
472	mov esi, msgIRQ	472	mov esi, msgIRQ
473	invoke SysMsgBoardStr	473	invoke SysMsgBoardStr
474	end if	474	end if
475		475
476	mov edx, FM_INTSTATUS	476	mov edx, FM_INTSTATUS
477	call [ctrl.ctrl_read16]	477	call [ctrl.ctrl_read16]
478		478
479	test eax, FM_INTSTATUS_PLAY	479	test eax, FM_INTSTATUS_PLAY
480	je .exit	480	je .exit
481		481
482	push eax	482	push eax
483	call fill_buffer	483	call fill_buffer
484	pop eax	484	pop eax
485		485
486	.exit:	486	.exit:
487	mov edx, FM_INTSTATUS	487	mov edx, FM_INTSTATUS
488	call [ctrl.ctrl_write16]	488	call [ctrl.ctrl_write16]
489		489
490	ret	490	ret
491	endp	491	endp
492		492
493	align 4	493	align 4
494	proc create_primary_buff	494	proc create_primary_buff
495		495
496	invoke KernelAlloc, 0x10000	496	invoke KernelAlloc, 0x10000
497	mov [ctrl.buffer], eax	497	mov [ctrl.buffer], eax
498		498
499	mov edi, eax	499	mov edi, eax
500	mov ecx, 0x10000/4	500	mov ecx, 0x10000/4

Subversion Repositories Kolibri OS

(root)/drivers/audio/fm801.asm – Rev 5077 → 5363