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

Rev	Author	Line No.	Line
431	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
168	serge	8	; (C) copyright Serge 2006
		9	; email: infinity_sound@mail.ru
		10
378	serge	11
431	serge	12
168	serge	13	align 4
378	serge	14
		15	mix_list rq 32
		16
		17	align 4
168	serge	18	proc new_mix stdcall, output:dword
281	serge	19	locals
378	serge	20	main_count rd 1
		21	fpu_state rb 528 ;512+16
281	serge	22	endl
168	serge	23
378	serge	24	mov [main_count], 32
281	serge	25	call prepare_playlist
378	serge	26	cmp [play_count], 0
		27	je .clear
168	serge	28
378	serge	29	lea eax, [fpu_state+16]
		30	and eax, -16 ;must be 16b aligned
188	serge	31	call FpuSave
168	serge	32
378	serge	33	call update_stream
		34	.mix:
		35	lea eax, [mix_list]
		36	call do_mix_list
		37	test eax, eax
		38	je .done
168	serge	39
378	serge	40	; cmp eax, 1
		41	; je .copy
168	serge	42
378	serge	43	lea ebx, [mix_list]
		44	stdcall mix_all, [output], ebx, eax
168	serge	45	@@:
378	serge	46	add [output], 512
293	serge	47	dec [main_count]
378	serge	48	jnz .mix
		49	.exit:
		50	lea eax, [fpu_state+16]
		51	and eax, -16
188	serge	52	call FpuRestore
281	serge	53	ret
378	serge	54	.copy:
		55	lea eax, [mix_list]
		56	stdcall copy_mem, [output], [eax]
		57	jmp @B
		58	.done:
		59	mov ecx, [main_count]
		60	shl ecx, 7 ;ecx*= 512/4
		61
281	serge	62	mov edi, [output]
		63	xor eax, eax
		64	cld
		65	rep stosd
378	serge	66	jmp .exit
		67	.clear:
		68	mov edi, [output]
		69	mov ecx, 4096
		70	xor eax, eax
		71	cld
		72	rep stosd
281	serge	73	ret
168	serge	74	endp
		75
		76	align 4
		77	proc update_stream
281	serge	78	locals
170	serge	79	stream_index dd ?
227	serge	80	ev_code dd ? ;EVENT
		81	ev_offs dd ?
		82	rd 4
281	serge	83	endl
168	serge	84
281	serge	85	mov [stream_index], 0
168	serge	86	.l1:
281	serge	87	mov edx, [stream_index]
		88	mov esi, [play_list+edx*4]
168	serge	89
378	serge	90	mov eax, [esi+STREAM.out_rp]
		91	cmp eax, [esi+STREAM.out_top]
281	serge	92	jb @f
328	serge	93	sub eax, 64*1024
168	serge	94	@@:
378	serge	95	mov [esi+STREAM.out_rp], eax
168	serge	96
378	serge	97	cmp word [esi+STREAM.format], PCM_2_16_48
281	serge	98	je .copy
168	serge	99
378	serge	100	cmp [esi+STREAM.out_count], 16384
		101	ja .skip
168	serge	102
378	serge	103	test [esi+STREAM.format], PCM_RING
		104	jnz .ring
168	serge	105
281	serge	106	stdcall refill, esi
378	serge	107	.skip:
281	serge	108	inc [stream_index]
		109	dec [play_count]
		110	jnz .l1
		111	ret
378	serge	112
		113	.ring:
		114	stdcall refill_ring, esi
		115	jmp .skip
168	serge	116	.copy:
281	serge	117	mov ebx, esi
378	serge	118	mov edi, [ebx+STREAM.out_wp]
		119	cmp edi, [ebx+STREAM.out_top]
281	serge	120	jb @f
328	serge	121
		122	sub edi, 64*1024
378	serge	123	mov [ebx+STREAM.out_wp], edi
168	serge	124	@@:
378	serge	125	mov esi, [ebx+STREAM.in_rp]
281	serge	126	mov ecx, 16384/4
		127	cld
		128	rep movsd
168	serge	129
378	serge	130	mov [ebx+STREAM.out_wp], edi
168	serge	131
378	serge	132	cmp esi, [ebx+STREAM.in_top]
281	serge	133	jb @f
168	serge	134
378	serge	135	sub esi, 0x10000
168	serge	136	@@:
378	serge	137	mov [ebx+STREAM.in_rp], esi
168	serge	138
378	serge	139	test eax, eax
		140	jz .l_end
		141	mov eax, [ebx+STREAM.notify_event]
		142	mov ebx, [ebx+STREAM.notify_id]
		143	mov ecx, EVENT_WATCHED
		144	xor edx, edx
		145	call RaiseEvent ;eax, ebx, ecx, edx
		146	.l_end:
