WebSVN – Kolibri OS – Blame – /kernel/trunk/drivers/ensoniq.asm

Rev	Author	Line No.	Line
2288	clevermous	1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		2	;; ;;
2455	mario79	3	;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
2288	clevermous	4	;; Distributed under terms of the GNU General Public License ;;
		5	;; ;;
		6	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		7
		8	;alpha version
		9
		10	format MS COFF
		11
		12	DEBUG equ 1
		13
		14
		15	include 'proc32.inc'
		16	include 'imports.inc'
		17
		18	REMAP_IRQ equ 0
		19
		20	;irq 0,1,2,8,12,13 ��
		21	; FEDCBA9876543210
		22	VALID_IRQ equ 1100111011111000b
		23	ATTCH_IRQ equ 0000111010101000b
		24
		25	IRQ_LINE equ 0
		26
		27	CPU_FREQ equ 2600d
		28
		29	BIT0 EQU 0x00000001
		30	BIT1 EQU 0x00000002
		31	BIT2 EQU 0x00000004
		32	BIT3 EQU 0x00000008
		33	BIT4 EQU 0x00000010
		34	BIT5 EQU 0x00000020
		35	BIT6 EQU 0x00000040
		36	BIT7 EQU 0x00000080
		37	BIT8 EQU 0x00000100
		38	BIT9 EQU 0x00000200
		39	BIT10 EQU 0x00000400
		40	BIT11 EQU 0x00000800
		41	BIT12 EQU 0x00001000
		42	BIT13 EQU 0x00002000
		43	BIT14 EQU 0x00004000
		44	BIT15 EQU 0x00008000
		45	BIT16 EQU 0x00010000
		46	BIT17 EQU 0x00020000
		47	BIT18 EQU 0x00040000
		48	BIT19 EQU 0x00080000
		49	BIT20 EQU 0x00100000
		50	BIT21 EQU 0x00200000
		51	BIT22 EQU 0x00400000
		52	BIT23 EQU 0x00800000
		53	BIT24 EQU 0x00100000
		54	BIT25 EQU 0x02000000
		55	BIT26 EQU 0x04000000
		56	BIT27 EQU 0x08000000
		57	BIT28 EQU 0x10000000
		58	BIT29 EQU 0x20000000
		59	BIT30 EQU 0x40000000
		60	BIT31 EQU 0x80000000
		61
		62
		63	PCM_OUT_BDL equ 0x10 ; PCM out buffer descriptors list
		64	PCM_OUT_CR_REG equ 0x1b ; PCM out Control Register
		65	PCM_OUT_LVI_REG equ 0x15 ; PCM last valid index
		66	PCM_OUT_SR_REG equ 0x16 ; PCM out Status register
		67	PCM_OUT_PIV_REG equ 0x1a
		68	PCM_OUT_CIV_REG equ 0x14 ; PCM out current index
		69
		70	PCM_IN_CR_REG equ 0x0b ; PCM in Control Register
		71	MC_IN_CR_REG equ 0x2b ; MIC in Control Register
		72	RR equ BIT1 ; reset registers. Nukes all regs
		73
		74	CODEC_MASTER_VOL_REG equ 0x02
		75	CODEC_AUX_VOL equ 0x04 ;
		76	CODEC_PCM_OUT_REG equ 18h ; PCM output volume
		77	CODEC_EXT_AUDIO_REG equ 28h ; extended audio
		78	CODEC_EXT_AUDIO_CTRL_REG equ 2ah ; extended audio control
		79	CODEC_PCM_FRONT_DACRATE_REG equ 2ch ; PCM out sample rate
		80	CODEC_PCM_SURND_DACRATE_REG equ 2eh ; surround sound sample rate
		81	CODEC_PCM_LFE_DACRATE_REG equ 30h ; LFE sample rate
		82
		83	GLOB_CTRL equ 0x2C ; Global Control
		84	CTRL_STAT equ 0x30 ; Global Status
		85	CTRL_CAS equ 0x34 ; Codec Access Semiphore
		86
		87	CAS_FLAG equ 0x01 ; Codec Access Semiphore Bit
		88
		89	CTRL_ST_CREADY equ BIT8+BIT9+BIT28 ; Primary Codec Ready
		90
		91	CTRL_ST_RCS equ 0x00008000 ; Read Completion Status
		92
		93	CTRL_CNT_CRIE equ BIT4+BIT5+BIT6 ; Codecs Resume Interrupt Enable
		94	CTRL_CNT_AC_OFF equ 0x00000008 ; ACLINK Off
		95	CTRL_CNT_WARM equ 0x00000004 ; AC97 Warm Reset
		96	CTRL_CNT_COLD equ 0x00000002 ; AC97 Cold Reset
		97	CTRL_CNT_GIE equ 0x00000001 ; GPI Interrupt Enable
		98
		99	CODEC_REG_POWERDOWN equ 0x26
		100	CODEC_REG_ST equ 0x26
		101
		102	DEV_PLAY equ 1
		103	DEV_STOP equ 2
		104	DEV_CALLBACK equ 3
		105	DEV_SET_BUFF equ 4
		106	DEV_NOTIFY equ 5
		107	DEV_SET_MASTERVOL equ 6
		108	DEV_GET_MASTERVOL equ 7
		109	DEV_GET_INFO equ 8
		110
		111	struc AC_CNTRL ;AC controller base class
		112	{ .bus dd ?
		113	.devfn dd ?
		114
		115	.vendor dd ?
		116	.dev_id dd ?
		117	.pci_cmd dd ?
		118	.pci_stat dd ?
		119
		120	.codec_io_base dd ?
		121	.codec_mem_base dd ?
		122
		123	.ctrl_io_base dd ?
		124	.ctrl_mem_base dd ?
		125	.cfg_reg dd ?
		126	.int_line dd ?
		127
		128	.vendor_ids dd ? ;vendor id string
		129	.ctrl_ids dd ? ;hub id string
		130
		131	.buffer dd ?
		132
		133	.notify_pos dd ?
		134	.notify_task dd ?
		135
		136	.lvi_reg dd ?
		137	.ctrl_setup dd ?
		138	.user_callback dd ?
		139	.codec_read16 dd ?
		140	.codec_write16 dd ?
		141
		142	.ctrl_read8 dd ?
		143	.ctrl_read16 dd ?
		144	.ctrl_read32 dd ?
		145
		146	.ctrl_write8 dd ?
		147	.ctrl_write16 dd ?
		148	.ctrl_write32 dd ?
		149	}
		150
		151	struc CODEC ;Audio Chip base class
		152	{
		153	.chip_id dd ?
		154	.flags dd ?
		155	.status dd ?
		156
		157	.ac_vendor_ids dd ? ;ac vendor id string
		158	.chip_ids dd ? ;chip model string
		159
		160	.shadow_flag dd ?
		161	dd ?
		162
		163	.regs dw ? ; codec registers
		164	.reg_master_vol dw ? ;0x02
		165	.reg_aux_out_vol dw ? ;0x04
		166	.reg_mone_vol dw ? ;0x06
		167	.reg_master_tone dw ? ;0x08
		168	.reg_beep_vol dw ? ;0x0A
		169	.reg_phone_vol dw ? ;0x0C
		170	.reg_mic_vol dw ? ;0x0E
		171	.reg_line_in_vol dw ? ;0x10
		172	.reg_cd_vol dw ? ;0x12
		173	.reg_video_vol dw ? ;0x14
		174	.reg_aux_in_vol dw ? ;0x16
		175	.reg_pcm_out_vol dw ? ;0x18
		176	.reg_rec_select dw ? ;0x1A
		177	.reg_rec_gain dw ? ;0x1C
		178	.reg_rec_gain_mic dw ? ;0x1E
		179	.reg_gen dw ? ;0x20
		180	.reg_3d_ctrl dw ? ;0X22
		181	.reg_page dw ? ;0X24
		182	.reg_powerdown dw ? ;0x26
		183	.reg_ext_audio dw ? ;0x28
		184	.reg_ext_st dw ? ;0x2a
		185	.reg_pcm_front_rate dw ? ;0x2c
		186	.reg_pcm_surr_rate dw ? ;0x2e
		187	.reg_lfe_rate dw ? ;0x30
		188	.reg_pcm_in_rate dw ? ;0x32
		189	dw ? ;0x34
		190	.reg_cent_lfe_vol dw ? ;0x36
		191	.reg_surr_vol dw ? ;0x38
		192	.reg_spdif_ctrl dw ? ;0x3A
		193	dw ? ;0x3C
		194	dw ? ;0x3E
		195	dw ? ;0x40
		196	dw ? ;0x42
		197	dw ? ;0x44
		198	dw ? ;0x46
		199	dw ? ;0x48
		200	dw ? ;0x4A
		201	dw ? ;0x4C
		202	dw ? ;0x4E
		203	dw ? ;0x50
		204	dw ? ;0x52
		205	dw ? ;0x54
		206	dw ? ;0x56
		207	dw ? ;0x58
		208	dw ? ;0x5A
		209	dw ? ;0x5C
		210	dw ? ;0x5E
		211	.reg_page_0 dw ? ;0x60
		212	.reg_page_1 dw ? ;0x62
		213	.reg_page_2 dw ? ;0x64
		214	.reg_page_3 dw ? ;0x66
		215	.reg_page_4 dw ? ;0x68
		216	.reg_page_5 dw ? ;0x6A
		217	.reg_page_6 dw ? ;0x6C
		218	.reg_page_7 dw ? ;0x6E
		219	dw ? ;0x70
		220	dw ? ;0x72
		221	dw ? ;0x74
		222	dw ? ;0x76
		223	dw ? ;0x78
		224	dw ? ;0x7A
		225	.reg_vendor_id_1 dw ? ;0x7C
		226	.reg_vendor_id_2 dw ? ;0x7E
		227
		228
		229	.reset dd ? ;virual
		230	.set_master_vol dd ?
		231	}
		232
		233	struc CTRL_INFO
		234	{ .pci_cmd dd ?
		235	.irq dd ?
		236	.glob_cntrl dd ?
		237	.glob_sta dd ?
		238	.codec_io_base dd ?
		239	.ctrl_io_base dd ?
		240	.codec_mem_base dd ?
		241	.ctrl_mem_base dd ?
		242	.codec_id dd ?
		243	}
		244
		245	struc IOCTL
		246	{ .handle dd ?
		247	.io_code dd ?
		248	.input dd ?
		249	.inp_size dd ?
		250	.output dd ?
		251	.out_size dd ?
		252	}
		253
		254	virtual at 0
		255	IOCTL IOCTL
		256	end virtual
		257
		258	EVENT_NOTIFY equ 0x00000200
		259
		260	OS_BASE equ 0x80000000
		261	SLOT_BASE equ OS_BASE+0x0080000
		262	new_app_base equ 0
		263
		264	public START
		265	public service_proc
		266	public version
		267
		268	section '.flat' code readable align 16
		269
		270	proc START stdcall, state:dword
		271
		272	cmp [state], 1
		273	jne .stop
		274
		275	if DEBUG
		276	mov esi, msgDetect
		277	call SysMsgBoardStr
		278	end if
		279
		280	call detect_controller
		281	test eax, eax
		282	jz .fail
		283
		284	if DEBUG
		285	mov esi, [ctrl.vendor_ids]
		286	call SysMsgBoardStr
		287	mov esi, [ctrl.ctrl_ids]
		288	call SysMsgBoardStr
		289
		290	end if
		291	call init_controller
		292	test eax, eax
		293	jz .fail
		294
		295	jmp .fail ;force fail
		296
		297	if DEBUG
		298	mov esi, msgInitCodec
		299	call SysMsgBoardStr
		300	end if
		301
		302	call init_codec
		303	test eax, eax
		304	jz .fail
		305
		306	if DEBUG
		307	mov esi, [codec.ac_vendor_ids]
		308	call SysMsgBoardStr
		309
		310	mov esi, [codec.chip_ids]
		311	call SysMsgBoardStr
		312	end if
		313
		314	call reset_controller
		315	call setup_codec
		316
		317	mov esi, msgPrimBuff
		318	call SysMsgBoardStr
		319
		320	call create_primary_buff
		321
		322	mov eax, VALID_IRQ
		323	mov ebx, [ctrl.int_line]
		324	mov esi, msgInvIRQ
		325	bt eax, ebx
		326	jnc .fail
		327	mov eax, ATTCH_IRQ
		328	mov esi, msgAttchIRQ
		329	bt eax, ebx
		330	jnc .fail
		331
		332	stdcall AttachIntHandler, ebx, ac97_irq, dword 0
		333	stdcall RegService, sz_sound_srv, service_proc
		334	ret
		335	.fail:
		336	if DEBUG
		337	mov esi, msgFail
		338	call SysMsgBoardStr
		339	end if
		340	xor eax, eax
		341	ret
		342	.stop:
		343	call stop
		344	xor eax, eax
		345	ret
		346	endp
		347
		348	handle equ IOCTL.handle
		349	io_code equ IOCTL.io_code
		350	input equ IOCTL.input
		351	inp_size equ IOCTL.inp_size
		352	output equ IOCTL.output
		353	out_size equ IOCTL.out_size
		354
		355	align 4
		356	proc service_proc stdcall, ioctl:dword
		357
		358	mov edi, [ioctl]
		359	mov eax, [edi+io_code]
		360	cmp eax, DEV_PLAY
		361	jne @F
		362	if DEBUG
		363	mov esi, msgPlay
		364	call SysMsgBoardStr
		365	end if
		366	call play
		367	ret
		368	@@:
		369	cmp eax, DEV_STOP
		370	jne @F
		371	if DEBUG
		372	mov esi, msgStop
		373	call SysMsgBoardStr
		374	end if
		375	call stop
		376	ret
		377	@@:
		378	cmp eax, DEV_CALLBACK
		379	jne @F
		380	mov ebx, [edi+input]
		381	stdcall set_callback, [ebx]
		382	ret
		383	@@:
		384	cmp eax, DEV_SET_MASTERVOL
		385	jne @F
		386	mov eax, [edi+input]
		387	mov eax, [eax]
		388	call set_master_vol ;eax= vol
		389	ret
		390	@@:
		391	cmp eax, DEV_GET_MASTERVOL
		392	jne @F
		393	mov ebx, [edi+output]
		394	stdcall get_master_vol, ebx
		395	ret
		396	;@@:
		397	; cmp eax, DEV_GET_INFO
		398	; jne @F
		399	; mov ebx, [edi+output]
		400	; stdcall get_dev_info, ebx
		401	; ret
		402	@@:
		403	.fail:
		404	or eax, -1
		405	ret
		406	endp
		407
		408	restore handle
		409	restore io_code
		410	restore input
		411	restore inp_size
		412	restore output
		413	restore out_size
		414
		415
		416	align 4
		417	proc ac97_irq
		418
		419	; if DEBUG
		420	; mov esi, msgIRQ
		421	; call SysMsgBoardStr
		422	; end if
		423
		424
		425	cmp [ctrl.user_callback], 0
		426	je @f
		427
		428	stdcall [ctrl.user_callback], ebx
		429	@@:
		430	ret
		431
		432	.skip:
		433	mov edx, PCM_OUT_CR_REG
		434	mov ax, 0x11 ;0x1D
		435	call [ctrl.ctrl_write8]
		436	ret
		437	endp
		438
		439	align 4
		440	proc create_primary_buff
		441
		442	stdcall KernelAlloc, 0x10000
		443	mov [ctrl.buffer], eax
		444
		445	mov edi, eax
		446	mov ecx, 0x10000/4
		447	xor eax, eax
		448	cld
		449	rep stosd
		450
		451	mov eax, [ctrl.buffer]
		452	call GetPgAddr
		453
		454	mov ebx, 0xC0002000
		455	mov ecx, 4
		456	mov edi, pcmout_bdl
		457	@@:
		458	mov [edi], eax
		459	mov [edi+4], ebx
		460
		461	mov [edi+32], eax
		462	mov [edi+4+32], ebx
		463
		464	mov [edi+64], eax
		465	mov [edi+4+64], ebx
		466
		467	mov [edi+96], eax
		468	mov [edi+4+96], ebx
		469
		470	mov [edi+128], eax
		471	mov [edi+4+128], ebx
		472
		473	mov [edi+160], eax
		474	mov [edi+4+160], ebx
		475
		476	mov [edi+192], eax
		477	mov [edi+4+192], ebx
		478
		479	mov [edi+224], eax
		480	mov [edi+4+224], ebx
		481
		482	add eax, 0x4000
		483	add edi, 8
		484	loop @B
		485
		486	mov edi, buff_list
		487	mov eax, [ctrl.buffer]
		488	mov ecx, 4
		489	@@:
		490	mov [edi], eax
		491	mov [edi+16], eax
		492	mov [edi+32], eax
		493	mov [edi+48], eax
		494	mov [edi+64], eax
		495	mov [edi+80], eax
		496	mov [edi+96], eax
		497	mov [edi+112], eax
		498
		499	add eax, 0x4000
		500	add edi, 4
		501	loop @B
		502
		503	mov eax, pcmout_bdl
		504	mov ebx, eax
		505	call GetPgAddr ;eax
		506	and ebx, 0xFFF
		507	add eax, ebx
		508
		509	mov edx, PCM_OUT_BDL
		510	call [ctrl.ctrl_write32]
		511
		512	mov eax, 16
		513	mov [ctrl.lvi_reg], eax
		514	mov edx, PCM_OUT_LVI_REG
		515	call [ctrl.ctrl_write8]
		516	ret
		517	endp
		518
		519	align 4
		520	proc detect_controller
		521	locals
		522	last_bus dd ?
		523	bus dd ?
		524	devfn dd ?
		525	endl
		526
		527	xor eax, eax
		528	mov [bus], eax
		529	inc eax
		530	call PciApi
		531	cmp eax, -1
		532	je .err
		533
		534	mov [last_bus], eax
		535
		536	.next_bus:
		537	and [devfn], 0
		538	.next_dev:
		539	stdcall PciRead32, [bus], [devfn], dword 0
		540	test eax, eax
		541	jz .next
		542	cmp eax, -1
		543	je .next
		544
		545	mov edi, devices
		546	@@:
		547	mov ebx, [edi]
		548	test ebx, ebx
		549	jz .next
		550
		551	cmp eax, ebx
		552	je .found
		553	add edi, 12
		554	jmp @B
		555
		556	.next:
		557	inc [devfn]
		558	cmp [devfn], 256
		559	jb .next_dev
		560	mov eax, [bus]
		561	inc eax
		562	mov [bus], eax
		563	cmp eax, [last_bus]
		564	jna .next_bus
		565	xor eax, eax
		566	ret
		567	.found:
		568	mov ebx, [bus]
		569	mov [ctrl.bus], ebx
		570
		571	mov ecx, [devfn]
		572	mov [ctrl.devfn], ecx
		573
		574	mov edx, eax
		575	and edx, 0xFFFF
		576	mov [ctrl.vendor], edx
		577	shr eax, 16
		578	mov [ctrl.dev_id], eax
		579
		580	mov ebx, [edi+4]
		581	mov [ctrl.ctrl_ids], ebx
		582	mov esi, [edi+8]
		583	mov [ctrl.ctrl_setup], esi
		584
		585	cmp ebx, 0x1274
		586	jne @F
		587	mov [ctrl.vendor_ids], msgEnsoniq
		588	ret
		589	@@:
		590	mov [ctrl.vendor_ids], 0 ;something wrong ?
		591	ret
		592	.err:
		593	xor eax, eax
		594	ret
		595	endp
		596
		597	align 4
		598	proc init_controller
		599
		600	mov esi, msgPCIcmd
		601	call SysMsgBoardStr
		602
		603	stdcall PciRead32, [ctrl.bus], [ctrl.devfn], dword 4
		604	mov ebx, eax
		605	and eax, 0xFFFF
		606	mov [ctrl.pci_cmd], eax
		607	shr ebx, 16
		608	mov [ctrl.pci_stat], ebx
		609
		610	call dword2str
		611	call SysMsgBoardStr
		612
		613	mov esi, msgIObase
		614	call SysMsgBoardStr
		615
		616	stdcall PciRead32, [ctrl.bus], [ctrl.devfn], dword 0x10
		617	; and eax, -16
		618	mov [ctrl.ctrl_io_base], eax
		619
		620	call dword2str
		621	call SysMsgBoardStr
		622
		623	mov esi, msgIRQline
		624	call SysMsgBoardStr
		625
		626	stdcall PciRead32, [ctrl.bus], [ctrl.devfn], dword 0x3C
		627	and eax, 0xFF
		628	mov [ctrl.int_line], eax
		629
		630	call dword2str
		631	call SysMsgBoardStr
		632
		633	call [ctrl.ctrl_setup]
		634	xor eax, eax
		635	inc eax
		636	ret
		637	endp
		638
		639	align 4
		640	proc set_ICH
		641	mov [ctrl.codec_read16], codec_io_r16 ;virtual
		642	mov [ctrl.codec_write16], codec_io_w16 ;virtual
		643
		644	mov [ctrl.ctrl_read8 ], ctrl_io_r8 ;virtual
		645	mov [ctrl.ctrl_read16], ctrl_io_r16 ;virtual
		646	mov [ctrl.ctrl_read32], ctrl_io_r32 ;virtual
		647
		648	mov [ctrl.ctrl_write8 ], ctrl_io_w8 ;virtual
		649	mov [ctrl.ctrl_write16], ctrl_io_w16 ;virtual
		650	mov [ctrl.ctrl_write32], ctrl_io_w32 ;virtual
		651	ret
		652	endp
		653
		654	align 4
		655	proc reset_controller
		656
		657	xor eax, eax
		658	mov edx, PCM_IN_CR_REG
		659	call [ctrl.ctrl_write8]
		660
		661	mov edx, PCM_OUT_CR_REG
		662	call [ctrl.ctrl_write8]
		663
		664	mov edx, MC_IN_CR_REG
		665	call [ctrl.ctrl_write8]
		666
		667	mov eax, RR
		668	mov edx, PCM_IN_CR_REG
		669	call [ctrl.ctrl_write8]
		670
		671	mov edx, PCM_OUT_CR_REG
		672	call [ctrl.ctrl_write8]
		673
		674	mov edx, MC_IN_CR_REG
		675	call [ctrl.ctrl_write8]
		676	ret
		677	endp
		678
		679	align 4
		680	proc init_codec
		681	locals
		682	counter dd ?
		683	endl
		684
		685	mov esi, msgControl
		686	call SysMsgBoardStr
		687
		688	mov edx, GLOB_CTRL
		689	call [ctrl.ctrl_read32]
		690	call dword2str
		691	call SysMsgBoardStr
		692
		693	mov esi, msgStatus
		694	call SysMsgBoardStr
		695
		696	mov edx, CTRL_STAT
		697	call [ctrl.ctrl_read32]
		698
		699	call dword2str
		700	call SysMsgBoardStr
		701
		702	test eax, CTRL_ST_CREADY
		703	jnz .ready
		704
		705	call reset_codec
		706	and eax, eax
		707	jz .err
		708
		709	xor edx, edx ;ac_reg_0
		710	call [ctrl.codec_write16]
		711
		712	xor eax, eax
		713	mov edx, CODEC_REG_POWERDOWN
		714	call [ctrl.codec_write16]
		715
		716	mov [counter], 200 ; total 200*5 ms = 1s
		717	.wait:
		718	mov edx, CODEC_REG_POWERDOWN
		719	call [ctrl.codec_read16]
		720	and eax, 0x0F
		721	cmp eax, 0x0F
		722	jz .ready
		723
		724	mov eax, 5000 ; wait 5 ms
		725	call StallExec
		726	sub [counter] , 1
		727	jnz .wait
		728	.err:
		729	xor eax, eax ; timeout error
		730	ret
		731	.ready:
		732	call detect_codec
		733
		734	xor eax, eax
		735	inc eax
		736	ret
		737	endp
		738
		739	align 4
		740	proc reset_codec
		741	mov edx, GLOB_CTRL
		742	call [ctrl.ctrl_read32]
		743
		744	test eax, 0x02
		745	jz .cold
		746
		747	call warm_reset
		748	jnc .ok
		749	.cold:
		750	call cold_reset
		751	jnc .ok
		752
		753	if DEBUG
		754	mov esi, msgCFail
		755	call SysMsgBoardStr
		756	end if
		757	xor eax, eax ; timeout error
		758	ret
		759	.ok:
		760	if DEBUG
		761	mov esi, msgResetOk
		762	call SysMsgBoardStr
		763	end if
		764
		765	xor eax, eax
		766	inc eax
		767	ret
		768	endp
		769
		770	align 4
		771	proc warm_reset
		772	locals
		773	counter dd ?
		774	endl
		775
		776	mov eax, 0x06
		777	mov edx, GLOB_CTRL
		778	call [ctrl.ctrl_write32]
		779
		780	if DEBUG
		781	mov esi, msgWarm
		782	call SysMsgBoardStr
		783	end if
		784
		785	mov [counter], 10 ; total 10*100 ms = 1s
		786	.wait:
		787	mov eax, 100000 ; wait 100 ms
		788	call StallExec
		789
		790	mov edx, GLOB_CTRL
		791	call [ctrl.ctrl_read32]
		792	test eax, 4
		793	jz .ok
		794	sub [counter], 1
		795	jnz .wait
		796
		797	if DEBUG
		798	mov esi, msgWRFail
		799	call SysMsgBoardStr
		800	end if
		801
		802	stc
		803	ret
		804	.ok:
		805	mov edx, CTRL_STAT
		806	call [ctrl.ctrl_read32]
		807	and eax, CTRL_ST_CREADY
		808	jz .fail
		809	clc
		810	ret
		811	.fail:
		812	stc
		813	ret
		814	endp
		815
		816	align 4
		817	proc cold_reset
		818	locals
		819	counter dd ?
		820	endl
		821
		822	xor eax, eax
		823	mov edx, GLOB_CTRL
		824	call [ctrl.ctrl_write32]
		825
		826	if DEBUG
		827	mov esi, msgCold
		828	call SysMsgBoardStr
		829	end if
		830
		831	mov eax, 1000000 ; wait 1 s
		832	call StallExec
		833
		834	mov eax, 2
		835	mov edx, GLOB_CTRL
		836	call [ctrl.ctrl_write32]
		837
		838	mov [counter], 10 ; total 10*100 ms = 1s
		839	.wait:
		840	mov eax, 100000 ; wait 100 ms
		841	call StallExec
		842
		843	mov edx, GLOB_CTRL
		844	call [ctrl.ctrl_read32]
		845	test eax, 4
		846	jz .ok
		847	sub [counter], 1
		848	jnz .wait
		849
		850	if DEBUG
		851	mov esi, msgCRFail
		852	call SysMsgBoardStr
		853	end if
		854	stc
		855	ret
		856	.ok:
		857	mov edx, CTRL_STAT
		858	call [ctrl.ctrl_read32]
		859	and eax, CTRL_ST_CREADY
		860	jz .fail
		861	clc
		862	ret
		863	.fail:
		864	stc
		865	ret
		866	endp
		867
		868	align 4
		869	play:
		870	mov eax, 16
		871	mov [ctrl.lvi_reg], eax
		872	mov edx, PCM_OUT_LVI_REG
		873	call [ctrl.ctrl_write8]
		874
		875	mov edx, PCM_OUT_CR_REG
		876	mov ax, 0x1D
		877	call [ctrl.ctrl_write8]
		878	xor eax, eax
		879	ret
		880
		881	align 4
		882	stop:
		883	mov edx, PCM_OUT_CR_REG
		884	mov ax, 0x0
		885	call [ctrl.ctrl_write8]
		886
		887	mov ax, 0x1c
		888	mov edx, PCM_OUT_SR_REG
		889	call [ctrl.ctrl_write16]
		890	xor eax, eax
		891	ret
		892
		893	align 4
		894	proc get_dev_info stdcall, p_info:dword
		895	virtual at esi
		896	CTRL_INFO CTRL_INFO
		897	end virtual
		898
		899	mov esi, [p_info]
		900	mov eax, [ctrl.int_line]
		901	mov ebx, [ctrl.codec_io_base]
		902	mov ecx, [ctrl.ctrl_io_base]
		903	mov edx, [ctrl.codec_mem_base]
		904	mov edi, [ctrl.ctrl_mem_base]
		905
		906	mov [CTRL_INFO.irq], eax
		907	mov [CTRL_INFO.codec_io_base], ebx
		908	mov [CTRL_INFO.ctrl_io_base], ecx
		909	mov [CTRL_INFO.codec_mem_base], edx
		910	mov [CTRL_INFO.ctrl_mem_base], edi
		911
		912	mov eax, [codec.chip_id]
		913	mov [CTRL_INFO.codec_id], eax
		914
		915	mov edx, GLOB_CTRL
		916	call [ctrl.ctrl_read32]
		917	mov [CTRL_INFO.glob_cntrl], eax
		918
		919	mov edx, CTRL_STAT
		920	call [ctrl.ctrl_read32]
		921	mov [CTRL_INFO.glob_sta], eax
		922
		923	mov ebx, [ctrl.pci_cmd]
		924	mov [CTRL_INFO.pci_cmd], ebx
		925	ret
		926	endp
		927
		928	align 4
		929	proc set_callback stdcall, handler:dword
		930	mov eax, [handler]
		931	mov [ctrl.user_callback], eax
		932	ret
		933	endp
		934
		935	align 4
		936	proc codec_read stdcall, ac_reg:dword ; reg = edx, reval = eax
		937
		938	mov edx, [ac_reg]
		939
		940	mov ebx, edx
		941	shr ebx, 1
		942	bt [codec.shadow_flag], ebx
		943	jc .use_shadow
		944
		945	call [ctrl.codec_read16] ;change edx !!!
		946	mov ecx, eax
		947
		948	mov edx, CTRL_STAT
		949	call [ctrl.ctrl_read32]
		950	test eax, CTRL_ST_RCS
		951	jz .read_ok
		952
		953	mov edx, CTRL_STAT
		954	call [ctrl.ctrl_write32]
		955	xor eax, eax
		956	not eax ;timeout
		957	ret
		958	.read_ok:
		959	mov edx, [ac_reg]
		960	mov [codec.regs+edx], cx
		961	bts [codec.shadow_flag], ebx
		962	mov eax, ecx
		963	ret
		964	.use_shadow:
		965	movzx eax, word [codec.regs+edx]
		966	ret
		967	endp
		968
		969	align 4
		970	proc codec_write stdcall, ac_reg:dword
		971	push eax
		972	call check_semafore
		973	and eax, eax
		974	jz .err
		975	pop eax
		976
		977	mov esi, [ac_reg]
		978	mov edx, esi
		979	call [ctrl.codec_write16]
		980	mov [codec.regs+esi], ax
		981	shr esi, 1
		982	bts [codec.shadow_flag], esi
		983	ret
		984	.err:
		985	pop eax
		986	ret
		987	endp
		988
		989	align 4
		990	proc codec_check_ready
		991
		992	mov edx, CTRL_ST
		993	call [ctrl.ctrl_read32]
		994	and eax, CTRL_ST_CREADY
		995	jz .not_ready
		996
		997	xor eax, wax
		998	inc eax
		999	ret
		1000	.not_ready:
		1001	xor eax, eax
		1002	ret
		1003	endp
		1004
		1005	align 4
		1006	proc check_semafore
		1007	local counter:DWORD
		1008
		1009	mov [counter], 100
		1010	.l1:
		1011	mov edx, CTRL_CAS
		1012	call [ctrl.ctrl_read8]
		1013	and eax, CAS_FLAG
		1014	jz .ok
		1015
		1016	mov eax, 1
		1017	call StallExec
		1018	sub [counter], 1
		1019	jnz .l1
		1020	xor eax, eax
		1021	ret
		1022	align 4
		1023	.ok:
		1024	xor eax, eax
		1025	inc eax
		1026	ret
		1027	endp
		1028
		1029	align 4
		1030	proc StallExec
		1031	push ecx
		1032	push edx
		1033	push ebx
		1034	push eax
		1035
		1036	mov ecx, CPU_FREQ
		1037	mul ecx
		1038	mov ebx, eax ;low
		1039	mov ecx, edx ;high
		1040	rdtsc
		1041	add ebx, eax
		1042	adc ecx, edx
		1043	@@:
		1044	rdtsc
		1045	sub eax, ebx
		1046	sbb edx, ecx
		1047	js @B
		1048
		1049	pop eax
		1050	pop ebx
		1051	pop edx
		1052	pop ecx
		1053	ret
		1054	endp
		1055
		1056	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		1057	; CONTROLLER IO functions
		1058	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		1059
		1060	align 4
		1061	codec_io_r16:
		1062	add edx, [ctrl.codec_io_base]
		1063	in ax, dx
		1064	ret
		1065
		1066	align 4
		1067	codec_io_w16:
		1068	add edx, [ctrl.codec_io_base]
		1069	out dx, ax
		1070	ret
		1071
		1072	align 4
		1073	ctrl_io_r8:
		1074	add edx, [ctrl.ctrl_io_base]
		1075	in al, dx
		1076	ret
		1077
		1078	align 4
		1079	ctrl_io_r16:
		1080	add edx, [ctrl.ctrl_io_base]
		1081	in ax, dx
		1082	ret
		1083
		1084	align 4
		1085	ctrl_io_r32:
		1086	add edx, [ctrl.ctrl_io_base]
		1087	in eax, dx
		1088	ret
		1089
		1090	align 4
		1091	ctrl_io_w8:
		1092	add edx, [ctrl.ctrl_io_base]
		1093	out dx, al
		1094	ret
		1095
		1096	align 4
		1097	ctrl_io_w16:
		1098	add edx, [ctrl.ctrl_io_base]
		1099	out dx, ax
		1100	ret
		1101
		1102	align 4
		1103	ctrl_io_w32:
		1104	add edx, [ctrl.ctrl_io_base]
		1105	out dx, eax
		1106	ret
		1107
		1108
		1109	align 4
		1110	dword2str:
		1111	mov esi, hex_buff
		1112	mov ecx, -8
		1113	@@:
		1114	rol eax, 4
		1115	mov ebx, eax
		1116	and ebx, 0x0F
		1117	mov bl, [ebx+hexletters]
		1118	mov [8+esi+ecx], bl
		1119	inc ecx
		1120	jnz @B
		1121	ret
		1122
		1123	hexletters db '0123456789ABCDEF'
		1124	hex_buff db 8 dup(0),13,10,0
		1125
		1126
		1127	include "codec.inc"
		1128
		1129	align 4
		1130	devices dd (0x5000 shl 16)+0x1274,msgEnsoniq,set_ICH
		1131	dd (0x5880 shl 16)+0x1274,msgVibra128,set_ICH
		1132	dd 0 ;terminator
		1133
		1134	version dd 0x00040004
		1135
		1136	msgEnsoniq db 'Ensonic 1371',13,10,0
		1137	msgVibra128 db 'Sound Blaster AudioPCI Vibra 128',13,10,0
		1138
		1139	sz_sound_srv db 'SOUND',0
		1140
		1141	msgDetect db 'detect hardware...',13,10,0
		1142	msgFail db 'device not found',13,10,0
		1143	msgAttchIRQ db 'IRQ line not supported', 13,10, 0
		1144	msgInvIRQ db 'IRQ line not assigned or invalid', 13,10, 0
		1145	msgPlay db 'start play', 13,10,0
		1146	msgStop db 'stop play', 13,10,0
		1147	msgNotify db 'call notify',13,10,0
		1148	msgIRQ db 'AC97 IRQ', 13,10,0
		1149	msgInitCtrl db 'init controller',13,10,0
		1150	msgInitCodec db 'init codec',13,10,0
		1151	msgPrimBuff db 'create primary buffer',13,10,0
		1152	msgReg db 'set service handler',13,10,0
		1153	msgOk db 'service installed',13,10,0
		1154	msgCold db 'cold reset',13,10,0
		1155	msgWarm db 'warm reset',13,10,0
		1156	msgWRFail db 'warm reset failed',13,10,0
		1157	msgCRFail db 'cold reset failed',13,10,0
		1158	msgCFail db 'codec not ready',13,10,0
		1159	msgResetOk db 'reset complete',13,10,0
		1160	msgStatus db 'global status ',0
		1161	msgControl db 'global control ',0
		1162	msgPCIcmd db 'PCI command ',0
		1163	msgIObase db 'IO base ',0
		1164	msgIRQline db 'IRQ line ',0
		1165
		1166	section '.data' data readable writable align 16
		1167
		1168	pcmout_bdl rq 32
		1169	buff_list rd 32
		1170
		1171	codec CODEC
		1172	ctrl AC_CNTRL
		1173
		1174	lpc_bus rd 1
		1175	civ_val rd 1
		1176

Subversion Repositories Kolibri OS

(root)/kernel/trunk/drivers/ensoniq.asm – Rev 2455