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

Subversion Repositories Kolibri OS

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