281	serge	147	inc [stream_index]
		148	dec [play_count]
		149	jnz .l1
		150	ret
378	serge	151	endp
		152
		153	align 4
		154	proc refill stdcall, str:dword
		155	locals
		156	r_size rd 1
		157	event rd 6
		158	endl
		159
		160	mov ebx, [str]
		161	mov edi, [ebx+STREAM.out_wp]
		162	cmp edi, [ebx+STREAM.out_top]
		163	jb @F
		164	sub edi, 0x10000
		165	mov [ebx+STREAM.out_wp], edi
168	serge	166	@@:
378	serge	167	mov eax, [ebx+STREAM.in_count]
		168	test eax, eax
		169	jz .done
227	serge	170
378	serge	171	mov ecx, [ebx+STREAM.r_size]
		172	cmp eax, ecx
		173	jle @F
		174
		175	mov eax, ecx
		176	@@:
		177	mov ecx, eax
		178	cmp word [ebx+STREAM.format], PCM_1_16_8
		179	ja @F
		180
		181	shr eax, 1 ;two channles
		182	@@:
		183	test [ebx+STREAM.format], 1 ;even formats mono
		184	jz @F
		185
		186	shr eax, 1 ;eax= samples
		187	@@:
		188	shl eax, 15 ;eax*=32768 =r_end
		189
		190	mov [r_size], ecx
		191
		192	mov esi, [ebx+STREAM.in_rp]
		193	mov edi, [ebx+STREAM.out_wp]
		194
		195	stdcall [ebx+STREAM.resample], edi, esi, \
		196	[ebx+STREAM.r_dt], ecx, eax
		197
		198	mov ebx, [str]
		199
		200	add [ebx+STREAM.out_count], eax;
		201	add [ebx+STREAM.out_wp], eax;
		202
		203	mov eax, [ebx+STREAM.in_rp]
		204	mov ecx, [r_size]
		205	add eax, ecx
		206	add [ebx+STREAM.in_free], ecx
		207	sub [ebx+STREAM.in_count], ecx
		208
		209	cmp eax, [ebx+STREAM.in_top]
		210	jb @f
		211
		212	sub eax, [ebx+STREAM.in_size]
		213	@@:
		214	mov [ebx+STREAM.in_rp], eax
		215
		216	.done:
		217	mov eax, [ebx+STREAM.notify_event]
168	serge	218	test eax, eax
378	serge	219	jz .exit
227	serge	220
378	serge	221	mov ebx, [ebx+STREAM.notify_id]
		222	mov ecx, EVENT_WATCHED
		223	xor edx, edx
		224	call RaiseEvent ;eax, ebx, ecx, edx
		225	.exit:
281	serge	226	ret
168	serge	227	endp
		228
		229	align 4
378	serge	230	proc refill_ring stdcall, str:dword
281	serge	231	locals
378	serge	232	event rd 6
281	serge	233	endl
168	serge	234
281	serge	235	mov ebx, [str]
378	serge	236	mov edi, [ebx+STREAM.out_wp]
		237	cmp edi, [ebx+STREAM.out_top]
328	serge	238	jb @F
378	serge	239	sub edi, 0x10000
		240	mov [ebx+STREAM.out_wp], edi
328	serge	241	@@:
378	serge	242	mov ecx, [ebx+STREAM.r_size]
		243	mov eax, ecx
		244	cmp word [ebx+STREAM.format], PCM_1_16_8
		245	ja @F
168	serge	246
378	serge	247	shr eax, 1 ;two channles
		248	@@:
		249	test [ebx+STREAM.format], 1 ;even formats mono
		250	jz @F
		251
		252	shr eax, 1 ;eax= samples
		253	@@:
		254	shl eax, 15 ;eax*=32768 =r_end
		255
		256	mov esi, [ebx+STREAM.in_rp]
		257	mov edi, [ebx+STREAM.out_wp]
		258
285	serge	259	stdcall [ebx+STREAM.resample], edi, esi, \
378	serge	260	[ebx+STREAM.r_dt], ecx, eax
168	serge	261
281	serge	262	mov ebx, [str]
168	serge	263
378	serge	264	add [ebx+STREAM.out_count], eax;
		265	add [ebx+STREAM.out_wp], eax;
