WebSVN – Kolibri OS – Blame – /kernel/trunk/core/fpu.inc

Rev	Author	Line No.	Line
214	serge	1
		2	clts
		3	fninit
		4
		5
221	serge	6	jnc .no_SSE
		7
214	serge	8
		9	mov ecx, cr0
		10	or ebx, CR4_OSFXSR+CR4_OSXMMEXPT
		11	mov cr4, ebx
		12
		13
		14	or ecx, CR0_NE
		15	mov cr0, ecx
		16
		17
		18	ldmxcsr [esp-4]
		19
		20
		21	xorps xmm1, xmm1
		22	xorps xmm2, xmm2
		23	xorps xmm3, xmm3
		24	xorps xmm4, xmm4
		25	xorps xmm5, xmm5
		26	xorps xmm6, xmm6
		27	xorps xmm7, xmm7
		28	fxsave [fpu_data] ;[eax]
357	serge	29	ret
214	serge	30	.no_SSE:
221	serge	31	mov ecx, cr0
214	serge	32	and ecx, not CR0_EM
		33	or ecx, CR0_MP+CR0_NE
		34	mov cr0, ecx
		35	fnsave [fpu_data]
357	serge	36	ret
214	serge	37
		38
		39	proc fpu_save
		40	clts
		41	mov ebx, [fpu_owner]
		42	shl ebx, 8
		43	mov eax, [ebx+PROC_BASE+0x10]
		44	mov ebx, [CURRENT_TASK]
		45	mov [fpu_owner], ebx
		46
		47
221	serge	48	jnc .no_SSE
214	serge	49
		50
		51	fninit ;re-init fpu
		52	ret
		53	.no_SSE:
		54	fnsave [eax]
		55	ret
		56	endp
		57
		58
		59	proc fpu_restore
		60	mov ebx, [CURRENT_TASK]
		61	shl ebx, 8
		62	mov eax, [ebx+PROC_BASE+0x10]
		63	bt [cpu_caps], CAPS_SSE
221	serge	64	jnc .no_SSE
214	serge	65
		66
		67	ret
		68	.no_SSE:
		69	fnclex ;fix possible problems
		70	frstor [eax]
		71	ret
		72	endp
		73
		74
		75	e7: ;#NM exception handler
		76	save_ring3_context
		77	clts
		78	mov ax, os_data
		79	mov ds, ax
		80	mov es, ax
		81
		82
		83	cmp ebx, [CURRENT_TASK]
		84	je .exit
		85
		86
		87	mov eax, [ebx+PROC_BASE+APPDATA.fpu_state]
		88	bt [cpu_caps], CAPS_SSE
221	serge	89	jnc .no_SSE
214	serge	90
		91
		92	mov ebx, [CURRENT_TASK]
		93	mov [fpu_owner], ebx
		94	shl ebx, 8
		95	mov eax, [ebx+PROC_BASE+APPDATA.fpu_state]
		96	fxrstor [eax]
		97	.exit:
		98	restore_ring3_context
		99	iret
		100
		101
		102	fnsave [eax]
		103	mov ebx, [CURRENT_TASK]
		104	mov [fpu_owner], ebx
		105	shl ebx, 8
		106	mov eax, [ebx+PROC_BASE+APPDATA.fpu_state]
		107	frstor [eax]
		108	restore_ring3_context
		109	iret
		110
		111
		112	fpu_owner dd 1
		113	endg
		114
		115
		116	reg_cs equ ebp+8
		117	reg_eflags equ ebp+12
		118	reg_esp equ ebp+16
		119	reg_ss equ ebp+20
		120
		121
		122	except_16: ;fpu native exceptions handler
		123	push ebp
		124	mov ebp, esp
		125
		126
		127	push ebx
		128	push ecx
		129	push edx
		130
		131
		132	shl ebx, 8
		133
		134
		135	test eax, eax
		136	jz .default
		137
		138
		139	mov edx, [reg_esp]
		140	sub edx, 4
		141	mov [ss:edx+new_app_base], ecx
		142	mov [reg_esp], edx
		143	mov dword [reg_eip], eax
		144
		145
		146	pop ecx
		147	pop ebx
		148	pop eax
		149
		150
		151	iretd
		152
		153
		154	pop edx
		155	pop ecx
		156	pop ebx
		157	pop eax
		158	leave
		159
		160
		161
		162
		163	jmp exc_c
		164
		165
		166	except_19: ;sse exceptions handler
		167	push ebp
		168	mov ebp, esp
		169
		170
		171	push ebx
		172	push ecx
		173	push edx
		174
		175
		176	shl ebx, 8
		177
		178
		179	test eax, eax
		180	jz .default
		181
		182
		183	mov edx, [reg_esp]
		184	sub edx, 4
		185	mov [ss:edx+new_app_base], ecx
		186	mov [reg_esp], edx
		187	mov dword [reg_eip], eax
		188
		189
		190	pop ecx
		191	pop ebx
		192	pop eax
		193
		194
		195	iretd
		196
		197
		198	pop edx
		199	pop ecx
		200	pop ebx
		201	pop eax
		202	leave
		203
		204
		205
		206
		207	jmp exc_c
		208
		209
		210	restore reg_cs
		211	restore reg_eflags
		212	restore reg_esp
		213	restore reg_ss
		214

Subversion Repositories Kolibri OS

(root)/kernel/trunk/core/fpu.inc @ 2971 – Rev 357