forked from KolibriOS/kolibrios
1063 lines
24 KiB
NASM
1063 lines
24 KiB
NASM
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
|
;; ;;
|
|
;; Copyright (C) KolibriOS team 2004-2007. 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
|