168	serge	266
378	serge	267	mov eax, [ebx+STREAM.in_rp]
		268	mov ecx, [ebx+STREAM.r_size]
		269	add eax, ecx
		270	add [ebx+STREAM.in_free], ecx
		271	sub [ebx+STREAM.in_count], ecx
		272
		273	cmp eax, [ebx+STREAM.in_top]
281	serge	274	jb @f
		275
378	serge	276	sub eax, [ebx+STREAM.in_size]
168	serge	277	@@:
378	serge	278	mov [ebx+STREAM.in_rp], eax
168	serge	279
378	serge	280	sub eax, [ebx+STREAM.in_base]
		281	sub eax, 128
		282	lea edx, [event]
		283
		284	mov dword [edx], RT_INP_EMPTY
		285	mov dword [edx+4], 0
		286	mov dword [edx+8], ebx
		287	mov dword [edx+12], eax
		288
		289	mov eax, [ebx+STREAM.notify_event]
		290	test eax, eax
		291	jz .exit
		292
		293	mov ebx, [ebx+STREAM.notify_id]
281	serge	294	xor ecx, ecx
378	serge	295	call RaiseEvent ;eax, ebx, ecx, edx
		296	.exit:
		297	ret
		298	endp
168	serge	299
378	serge	300	align 4
		301	proc mix_all stdcall, dest:dword, list:dword, count:dword
		302
		303	mov edi, [dest]
		304	mov ebx, 64
		305	.mix:
		306	mov edx, [list]
		307	mov ecx, [count]
		308
		309	mov eax, [edx]
		310	movq mm0, [eax]
		311	movd mm1, [edx+4]
		312	punpckldq mm1,mm1
		313	pmulhw mm0, mm1
		314	psllw mm0, 1
		315
		316	.mix_loop:
		317	add dword [edx], 8
		318	add edx, 8
		319	dec ecx
		320	jz @F
		321
		322	mov eax, [edx]
		323	movq mm1, [eax]
		324	movd mm2, [edx+4]
		325	punpckldq mm2,mm2
		326	pmulhw mm1, mm2
		327	psllw mm1, 1
		328	paddsw mm0, mm1
		329	jmp .mix_loop
168	serge	330	@@:
378	serge	331	movq [edi], mm0
		332	add edi, 8
		333	dec ebx
		334	jnz .mix
227	serge	335
291	serge	336	ret
168	serge	337	endp
		338
		339	align 4
285	serge	340	proc resample_1 stdcall, dest:dword,src:dword,\
291	serge	341	r_dt:dword, r_size:dword,r_end:dword
168	serge	342
285	serge	343	; dest equ esp+8
		344	; src equ esp+12
		345	; r_dt equ esp+16
		346	; r_size equ esp+20
378	serge	347	; r_end equ esp+24
168	serge	348
285	serge	349	mov edi, [dest]
		350	mov edx, [src]
		351	sub edx, 32*2
		352	mov eax, 16
168	serge	353
378	serge	354	align 4
168	serge	355	.l1:
291	serge	356	mov ecx, eax
		357	mov esi, eax
		358	and ecx, 0x7FFF
		359	shr esi, 15
		360	lea esi, [edx+esi*2]
168	serge	361
291	serge	362	movsx ebp, word [esi]
		363	movsx esi, word [esi+2]
		364	mov ebx, 32768
		365	imul esi, ecx
		366	sub ebx, ecx
		367	imul ebx, ebp
		368	lea ecx, [ebx+esi+16384]
		369	sar ecx, 15
		370	cmp ecx, 32767 ; 00007fffH
		371	jle @f
		372	mov ecx, 32767 ; 00007fffH
		373	jmp .write
168	serge	374	@@:
291	serge	375	cmp ecx, -32768 ; ffff8000H
		376	jge .write
		377	mov ecx, -32768 ; ffff8000H
168	serge	378	.write:
291	serge	379	mov ebx, ecx
		380	shl ebx, 16
		381	mov bx, cx
		382	mov [edi], ebx
		383	add edi, 4
168	serge	384
293	serge	385	add eax, [esp+16]
		386	cmp eax, [esp+24]
291	serge	387	jb .l1
168	serge	388
291	serge	389	mov ebp, esp
168	serge	390
291	serge	391	sub edi, [dest]
		392	mov eax, edi
		393	ret
168	serge	394	endp
		395
		396	align 4
285	serge	397	proc resample_18 stdcall, dest:dword,src:dword,\
291	serge	398	r_dt:dword, r_size:dword,r_end:dword
168	serge	399
		400
291	serge	401	mov edi, [dest]
285	serge	402	mov edx, [src]
		403	sub edx, 32
		404
