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

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

Subversion Repositories Kolibri OS

(root)/kernel/trunk/drivers/sis.asm – Rev 895