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


;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;;                                                              ;;
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
;; Distributed under terms of the GNU General Public License    ;;
;;                                                              ;;
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 
format MS COFF
 
DEBUG           equ 1
DEBUG_IRQ       equ 0
 
include 'proc32.inc'
include 'imports.inc'
 
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 ?
}
 
struc IOCTL
{  .handle            dd ?
   .io_code           dd ?
   .input             dd ?
   .inp_size          dd ?
   .output            dd ?
   .out_size          dd ?
}
 
virtual at 0
  IOCTL IOCTL
end virtual
 
EVENT_NOTIFY      equ 0x00000200
 
public START
public service_proc
public version
 
section '.flat' code readable align 16
 
proc START stdcall, state:dword
 
        cmp     [state], 1
        jne     .stop
 
     if DEBUG
        mov     eax, START
        call    dword2str
        call    SysMsgBoardStr
        mov     esi, msgInit
        call    SysMsgBoardStr
     end if
 
        call    detect_controller
        test    eax, eax
        jz      .fail
 
     if DEBUG
        mov     esi, [ctrl.vendor_ids]
        call    SysMsgBoardStr
        mov     esi, [ctrl.ctrl_ids]
        call    SysMsgBoardStr
 
     end if
 
        call    init_controller
        test    eax, eax
        jz      .fail
 
        call    init_codec
        test    eax, eax
        jz      .fail
 
        call    reset_controller
        call    setup_codec
 
        mov     esi, msgPrimBuff
        call    SysMsgBoardStr
        call    create_primary_buff
 
        mov     esi, msgDone
        call    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
 
        stdcall AttachIntHandler, ebx, ac97_irq, dword 0
.reg:
 
        stdcall RegService, sz_sound_srv, service_proc
        ret
.fail:
   if DEBUG
        mov     esi, msgFail
        call    SysMsgBoardStr
   end if
        xor     eax, eax
        ret
.fail_msg:
        call    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
        call    SysMsgBoardStr
     end if
        call    play
        ret
@@:
        cmp     eax, DEV_STOP
        jne     @F
     if DEBUG
        mov     esi, msgStop
        call    SysMsgBoardStr
     end if
        call    stop
        ret
@@:
        cmp     eax, DEV_CALLBACK
        jne     @F
        mov     ebx, [edi+input]
        stdcall set_callback, [ebx]
        ret
@@:
        cmp     eax, DEV_SET_MASTERVOL
        jne     @F
        mov     eax, [edi+input]
        mov     eax, [eax]
        call    set_master_vol      ;eax= vol
        ret
@@:
        cmp     eax, DEV_GET_MASTERVOL
        jne     @F
        mov     ebx, [edi+output]
        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
        call    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
 
        stdcall KernelAlloc, 0x10000
        mov     [ctrl.buffer], eax
 
        mov     edi, eax
        mov     ecx, 0x10000/4
        xor     eax, eax
        cld
        rep stosd
 
        mov     eax, [ctrl.buffer]
        call    GetPgAddr
        mov     [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
        call    PciApi
        cmp     eax, -1
        je      .err
 
        mov     [last_bus], eax
 
.next_bus:
        and     [devfn], 0
.next_dev:
        stdcall PciRead32, [bus], [devfn], dword 0
        test    eax, eax
        jz      .next
        cmp     eax, -1
        je      .next
 
        push    eax
        stdcall 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
 
        stdcall PciRead32, [ctrl.bus], [ctrl.devfn], dword 4
        mov     ebx, eax
        and     eax, 0xFFFF
        mov     [ctrl.pci_cmd], eax
        shr     ebx, 16
        mov     [ctrl.pci_stat], ebx
 
        mov     esi, msgPciCmd
        call    SysMsgBoardStr
        call    dword2str
        call    SysMsgBoardStr
 
        mov     esi, msgPciStat
        call    SysMsgBoardStr
        mov     eax, [ctrl.pci_stat]
        call    dword2str
        call    SysMsgBoardStr
 
        mov     esi, msgCtrlIsaIo
        call    SysMsgBoardStr
 
        stdcall PciRead32, [ctrl.bus], [ctrl.devfn], dword 0x10
 
        call    dword2str
        call    SysMsgBoardStr
 
        and     eax, 0xFFFE
        mov     [ctrl.ctrl_io_base], eax
 
        mov     esi, msgIrqNum
        call    SysMsgBoardStr
 
        stdcall PciRead32, [ctrl.bus], [ctrl.devfn], dword 0x3C
        and     eax, 0xFF
        mov     [ctrl.int_line], eax
 
        call    dword2str
        call    SysMsgBoardStr
 
        call    [ctrl.ctrl_setup]
        xor     eax, eax
        inc     eax
        ret
endp
 
align 4
proc set_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
        call    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
        call    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
 
version      dd (5 shl 16) or (API_VERSION and 0xFFFF)
 
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
 
section '.data' data readable writable align 16
 
codec CODEC
ctrl AC_CNTRL
 
int_flip_flop      rd 1
buffer_pgaddr      rd 1

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

Subversion Repositories Kolibri OS

(root)/kernel/trunk/drivers/fm801.asm – Rev 2288 → 2455