291	serge	405	mov esi, 16
168	serge	406
378	serge	407	align 4
168	serge	408	.l1:
291	serge	409	mov ecx, esi
		410	mov eax, esi
		411	and ecx, 0x7FFF
		412	shr eax, 15
		413	lea eax, [edx+eax]
168	serge	414
291	serge	415	mov bx, word [eax]
		416	sub bh, 0x80
		417	sub bl, 0x80
		418	movsx eax, bh
		419	shl eax,8
		420	movsx ebp, bl
		421	shl ebp,8
		422	mov ebx, 32768
		423	imul eax, ecx
		424	sub ebx, ecx
		425	imul ebx, ebp
		426	lea ecx, [ebx+eax+16384]
		427	sar ecx, 15
		428	cmp ecx, 32767 ; 00007fffH
		429	jle @f
		430	mov ecx, 32767 ; 00007fffH
		431	jmp .write
168	serge	432	@@:
291	serge	433	cmp ecx, -32768 ; ffff8000H
		434	jge .write
		435	mov ecx, -32768 ; ffff8000H
168	serge	436	.write:
291	serge	437	mov ebx, ecx
		438	shl ebx, 16
		439	mov bx, cx
		440	mov [edi], ebx
		441	add edi, 4
168	serge	442
293	serge	443	add esi, [esp+16]
		444	cmp esi, [esp+24]
291	serge	445	jb .l1
168	serge	446
291	serge	447	mov ebp, esp
		448	sub edi, [dest]
		449	mov eax, edi
		450	ret
168	serge	451	endp
		452
		453	align 4
285	serge	454	proc copy_stream stdcall, dest:dword,src:dword,\
291	serge	455	r_dt:dword, r_size:dword,r_end:dword
168	serge	456
281	serge	457	mov ecx, [r_size]
		458	mov eax, ecx
		459	shr ecx, 2
		460	mov esi, [src]
		461	mov edi, [dest]
		462	rep movsd
		463	mov eax, 16384
		464	ret
168	serge	465	endp
		466
		467	align 4
285	serge	468	proc resample_2 stdcall, dest:dword,src:dword,\
291	serge	469	r_dt:dword, r_size:dword,r_end:dword
168	serge	470
285	serge	471	mov edx, [src]
		472	sub edx, 32*4
		473	mov edi, [dest]
		474	mov ebx, [r_dt]
		475	mov eax, 16
		476	emms
168	serge	477
378	serge	478	align 4
168	serge	479	.l1:
285	serge	480	mov ecx, eax
		481	mov esi, eax
		482	and ecx, 0x7FFF
		483	shr esi, 15
		484	lea esi, [edx+esi*4]
168	serge	485
285	serge	486	movq mm0, [esi]
		487	movq mm1, mm0
168	serge	488
285	serge	489	movd mm2, ecx
		490	punpcklwd mm2, mm2
		491	movq mm3, qword [m7] ;0x8000
168	serge	492
285	serge	493	psubw mm3, mm2 ; ;0x8000 - iconst
		494	punpckldq mm3, mm2
168	serge	495
285	serge	496	pmulhw mm0, mm3
		497	pmullw mm1, mm3
168	serge	498
285	serge	499	movq mm4, mm1
		500	punpcklwd mm1, mm0
		501	punpckhwd mm4, mm0
		502	paddd mm1, mm4
		503	psrad mm1, 15
		504	packssdw mm1, mm1
		505	movd [edi], mm1
		506	add edi, 4
168	serge	507
285	serge	508	add eax, ebx
		509	cmp eax, [r_end]
		510	jb .l1
		511	emms
168	serge	512
285	serge	513	sub edi, [dest]
		514	mov eax, edi
		515	ret
168	serge	516	endp
		517
		518	align 4
285	serge	519	proc resample_28 stdcall, dest:dword,src:dword,\
291	serge	520	r_dt:dword, r_size:dword,r_end:dword
168	serge	521
285	serge	522	mov edx, [src]
		523	sub edx, 32*2
		524	mov edi, [dest]
		525	mov ebx, [r_dt]
		526	mov eax, 16
		527	emms
		528	movq mm7,[mm80]
		529	movq mm6,[mm_mask]
168	serge	530
378	serge	531	align 4
168	serge	532	.l1:
291	serge	533	mov ecx, eax
		534	mov esi, eax
		535	and ecx, 0x7FFF
		536	shr esi, 15
		537	lea esi, [edx+esi*2]
168	serge	538
291	serge	539	movq mm0, [esi]
		540	psubb mm0,mm7
		541	punpcklbw mm0,mm0
		542	pand mm0,mm6
