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


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

Subversion Repositories Kolibri OS

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