168	serge	543
291	serge	544	movq mm1, mm0
168	serge	545
291	serge	546	movd mm2, ecx
		547	punpcklwd mm2, mm2
		548	movq mm3, qword [m7] ; // 0x8000
168	serge	549
291	serge	550	psubw mm3, mm2 ; // 0x8000 - iconst
		551	punpckldq mm3, mm2
168	serge	552
291	serge	553	pmulhw mm0, mm3
		554	pmullw mm1, mm3
168	serge	555
291	serge	556	movq mm4, mm1
		557	punpcklwd mm1, mm0
		558	punpckhwd mm4, mm0
		559	paddd mm1, mm4
		560	psrad mm1, 15
		561	packssdw mm1, mm1
		562	movd [edi], mm1
		563	add edi, 4
168	serge	564
291	serge	565	add eax, ebx
		566	cmp eax, [r_end]
		567	jb .l1
		568	emms
168	serge	569
		570
291	serge	571	sub edi, [dest]
		572	mov eax, edi
		573	ret
168	serge	574	endp
		575
		576
285	serge	577	proc m16_stereo stdcall, dest:dword,src:dword,\
291	serge	578	r_dt:dword, r_size:dword,r_end:dword
168	serge	579
291	serge	580	mov esi, [src]
		581	mov edi, [dest]
		582	mov ecx, [r_size]
		583	shr ecx,8
168	serge	584	@@:
291	serge	585	call m16_s_mmx
		586	add edi, 128
		587	add esi, 64
		588	call m16_s_mmx
		589	add edi, 128
		590	add esi, 64
		591	call m16_s_mmx
		592	add edi, 128
		593	add esi, 64
		594	call m16_s_mmx
		595	add edi, 128
		596	add esi, 64
		597	dec ecx
		598	jnz @b
168	serge	599
291	serge	600	mov eax, [r_size]
		601	add eax, eax
		602	ret
168	serge	603	endp
		604
		605	align 4
285	serge	606	proc s8_stereo stdcall, dest:dword,src:dword,\
291	serge	607	r_dt:dword, r_size:dword,r_end:dword
168	serge	608
281	serge	609	mov esi, [src]
		610	mov edi, [dest]
		611	mov ecx, [r_size]
		612	shr ecx, 7
168	serge	613
281	serge	614	movq mm7, [mm80]
		615	movq mm6, [mm_mask]
168	serge	616	@@:
281	serge	617	call s8_s_mmx
		618	add edi, 64
		619	add esi, 32
		620	call s8_s_mmx
		621	add edi, 64
		622	add esi, 32
		623	call s8_s_mmx
		624	add edi, 64
		625	add esi, 32
		626	call s8_s_mmx
		627	add edi, 64
		628	add esi, 32
168	serge	629	dec ecx
281	serge	630	jnz @b
168	serge	631
281	serge	632	mov eax, [r_size]
		633	add eax, eax
		634	ret
168	serge	635	endp
		636
285	serge	637	proc m8_stereo stdcall, dest:dword,src:dword,\
291	serge	638	r_dt:dword, r_size:dword,r_end:dword
168	serge	639
281	serge	640	mov esi, [src]
		641	mov edi, [dest]
		642	mov ecx, [r_size]
		643	shr ecx, 6
168	serge	644
281	serge	645	movq mm7, [mm80]
		646	movq mm6, [mm_mask]
168	serge	647	@@:
281	serge	648	call m8_s_mmx
		649	add edi, 64
		650	add esi, 16
		651	call m8_s_mmx
		652	add edi, 64
		653	add esi, 16
		654	call m8_s_mmx
		655	add edi, 64
		656	add esi, 16
		657	call m8_s_mmx
		658	add edi, 64
		659	add esi, 16
		660	dec ecx
		661	jnz @b
168	serge	662
281	serge	663	mov eax, [r_size]
		664	add eax, eax
		665	add eax, eax
		666	ret
168	serge	667	endp
		668
		669	align 4
		670	proc alloc_mix_buff
		671
281	serge	672	bsf eax, [mix_buff_map]
		673	jnz .find
		674	xor eax, eax
		675	ret
168	serge	676	.find:
281	serge	677	btr [mix_buff_map], eax
		678	shl eax, 9
		679	add eax, [mix_buff]
		680	ret
168	serge	681	endp
		682
293	serge	683	align 4
168	serge	684	proc m16_s_mmx
		685
291	serge	686	movq mm0, [esi]
		687	movq mm1, mm0
		688	punpcklwd mm0, mm0
		689	punpckhwd mm1, mm1
		690	movq [edi], mm0
		691	movq [edi+8], mm1
168	serge	692
291	serge	693	movq mm0, [esi+8]
		694	movq mm1, mm0
		695	punpcklwd mm0, mm0
		696	punpckhwd mm1, mm1
		697	movq [edi+16], mm0
		698	movq [edi+24], mm1
168	serge	699
291	serge	700	movq mm0, [esi+16]
		701	movq mm1, mm0
		702	punpcklwd mm0, mm0
		703	punpckhwd mm1, mm1
		704	movq [edi+32], mm0
		705	movq [edi+40], mm1
168	serge	706
291	serge	707	movq mm0, [esi+24]
		708	movq mm1, mm0
		709	punpcklwd mm0, mm0
		710	punpckhwd mm1, mm1
		711	movq [edi+48], mm0
		712	movq [edi+56], mm1
168	serge	713
291	serge	714	movq mm0, [esi+32]
		715	movq mm1, mm0
		716	punpcklwd mm0, mm0
		717	punpckhwd mm1, mm1
		718	movq [edi+64], mm0
		719	movq [edi+72], mm1
168	serge	720
291	serge	721	movq mm0, [esi+40]
		722	movq mm1, mm0
		723	punpcklwd mm0, mm0
		724	punpckhwd mm1, mm1
		725	movq [edi+80], mm0
		726	movq [edi+88], mm1
168	serge	727
		728
291	serge	729	movq mm0, [esi+48]
		730	movq mm1, mm0
		731	punpcklwd mm0, mm0
		732	punpckhwd mm1, mm1
		733	movq [edi+96], mm0
		734	movq [edi+104], mm1
168	serge	735
291	serge	736	movq mm0, [esi+56]
		737	movq mm1, mm0
		738	punpcklwd mm0, mm0
		739	punpckhwd mm1, mm1
		740	movq [edi+112], mm0
		741	movq [edi+120], mm1
168	serge	742
291	serge	743	ret
168	serge	744	endp
		745
		746	align 4
		747	proc s8_s_mmx
		748
281	serge	749	movq mm0, [esi]
		750	psubb mm0, mm7
		751	movq mm1, mm0
		752	punpcklbw mm0, mm0
		753	pand mm0, mm6
		754	punpckhbw mm1, mm1
		755	pand mm1, mm6
		756	movq [edi], mm0
		757	movq [edi+8], mm1
168	serge	758
281	serge	759	movq mm0, [esi+8]
		760	psubb mm0, mm7
		761	movq mm1, mm0
		762	punpcklbw mm0, mm0
		763	pand mm0, mm6
		764	punpckhbw mm1, mm1
		765	pand mm1, mm6
		766	movq [edi+16], mm0
		767	movq [edi+24], mm1
168	serge	768
281	serge	769	movq mm0, [esi+16]
		770	psubb mm0, mm7
		771	movq mm1, mm0
		772	punpcklbw mm0, mm0
		773	pand mm0, mm6
		774	punpckhbw mm1, mm1
		775	pand mm1, mm6
		776	movq [edi+32], mm0
		777	movq [edi+40], mm1
168	serge	778
281	serge	779	movq mm0, [esi+24]
		780	psubb mm0, mm7
		781	movq mm1, mm0
		782	punpcklbw mm0, mm0
		783	pand mm0, mm6
		784	punpckhbw mm1, mm1
		785	pand mm1, mm6
		786	movq [edi+48], mm0
		787	movq [edi+56], mm1
168	serge	788
281	serge	789	ret
168	serge	790
		791	endp
		792
		793	align 4
		794	proc m8_s_mmx
		795
281	serge	796	movq mm0, [esi]
		797	psubb mm0, mm7
		798	movq mm1, mm0
		799	punpcklbw mm0, mm0
		800	pand mm0, mm6
		801	punpckhbw mm1, mm1
		802	pand mm1, mm6
		803	movq mm2, mm0
		804	punpcklwd mm0, mm0
		805	punpckhwd mm2, mm2
168	serge	806
281	serge	807	movq mm3, mm1
		808	punpcklwd mm1, mm1
		809	punpckhwd mm3, mm3
168	serge	810
281	serge	811	movq [edi], mm0
		812	movq [edi+8], mm2
		813	movq [edi+16], mm1
		814	movq [edi+24], mm3
168	serge	815
281	serge	816	movq mm0, [esi+8]
		817	psubb mm0, mm7
		818	movq mm1, mm0
		819	punpcklbw mm0, mm0
		820	pand mm0, mm6
		821	punpckhbw mm1, mm1
		822	pand mm1, mm6
		823	movq mm2, mm0
		824	punpcklwd mm0, mm0
		825	punpckhwd mm2, mm2
168	serge	826
281	serge	827	movq mm3, mm1
		828	punpcklwd mm1, mm1
		829	punpckhwd mm3, mm3
168	serge	830
281	serge	831	movq [edi+32], mm0
		832	movq [edi+40], mm2
		833	movq [edi+48], mm1
		834	movq [edi+56], mm3
168	serge	835
281	serge	836	ret
168	serge	837	endp
		838
		839	align 4
		840	proc mix_2_1 stdcall, output:dword, str0:dword, str1:dword
		841
281	serge	842	mov edi, [output]
293	serge	843	mov eax, [str0]
		844	mov ebx, [str1]
		845	mov esi, 128
		846	call [mix_2_core] ;edi, eax, ebx
168	serge	847
293	serge	848	add edi, esi
		849	add eax, esi
		850	add ebx, esi
		851	call [mix_2_core] ;edi, eax, ebx
168	serge	852
293	serge	853	add edi, esi
		854	add eax, esi
		855	add ebx, esi
		856	call [mix_2_core] ;edi, eax, ebx
		857
		858	add edi, esi
		859	add eax, esi
		860	add ebx, esi
		861	call [mix_2_core] ;edi, eax, ebx
281	serge	862	ret
168	serge	863	endp
		864
		865	align 4
		866	proc mix_3_1 stdcall, output:dword, str0:dword, str1:dword, str2:dword
		867
291	serge	868	mov edi, [output]
293	serge	869	mov eax, [str0]
		870	mov ebx, [str1]
		871	mov ecx, [str2]
		872	mov esi, 128
		873	call [mix_3_core]
168	serge	874
293	serge	875	add edi, esi
		876	add eax, esi
		877	add ebx, esi
		878	add ecx, esi
		879	call [mix_3_core]
168	serge	880
293	serge	881	add edi, esi
		882	add eax, esi
		883	add ebx, esi
		884	add ecx, esi
		885	call [mix_3_core]
		886
		887	add edi, esi
		888	add eax, esi
		889	add ebx, esi
		890	add ecx, esi
		891	call [mix_3_core]
291	serge	892	ret
168	serge	893	endp
		894
		895	align 4
		896	proc mix_4_1 stdcall, str0:dword, str1:dword,\
291	serge	897	str2:dword, str3:dword
168	serge	898
291	serge	899	local output:DWORD
168	serge	900
291	serge	901	call alloc_mix_buff
		902	and eax, eax
		903	jz .err
168	serge	904
378	serge	905	mov [output], eax
		906
291	serge	907	mov edi, eax
293	serge	908	mov eax, [str0]
		909	mov ebx, [str1]
		910	mov ecx, [str2]
		911	mov edx, [str3]
		912	mov esi, 128
		913	call [mix_4_core] ;edi, eax, ebx, ecx, edx
168	serge	914
293	serge	915	add edi, esi
		916	add eax, esi
		917	add ebx, esi
		918	add ecx, esi
		919	add edx, esi
		920	call [mix_4_core] ;edi, eax, ebx, ecx, edx
		921
		922	add edi, esi
		923	add eax, esi
		924	add ebx, esi
		925	add ecx, esi
		926	add edx, esi
		927	call [mix_4_core] ;edi, eax, ebx, ecx, edx
		928
		929	add edi, esi
		930	add eax, esi
		931	add ebx, esi
		932	add ecx, esi
		933	add edx, esi
		934	call [mix_4_core] ;edi, eax, ebx, ecx, edx
291	serge	935	mov eax, [output]
		936	ret
168	serge	937	.err:
291	serge	938	xor eax, eax
		939	ret
168	serge	940	endp
		941
		942
		943	align 4
		944	proc final_mix stdcall, output:dword, str0:dword, str1:dword,\
291	serge	945	str2:dword, str3:dword
168	serge	946
291	serge	947	mov edi, [output]
168	serge	948
281	serge	949	mov eax, [str0]
		950	mov ebx, [str1]
		951	mov ecx, [str2]
293	serge	952	mov edx, [str3]
		953	mov esi, 128
		954	call [mix_4_core] ;edi, eax, ebx, ecx, edx
168	serge	955
293	serge	956	add edi, esi
		957	add eax, esi
		958	add ebx, esi
		959	add ecx, esi
		960	add edx, esi
		961	call [mix_4_core] ;edi, eax, ebx, ecx, edx
168	serge	962
293	serge	963	add edi, esi
		964	add eax, esi
		965	add ebx, esi
		966	add ecx, esi
		967	add edx, esi
		968	call [mix_4_core] ;edi, eax, ebx, ecx, edx
168	serge	969
293	serge	970	add edi, esi
		971	add eax, esi
		972	add ebx, esi
		973	add ecx, esi
		974	add edx, esi
		975	call [mix_4_core] ;edi, eax, ebx, ecx, edx
281	serge	976	ret
168	serge	977	endp
		978
		979	align 4
		980	proc copy_mem stdcall, output:dword, input:dword
		981
291	serge	982	mov edi, [output]
		983	mov esi, [input]
		984	mov ecx, 0x80
168	serge	985	.l1:
291	serge	986	mov eax, [esi]
		987	mov [edi], eax
		988	add esi, 4
		989	add edi, 4
		990	loop .l1
168	serge	991
291	serge	992	ret
168	serge	993	endp
		994
		995	proc memcpy
		996	@@:
291	serge	997	mov eax, [esi]
		998	mov [edi], eax
		999	add esi, 4
		1000	add edi, 4
		1001	dec ecx
		1002	jnz @B
		1003	ret
168	serge	1004	endp
		1005
378	serge	1006	if 0
168	serge	1007
378	serge	1008	align 4
		1009	proc new_mix stdcall, output:dword
		1010	locals
		1011	mixCounter dd ?
		1012	mixIndex dd ?
		1013	streamIndex dd ?
		1014	inputCount dd ?
		1015	main_count dd ?
		1016	blockCount dd ?
		1017	mix_out dd ?
		1018	endl
		1019
		1020	call prepare_playlist
		1021
		1022	cmp [play_count], 0
		1023	je .exit
		1024	call FpuSave
		1025	mov [main_count], 32;
		1026	.l00:
		1027	mov [mix_buff_map], 0x0000FFFF;
		1028	xor eax, eax
		1029	mov [mixCounter], eax
		1030	mov [mixIndex],eax
		1031	mov [streamIndex], eax;
		1032	mov ebx, [play_count]
		1033	mov [inputCount], ebx
		1034	.l0:
		1035	mov ecx, 4
		1036	.l1:
		1037	mov ebx, [streamIndex]
		1038	mov esi, [play_list+ebx*4]
		1039	mov eax, [esi+STREAM.work_read]
		1040	add [esi+STREAM.work_read], 512
		1041
		1042	mov ebx, [mixIndex]
		1043	mov [mix_input+ebx*4], eax
		1044	inc [mixCounter]
		1045	inc [mixIndex]
		1046	inc [streamIndex]
		1047	dec [inputCount]
		1048	jz .m2
		1049
		1050	dec ecx
		1051	jnz .l1
		1052
		1053	cmp [mixCounter], 4
		1054	jnz .m2
		1055
		1056	stdcall mix_4_1, [mix_input],[mix_input+4],[mix_input+8],[mix_input+12]
		1057	sub [mixIndex],4
		1058	mov ebx, [mixIndex]
		1059	mov [mix_input+ebx*4], eax
		1060	inc [mixIndex]
		1061	mov [mixCounter], 0
		1062
		1063	cmp [inputCount], 0
		1064	jnz .l0
		1065	.m2:
		1066	cmp [mixIndex], 1
		1067	jne @f
		1068	stdcall copy_mem, [output], [mix_input]
		1069	jmp .m3
		1070	@@:
		1071	cmp [mixIndex], 2
		1072	jne @f
		1073	stdcall mix_2_1, [output], [mix_input], [mix_input+4]
		1074	jmp .m3
		1075	@@:
		1076	cmp [mixIndex], 3
		1077	jne @f
		1078	stdcall mix_3_1, [output],[mix_input],[mix_input+4],[mix_input+8]
		1079	jmp .m3
		1080	@@:
		1081	stdcall final_mix, [output],[mix_input],[mix_input+4],[mix_input+8], [mix_input+12]
		1082	.m3:
		1083	add [output],512
		1084
		1085	dec [main_count]
		1086	jnz .l00
		1087
		1088	call update_stream
		1089	emms
		1090	call FpuRestore
		1091	ret
		1092	.exit:
		1093	mov edi, [output]
		1094	mov ecx, 0x1000
		1095	xor eax, eax
		1096	cld
		1097	rep stosd
		1098	ret
		1099	endp
		1100
		1101	end if
		1102

Subversion Repositories Kolibri OS

(root)/kernel/trunk/drivers/mixer.asm – Rev 431