WebSVN – Kolibri OS – Blame – /kernel/trunk/blkdev/hd_drv.inc

Rev	Author	Line No.	Line
2288	clevermous	1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		2	;; ;;
3742	clevermous	3	;; Copyright (C) KolibriOS team 2004-2013. All rights reserved. ;;
2288	clevermous	4	;; Distributed under terms of the GNU General Public License ;;
		5	;; ;;
		6	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		7
		8	$Revision: 4273 $
		9
		10
		11	; Low-level driver for HDD access
		12	; DMA support by Mario79
		13	; Access through BIOS by diamond
3712	mario79	14	; LBA48 support by Mario79
		15	;-----------------------------------------------------------------------------
3742	clevermous	16	struct HD_DATA
		17	hdbase dd ?
		18	hdid dd ?
		19	hdpos dd ?
		20	ends
		21
		22	iglobal
2288	clevermous	23	align 4
3742	clevermous	24	ide_callbacks:
		25	dd ide_callbacks.end - ide_callbacks ; strucsize
		26	dd 0 ; no close function
		27	dd 0 ; no closemedia function
		28	dd ide_querymedia
		29	dd ide_read
		30	dd ide_write
		31	dd 0 ; no flush function
		32	dd 0 ; use default cache size
		33	.end:
2288	clevermous	34
3742	clevermous	35	bd_callbacks:
		36	dd bd_callbacks.end - bd_callbacks ; strucsize
		37	dd 0 ; no close function
		38	dd 0 ; no closemedia function
		39	dd bd_querymedia
		40	dd bd_read_interface
		41	dd bd_write_interface
		42	dd 0 ; no flush function
		43	dd 0 ; use default cache size
		44	.end:
2288	clevermous	45
3742	clevermous	46	hd0_data HD_DATA ?, 0, 1
		47	hd1_data HD_DATA ?, 0x10, 2
		48	hd2_data HD_DATA ?, 0, 3
		49	hd3_data HD_DATA ?, 0x10, 4
4273	clevermous	50
		51	hd_address_table:
		52	dd 0x1f0, 0x00, 0x1f0, 0x10
		53	dd 0x170, 0x00, 0x170, 0x10
3742	clevermous	54	endg
2288	clevermous	55
3742	clevermous	56	uglobal
		57	ide_mutex MUTEX
		58	ide_channel1_mutex MUTEX
		59	ide_channel2_mutex MUTEX
		60	endg
2288	clevermous	61
3742	clevermous	62	proc ide_read stdcall uses edi, \
		63	hd_data, buffer, startsector:qword, numsectors
		64	; hd_data = pointer to hd*_data
		65	; buffer = pointer to buffer for data
		66	; startsector = 64-bit start sector
		67	; numsectors = pointer to number of sectors on input,
		68	; must be filled with number of sectors really read
		69	locals
		70	sectors_todo dd ?
		71	channel_lock dd ?
		72	endl
		73	; 1. Initialize number of sectors: get number of requested sectors
		74	; and say that no sectors were read yet.
		75	mov ecx, [numsectors]
		76	mov eax, [ecx]
		77	mov dword [ecx], 0
		78	mov [sectors_todo], eax
		79	; 2. Acquire the global lock.
		80	mov ecx, ide_mutex
		81	call mutex_lock
		82	mov ecx, ide_channel2_mutex
		83	mov eax, [hd_data]
3774	mario79	84	push ecx
		85	mov ecx, [hd_address_table]
		86	cmp [eax+HD_DATA.hdbase], ecx ; 0x1F0
		87	pop ecx
3742	clevermous	88	jne .IDE_Channel_2
		89	mov ecx, ide_channel1_mutex
		90	.IDE_Channel_2:
		91	mov [channel_lock], ecx
		92	call mutex_lock
		93	; 3. Convert parameters to the form suitable for worker procedures.
		94	; Underlying procedures do not know about 64-bit sectors.
		95	; Worker procedures use global variables and edi for [buffer].
		96	cmp dword [startsector+4], 0
		97	jnz .fail
		98	and [hd_error], 0
		99	mov ecx, [hd_data]
		100	mov eax, [ecx+HD_DATA.hdbase]
		101	mov [hdbase], eax
		102	mov eax, [ecx+HD_DATA.hdid]
		103	mov [hdid], eax
		104	mov eax, [ecx+HD_DATA.hdpos]
		105	mov [hdpos], eax
		106	mov eax, dword [startsector]
		107	mov edi, [buffer]
		108	; 4. Worker procedures take one sectors per time, so loop over all sectors to read.
		109	.sectors_loop:
2288	clevermous	110	; DMA read is permitted if [allow_dma_access]=1 or 2
		111	cmp [allow_dma_access], 2
		112	ja .nodma
		113	cmp [dma_hdd], 1
		114	jnz .nodma
		115	call hd_read_dma
		116	jmp @f
		117	.nodma:
		118	call hd_read_pio
		119	@@:
		120	cmp [hd_error], 0
3742	clevermous	121	jnz .fail
		122	mov ecx, [numsectors]
		123	inc dword [ecx] ; one more sector is read
		124	dec [sectors_todo]
		125	jz .done
		126	inc eax
		127	jnz .sectors_loop
		128	; 5. Loop is done, either due to error or because everything is done.
		129	; Release the global lock and return the corresponding status.
		130	.fail:
		131	mov ecx, [channel_lock]
		132	call mutex_unlock
		133	mov ecx, ide_mutex
		134	call mutex_unlock
		135	or eax, -1
		136	ret
		137	.done:
		138	mov ecx, [channel_lock]
		139	call mutex_unlock
		140	mov ecx, ide_mutex
		141	call mutex_unlock
		142	xor eax, eax
		143	ret
		144	endp
3712	mario79	145
3742	clevermous	146	proc ide_write stdcall uses esi edi, \
		147	hd_data, buffer, startsector:qword, numsectors
		148	; hd_data = pointer to hd*_data
		149	; buffer = pointer to buffer with data
		150	; startsector = 64-bit start sector
		151	; numsectors = pointer to number of sectors on input,
		152	; must be filled with number of sectors really written
		153	locals
		154	sectors_todo dd ?
		155	channel_lock dd ?
		156	endl
		157	; 1. Initialize number of sectors: get number of requested sectors
		158	; and say that no sectors were read yet.
		159	mov ecx, [numsectors]
		160	mov eax, [ecx]
		161	mov dword [ecx], 0
		162	mov [sectors_todo], eax
		163	; 2. Acquire the global lock.
		164	mov ecx, ide_mutex
		165	call mutex_lock
		166	mov ecx, ide_channel2_mutex
		167	mov eax, [hd_data]
3774	mario79	168	push ecx
		169	mov ecx, [hd_address_table]
		170	cmp [eax+HD_DATA.hdbase], ecx ; 0x1F0
		171	pop ecx
3742	clevermous	172	jne .IDE_Channel_2
		173	mov ecx, ide_channel1_mutex
		174	.IDE_Channel_2:
		175	mov [channel_lock], ecx
		176	call mutex_lock
		177	; 3. Convert parameters to the form suitable for worker procedures.
		178	; Underlying procedures do not know about 64-bit sectors.
		179	; Worker procedures use global variables and esi for [buffer].
		180	cmp dword [startsector+4], 0
		181	jnz .fail
		182	and [hd_error], 0
		183	mov ecx, [hd_data]
		184	mov eax, [ecx+HD_DATA.hdbase]
		185	mov [hdbase], eax
		186	mov eax, [ecx+HD_DATA.hdid]
		187	mov [hdid], eax
		188	mov eax, [ecx+HD_DATA.hdpos]
		189	mov [hdpos], eax
		190	mov esi, [buffer]
		191	lea edi, [startsector]
		192	mov [cache_chain_ptr], edi
		193	; 4. Worker procedures take max 16 sectors per time,
		194	; loop until all sectors will be processed.
		195	.sectors_loop:
		196	mov ecx, 16
		197	cmp ecx, [sectors_todo]
		198	jbe @f
		199	mov ecx, [sectors_todo]
		200	@@:
		201	mov [cache_chain_size], cl
		202	; DMA write is permitted only if [allow_dma_access]=1
		203	cmp [allow_dma_access], 2
		204	jae .nodma
		205	cmp [dma_hdd], 1
		206	jnz .nodma
		207	call cache_write_dma
		208	jmp .common
		209	.nodma:
		210	mov [cache_chain_size], 1
		211	call cache_write_pio
		212	.common:
		213	cmp [hd_error], 0
		214	jnz .fail
		215	movzx ecx, [cache_chain_size]
		216	mov eax, [numsectors]
		217	add [eax], ecx
		218	sub [sectors_todo], ecx
		219	jz .done
		220	add [edi], ecx
		221	jc .fail
		222	shl ecx, 9
		223	add esi, ecx
		224	jmp .sectors_loop
		225	; 5. Loop is done, either due to error or because everything is done.
		226	; Release the global lock and return the corresponding status.
		227	.fail:
		228	mov ecx, [channel_lock]
		229	call mutex_unlock
		230	mov ecx, ide_mutex
		231	call mutex_unlock
		232	or eax, -1
		233	ret
		234	.done:
		235	mov ecx, [channel_lock]
		236	call mutex_unlock
		237	mov ecx, ide_mutex
		238	call mutex_unlock
		239	xor eax, eax
		240	ret
		241	endp
2288	clevermous	242
3742	clevermous	243	; This is a stub.
		244	proc ide_querymedia stdcall, hd_data, mediainfo
		245	mov eax, [mediainfo]
		246	mov [eax+DISKMEDIAINFO.Flags], 0
		247	mov [eax+DISKMEDIAINFO.SectorSize], 512
		248	or dword [eax+DISKMEDIAINFO.Capacity], 0xFFFFFFFF
		249	or dword [eax+DISKMEDIAINFO.Capacity+4], 0xFFFFFFFF
		250	xor eax, eax
		251	ret
		252	endp
2288	clevermous	253
3742	clevermous	254	proc bd_read_interface stdcall uses edi, \
		255	userdata, buffer, startsector:qword, numsectors
		256	; userdata = old [hdpos] = 80h + index in NumBiosDisks
		257	; buffer = pointer to buffer for data
		258	; startsector = 64-bit start sector
		259	; numsectors = pointer to number of sectors on input,
		260	; must be filled with number of sectors really read
		261	locals
		262	sectors_todo dd ?
		263	endl
		264	; 1. Initialize number of sectors: get number of requested sectors
		265	; and say that no sectors were read yet.
		266	mov ecx, [numsectors]
		267	mov eax, [ecx]
		268	mov dword [ecx], 0
		269	mov [sectors_todo], eax
		270	; 2. Acquire the global lock.
		271	mov ecx, ide_mutex
		272	call mutex_lock
		273	; 3. Convert parameters to the form suitable for worker procedures.
		274	; Underlying procedures do not know about 64-bit sectors.
		275	; Worker procedures use global variables and edi for [buffer].
		276	cmp dword [startsector+4], 0
		277	jnz .fail
		278	and [hd_error], 0
		279	mov eax, [userdata]
		280	mov [hdpos], eax
		281	mov eax, dword [startsector]
		282	mov edi, [buffer]
		283	; 4. Worker procedures take one sectors per time, so loop over all sectors to read.
		284	.sectors_loop:
		285	call bd_read
		286	cmp [hd_error], 0
		287	jnz .fail
		288	mov ecx, [numsectors]
		289	inc dword [ecx] ; one more sector is read
		290	dec [sectors_todo]
		291	jz .done
		292	inc eax
		293	jnz .sectors_loop
		294	; 5. Loop is done, either due to error or because everything is done.
		295	; Release the global lock and return the corresponding status.
		296	.fail:
		297	mov ecx, ide_mutex
		298	call mutex_unlock
		299	or eax, -1
		300	ret
		301	.done:
		302	mov ecx, ide_mutex
		303	call mutex_unlock
		304	xor eax, eax
		305	ret
		306	endp
3712	mario79	307
3742	clevermous	308	proc bd_write_interface stdcall uses esi edi, \
		309	userdata, buffer, startsector:qword, numsectors
		310	; userdata = old [hdpos] = 80h + index in NumBiosDisks
		311	; buffer = pointer to buffer with data
		312	; startsector = 64-bit start sector
		313	; numsectors = pointer to number of sectors on input,
		314	; must be filled with number of sectors really written
		315	locals
		316	sectors_todo dd ?
		317	endl
		318	; 1. Initialize number of sectors: get number of requested sectors
		319	; and say that no sectors were read yet.
		320	mov ecx, [numsectors]
		321	mov eax, [ecx]
		322	mov dword [ecx], 0
		323	mov [sectors_todo], eax
		324	; 2. Acquire the global lock.
		325	mov ecx, ide_mutex
		326	call mutex_lock
		327	; 3. Convert parameters to the form suitable for worker procedures.
		328	; Underlying procedures do not know about 64-bit sectors.
		329	; Worker procedures use global variables and esi for [buffer].
		330	cmp dword [startsector+4], 0
		331	jnz .fail
		332	and [hd_error], 0
		333	mov eax, [userdata]
		334	mov [hdpos], eax
		335	mov esi, [buffer]
		336	lea edi, [startsector]
		337	mov [cache_chain_ptr], edi
		338	; 4. Worker procedures take max 16 sectors per time,
		339	; loop until all sectors will be processed.
		340	.sectors_loop:
		341	mov ecx, 16
		342	cmp ecx, [sectors_todo]
		343	jbe @f
		344	mov ecx, [sectors_todo]
		345	@@:
		346	mov [cache_chain_size], cl
		347	call bd_write_cache_chain
		348	cmp [hd_error], 0
		349	jnz .fail
		350	movzx ecx, [cache_chain_size]
		351	mov eax, [numsectors]
		352	add [eax], ecx
		353	sub [sectors_todo], ecx
		354	jz .done
		355	add [edi], ecx
		356	jc .fail
		357	shl ecx, 9
		358	add esi, ecx
		359	jmp .sectors_loop
		360	; 5. Loop is done, either due to error or because everything is done.
		361	; Release the global lock and return the corresponding status.
		362	.fail:
		363	mov ecx, ide_mutex
		364	call mutex_unlock
		365	or eax, -1
		366	ret
		367	.done:
		368	mov ecx, ide_mutex
		369	call mutex_unlock
		370	xor eax, eax
		371	ret
		372	endp
2288	clevermous	373
3742	clevermous	374	; This is a stub.
		375	proc bd_querymedia stdcall, hd_data, mediainfo
		376	mov eax, [mediainfo]
		377	mov [eax+DISKMEDIAINFO.Flags], 0
		378	mov [eax+DISKMEDIAINFO.SectorSize], 512
		379	or dword [eax+DISKMEDIAINFO.Capacity], 0xFFFFFFFF
		380	or dword [eax+DISKMEDIAINFO.Capacity+4], 0xFFFFFFFF
		381	xor eax, eax
		382	ret
		383	endp
3712	mario79	384
		385	;-----------------------------------------------------------------------------
2288	clevermous	386	align 4
3742	clevermous	387	; input: eax = sector, edi -> buffer
		388	; output: edi = edi + 512
2288	clevermous	389	hd_read_pio:
		390	push eax edx
		391
3712	mario79	392	; Select the desired drive
3702	mario79	393	mov edx, [hdbase]
		394	add edx, 6 ;адрес регистра головок
		395	mov al, byte [hdid]
		396	add al, 128+64+32
		397	out dx, al; номер головки/номер диска
3711	clevermous	398
2288	clevermous	399	call wait_for_hd_idle
		400	cmp [hd_error], 0
		401	jne hd_read_error
3711	clevermous	402
3702	mario79	403	; ATA with 28 or 48 bit for sector number?
		404	mov eax, [esp+4]
		405	cmp eax, 0x10000000
3711	clevermous	406	jae .lba48
3712	mario79	407	;--------------------------------------
3702	mario79	408	.lba28:
3706	mario79	409	pushfd
2288	clevermous	410	cli
		411	xor eax, eax
		412	mov edx, [hdbase]
		413	inc edx
3706	mario79	414	out dx, al ; ATA Features регистр "особенностей"
2288	clevermous	415	inc edx
		416	inc eax
3706	mario79	417	out dx, al ; ATA Sector Counter счётчик секторов
2288	clevermous	418	inc edx
3706	mario79	419	mov eax, [esp+4+4]
		420	out dx, al ; LBA Low LBA (7:0)
2288	clevermous	421	shr eax, 8
		422	inc edx
3706	mario79	423	out dx, al ; LBA Mid LBA (15:8)
2288	clevermous	424	shr eax, 8
		425	inc edx
3706	mario79	426	out dx, al ; LBA High LBA (23:16)
2288	clevermous	427	shr eax, 8
		428	inc edx
3706	mario79	429	and al, 1+2+4+8 ; LBA (27:24)
2288	clevermous	430	add al, byte [hdid]
		431	add al, 128+64+32
3706	mario79	432	out dx, al ; номер головки/номер диска
2288	clevermous	433	inc edx
3711	clevermous	434	mov al, 20h ; READ SECTOR(S)
3706	mario79	435	out dx, al ; ATACommand регистр команд
		436	popfd
3711	clevermous	437	jmp .continue
3712	mario79	438	;--------------------------------------
3702	mario79	439	.lba48:
3706	mario79	440	pushfd
3702	mario79	441	cli
		442	xor eax, eax
		443	mov edx, [hdbase]
		444	inc edx
		445	out dx, al ; Features Previous Reserved
		446	out dx, al ; Features Current Reserved
		447	inc edx
		448	out dx, al ; Sector Count Previous Sector count (15:8)
		449	inc eax
		450	out dx, al ; Sector Count Current Sector count (7:0)
		451	inc edx
3706	mario79	452	mov eax, [esp+4+4]
3711	clevermous	453	rol eax, 8
3702	mario79	454	out dx, al ; LBA Low Previous LBA (31:24)
3712	mario79	455	xor eax, eax ; because only 32 bit cache
3702	mario79	456	inc edx
		457	out dx, al ; LBA Mid Previous LBA (39:32)
		458	inc edx
		459	out dx, al ; LBA High Previous LBA (47:40)
3711	clevermous	460	sub edx, 2
3706	mario79	461	mov eax, [esp+4+4]
3702	mario79	462	out dx, al ; LBA Low Current LBA (7:0)
		463	shr eax, 8
		464	inc edx
		465	out dx, al ; LBA Mid Current LBA (15:8)
		466	shr eax, 8
		467	inc edx
		468	out dx, al ; LBA High Current LBA (23:16)
		469	inc edx
		470	mov al, byte [hdid]
		471	add al, 128+64+32
3712	mario79	472	out dx, al ; номер головки/номер диска
3702	mario79	473	inc edx
3711	clevermous	474	mov al, 24h ; READ SECTOR(S) EXT
3712	mario79	475	out dx, al ; ATACommand регистр команд
3706	mario79	476	popfd
3712	mario79	477	;--------------------------------------
3702	mario79	478	.continue:
2288	clevermous	479	call wait_for_sector_buffer
		480
		481	cmp [hd_error], 0
		482	jne hd_read_error
		483
3712	mario79	484	pushfd
2288	clevermous	485	cli
3712	mario79	486
2288	clevermous	487	mov ecx, 256
		488	mov edx, [hdbase]
		489	cld
		490	rep insw
3712	mario79	491	popfd
2288	clevermous	492
		493	pop edx eax
		494	ret
3712	mario79	495	;-----------------------------------------------------------------------------
2288	clevermous	496	align 4
3742	clevermous	497	; edi -> sector, esi -> data
2288	clevermous	498	cache_write_pio:
3712	mario79	499	; Select the desired drive
3702	mario79	500	mov edx, [hdbase]
		501	add edx, 6 ;адрес регистра головок
		502	mov al, byte [hdid]
		503	add al, 128+64+32
3712	mario79	504	out dx, al ; номер головки/номер диска
3702	mario79	505
2288	clevermous	506	call wait_for_hd_idle
		507	cmp [hd_error], 0
		508	jne hd_write_error
		509
3706	mario79	510	; ATA with 28 or 48 bit for sector number?
3742	clevermous	511	mov eax, [edi]
3706	mario79	512	cmp eax, 0x10000000
		513	jae .lba48
3712	mario79	514	;--------------------------------------
3706	mario79	515	.lba28:
		516	pushfd
2288	clevermous	517	cli
		518	xor eax, eax
		519	mov edx, [hdbase]
		520	inc edx
3706	mario79	521	out dx, al ; ATA Features регистр "особенностей"
2288	clevermous	522	inc edx
		523	inc eax
3706	mario79	524	out dx, al ; ATA Sector Counter счётчик секторов
2288	clevermous	525	inc edx
3742	clevermous	526	mov eax, [edi] ; eax = sector to write
3706	mario79	527	out dx, al ; LBA Low LBA (7:0)
2288	clevermous	528	shr eax, 8
		529	inc edx
3706	mario79	530	out dx, al ; LBA Mid LBA (15:8)
2288	clevermous	531	shr eax, 8
		532	inc edx
3706	mario79	533	out dx, al ; LBA High LBA (23:16)
2288	clevermous	534	shr eax, 8
		535	inc edx
3706	mario79	536	and al, 1+2+4+8 ; LBA (27:24)
2288	clevermous	537	add al, byte [hdid]
		538	add al, 128+64+32
3706	mario79	539	out dx, al ; номер головки/номер диска
2288	clevermous	540	inc edx
3706	mario79	541	mov al, 30h ; WRITE SECTOR(S)
		542	out dx, al ; ATACommand регистр команд
3711	clevermous	543	jmp .continue
3712	mario79	544	;--------------------------------------
3706	mario79	545	.lba48:
		546	pushfd
		547	cli
		548	xor eax, eax
		549	mov edx, [hdbase]
		550	inc edx
		551	out dx, al ; Features Previous Reserved
		552	out dx, al ; Features Current Reserved
		553	inc edx
		554	out dx, al ; Sector Count Previous Sector count (15:8)
		555	inc eax
		556	out dx, al ; Sector Count Current Sector count (7:0)
		557	inc edx
3742	clevermous	558	mov eax, [edi]
3711	clevermous	559	rol eax, 8
3706	mario79	560	out dx, al ; LBA Low Previous LBA (31:24)
3712	mario79	561	xor eax, eax ; because only 32 bit cache
3706	mario79	562	inc edx
		563	out dx, al ; LBA Mid Previous LBA (39:32)
		564	inc edx
		565	out dx, al ; LBA High Previous LBA (47:40)
3711	clevermous	566	sub edx, 2
3742	clevermous	567	mov eax, [edi]
3706	mario79	568	out dx, al ; LBA Low Current LBA (7:0)
		569	shr eax, 8
		570	inc edx
		571	out dx, al ; LBA Mid Current LBA (15:8)
		572	shr eax, 8
		573	inc edx
		574	out dx, al ; LBA High Current LBA (23:16)
		575	inc edx
		576	mov al, byte [hdid]
		577	add al, 128+64+32
3712	mario79	578	out dx, al ; номер головки/номер диска
3706	mario79	579	inc edx
3711	clevermous	580	mov al, 34h ; WRITE SECTOR(S) EXT
3712	mario79	581	out dx, al ; ATACommand регистр команд
		582	;--------------------------------------
3706	mario79	583	.continue:
3881	mario79	584	popfd
2288	clevermous	585	call wait_for_sector_buffer
		586
		587	cmp [hd_error], 0
		588	jne hd_write_error
		589
		590	push ecx esi
		591
3712	mario79	592	pushfd
2288	clevermous	593	cli
		594	mov ecx, 256
		595	mov edx, [hdbase]
		596	cld
		597	rep outsw
3712	mario79	598	popfd
2288	clevermous	599
		600	pop esi ecx
		601	ret
3712	mario79	602	;-----------------------------------------------------------------------------
		603	align 4
2288	clevermous	604	save_hd_wait_timeout:
		605	push eax
		606	mov eax, [timer_ticks]
		607	add eax, 300 ; 3 sec timeout
		608	mov [hd_wait_timeout], eax
		609	pop eax
		610	ret
3712	mario79	611	;-----------------------------------------------------------------------------
2288	clevermous	612	align 4
		613	check_hd_wait_timeout:
		614	push eax
		615	mov eax, [hd_wait_timeout]
		616	cmp [timer_ticks], eax
		617	jg hd_timeout_error
3712	mario79	618
2288	clevermous	619	pop eax
		620	mov [hd_error], 0
		621	ret
3712	mario79	622	;-----------------------------------------------------------------------------
2288	clevermous	623	hd_timeout_error:
3712	mario79	624	if lang eq sp
		625	DEBUGF 1,"K : FS - HD tiempo de espera agotado\n"
		626	else
		627	DEBUGF 1,"K : FS - HD timeout\n"
		628	end if
2288	clevermous	629	mov [hd_error], 1
		630	pop eax
		631	ret
3712	mario79	632	;-----------------------------------------------------------------------------
2288	clevermous	633	hd_read_error:
3712	mario79	634	if lang eq sp
		635	DEBUGF 1,"K : FS - HD error de lectura\n"
		636	else
		637	DEBUGF 1,"K : FS - HD read error\n"
		638	end if
2288	clevermous	639	pop edx eax
		640	ret
3712	mario79	641	;-----------------------------------------------------------------------------
		642	hd_write_error_dma:
		643	pop esi
2288	clevermous	644	hd_write_error:
3309	esevece	645	if lang eq sp
		646	DEBUGF 1,"K : FS - HD error de escritura\n"
		647	else
		648	DEBUGF 1,"K : FS - HD write error\n"
		649	end if
2288	clevermous	650	ret
3712	mario79	651	;-----------------------------------------------------------------------------
2288	clevermous	652	align 4
		653	wait_for_hd_idle:
		654	push eax edx
		655
		656	call save_hd_wait_timeout
		657
		658	mov edx, [hdbase]
		659	add edx, 0x7
3712	mario79	660	;--------------------------------------
		661	align 4
		662	wfhil1:
2288	clevermous	663	call check_hd_wait_timeout
		664	cmp [hd_error], 0
		665	jne @f
		666
		667	in al, dx
		668	test al, 128
		669	jnz wfhil1
		670
3712	mario79	671	@@:
2288	clevermous	672	pop edx eax
		673	ret
3712	mario79	674	;-----------------------------------------------------------------------------
2288	clevermous	675	align 4
		676	wait_for_sector_buffer:
		677	push eax edx
		678
		679	mov edx, [hdbase]
		680	add edx, 0x7
		681
		682	call save_hd_wait_timeout
3712	mario79	683	;--------------------------------------
		684	align 4
		685	hdwait_sbuf: ; wait for sector buffer to be ready
2288	clevermous	686	call check_hd_wait_timeout
		687	cmp [hd_error], 0
		688	jne @f
		689
		690	in al, dx
		691	test al, 8
		692	jz hdwait_sbuf
		693
		694	mov [hd_error], 0
		695
		696	cmp [hd_setup], 1 ; do not mark error for setup request
		697	je buf_wait_ok
		698
		699	test al, 1 ; previous command ended up with an error
		700	jz buf_wait_ok
3712	mario79	701	@@:
2288	clevermous	702	mov [hd_error], 1
		703
3712	mario79	704	buf_wait_ok:
2288	clevermous	705	pop edx eax
		706	ret
3712	mario79	707	;-----------------------------------------------------------------------------
3762	mario79	708	irq14_num equ byte 14
		709	irq15_num equ byte 15
		710	;-----------------------------------------------------------------------------
2288	clevermous	711	align 4
		712	wait_for_sector_dma_ide0:
		713	push eax
		714	push edx
		715	call save_hd_wait_timeout
3712	mario79	716	;--------------------------------------
		717	align 4
2288	clevermous	718	.wait:
		719	call change_task
3870	mario79	720	cmp [IDE_common_irq_param], 0
		721	jz .done
3762	mario79	722
2288	clevermous	723	call check_hd_wait_timeout
		724	cmp [hd_error], 0
		725	jz .wait
3881	mario79	726	; clear Bus Master IDE Command register
3870	mario79	727	pushfd
		728	cli
3762	mario79	729	mov [IDE_common_irq_param], 0
2288	clevermous	730	mov dx, [IDEContrRegsBaseAddr]
		731	mov al, 0
		732	out dx, al
3870	mario79	733	popfd
3881	mario79	734	;--------------------------------------
		735	align 4
2288	clevermous	736	.done:
		737	pop edx
		738	pop eax
		739	ret
3712	mario79	740	;-----------------------------------------------------------------------------
2288	clevermous	741	align 4
		742	wait_for_sector_dma_ide1:
		743	push eax
		744	push edx
		745	call save_hd_wait_timeout
3712	mario79	746	;--------------------------------------
		747	align 4
2288	clevermous	748	.wait:
		749	call change_task
3870	mario79	750	cmp [IDE_common_irq_param], 0
		751	jz .done
3762	mario79	752
2288	clevermous	753	call check_hd_wait_timeout
		754	cmp [hd_error], 0
		755	jz .wait
3881	mario79	756	; clear Bus Master IDE Command register
3870	mario79	757	pushfd
		758	cli
3762	mario79	759	mov [IDE_common_irq_param], 0
2288	clevermous	760	mov dx, [IDEContrRegsBaseAddr]
		761	add dx, 8
		762	mov al, 0
		763	out dx, al
3870	mario79	764	popfd
3881	mario79	765	;--------------------------------------
		766	align 4
2288	clevermous	767	.done:
		768	pop edx
		769	pop eax
		770	ret
3712	mario79	771	;-----------------------------------------------------------------------------
2288	clevermous	772	iglobal
		773	align 4
		774	; note that IDE descriptor table must be 4-byte aligned and do not cross 4K boundary
		775	IDE_descriptor_table:
3712	mario79	776	dd IDE_DMA
		777	dw 0x2000
		778	dw 0x8000
2288	clevermous	779
3712	mario79	780	dma_cur_sector dd not 40h
		781	dma_hdpos dd 0
3762	mario79	782	IDE_common_irq_param db 0
2288	clevermous	783	endg
3712	mario79	784	;-----------------------------------------------------------------------------
2288	clevermous	785	uglobal
		786	; all uglobals are zeroed at boot
3712	mario79	787	dma_process dd 0
		788	dma_slot_ptr dd 0
		789	cache_chain_pos dd 0
		790	cache_chain_ptr dd 0
		791	cache_chain_size db 0
		792	cache_chain_started db 0
		793	dma_task_switched db 0
		794	dma_hdd db 0
		795	allow_dma_access db 0
2288	clevermous	796	endg
3712	mario79	797	;-----------------------------------------------------------------------------
2288	clevermous	798	align 4
3870	mario79	799	IDE_irq_14_handler:
		800	cmp [IDE_common_irq_param], irq14_num
		801	jne .exit
		802
2288	clevermous	803	pushfd
		804	cli
		805	pushad
3881	mario79	806	; clear Bus Master IDE Command register
3870	mario79	807	mov [IDE_common_irq_param], 0
2288	clevermous	808	mov dx, [IDEContrRegsBaseAddr]
		809	mov al, 0
		810	out dx, al
3881	mario79	811	; clear Bus Master IDE Status register
		812	; clear Interrupt bit
		813	add edx, 2
		814	mov al, 4 ; 100b
		815	out dx, al
3870	mario79	816
		817	popad
		818	popfd
3881	mario79	819	;--------------------------------------
		820	align 4
3870	mario79	821	.exit:
		822	mov al, 1
		823	ret
		824	;-----------------------------------------------------------------------------
2288	clevermous	825	align 4
3870	mario79	826	IDE_irq_15_handler:
		827	cmp [IDE_common_irq_param], irq15_num
		828	jne .exit
		829
		830	pushfd
		831	cli
		832	pushad
3881	mario79	833	; clear Bus Master IDE Command register
3870	mario79	834	mov [IDE_common_irq_param], 0
2288	clevermous	835	mov dx, [IDEContrRegsBaseAddr]
		836	add dx, 8
		837	mov al, 0
		838	out dx, al
3881	mario79	839	; clear Bus Master IDE Status register
		840	; clear Interrupt bit
		841	add edx, 2
		842	mov al, 4 ; 100b
		843	out dx, al
3870	mario79	844
		845	popad
		846	popfd
3881	mario79	847	;--------------------------------------
		848	align 4
3870	mario79	849	.exit:
		850	mov al, 1
		851	ret
		852	;-----------------------------------------------------------------------------
		853	align 4
		854	IDE_common_irq_handler:
		855	cmp [IDE_common_irq_param], 0
		856	je .exit
		857
		858	pushfd
		859	cli
		860	pushad
3881	mario79	861	; clear Bus Master IDE Command register
3870	mario79	862	xor ebx, ebx
		863	mov dx, [IDEContrRegsBaseAddr]
		864	mov eax, IDE_common_irq_param
		865	cmp [eax], irq14_num
		866	mov [eax], bl
		867	xor eax, eax
		868	je @f
		869
		870	add dx, 8
3762	mario79	871	;--------------------------------------
		872	align 4
3870	mario79	873	@@:
		874	out dx, al
3881	mario79	875	; clear Bus Master IDE Status register
		876	; clear Interrupt bit
		877	add edx, 2
		878	mov al, 4 ; 100b
		879	out dx, al
3870	mario79	880
2288	clevermous	881	popad
		882	popfd
3881	mario79	883	;--------------------------------------
		884	align 4
3870	mario79	885	.exit:
3762	mario79	886	mov al, 1
2288	clevermous	887	ret
3712	mario79	888	;-----------------------------------------------------------------------------
2288	clevermous	889	align 4
		890	hd_read_dma:
		891	push eax
		892	push edx
		893	mov edx, [dma_hdpos]
		894	cmp edx, [hdpos]
		895	jne .notread
		896	mov edx, [dma_cur_sector]
		897	cmp eax, edx
		898	jb .notread
		899	add edx, 15
		900	cmp [esp+4], edx
		901	ja .notread
		902	mov eax, [esp+4]
		903	sub eax, [dma_cur_sector]
		904	shl eax, 9
		905	add eax, (OS_BASE+IDE_DMA)
3742	clevermous	906	push ecx esi
2288	clevermous	907	mov esi, eax
3712	mario79	908
2288	clevermous	909	mov ecx, 512/4
		910	cld
		911	rep movsd
3742	clevermous	912	pop esi ecx
2288	clevermous	913	pop edx
		914	pop eax
		915	ret
		916	.notread:
3870	mario79	917	; set data for PRD Table
2288	clevermous	918	mov eax, IDE_descriptor_table
		919	mov dword [eax], IDE_DMA
		920	mov word [eax+4], 0x2000
		921	sub eax, OS_BASE
3870	mario79	922	; select controller Primary or Secondary
2288	clevermous	923	mov dx, [IDEContrRegsBaseAddr]
3774	mario79	924	push eax
		925	mov eax, [hd_address_table]
		926	cmp [hdbase], eax ; 0x1F0
		927	pop eax
2288	clevermous	928	jz @f
		929	add edx, 8
		930	@@:
		931	push edx
3870	mario79	932	; Bus Master IDE PRD Table Address
2288	clevermous	933	add edx, 4
3870	mario79	934	; save IDE_descriptor_table
2288	clevermous	935	out dx, eax
		936	pop edx
3870	mario79	937	; clear Bus Master IDE Command register
2288	clevermous	938	mov al, 0
		939	out dx, al
3870	mario79	940	; clear Bus Master IDE Status register
		941	; clear Error bit and Interrupt bit
2288	clevermous	942	add edx, 2
3870	mario79	943	mov al, 6 ; 110b
2288	clevermous	944	out dx, al
3712	mario79	945	; Select the desired drive
		946	mov edx, [hdbase]
		947	add edx, 6 ; адрес регистра головок
		948	mov al, byte [hdid]
		949	add al, 128+64+32
		950	out dx, al ; номер головки/номер диска
		951
2288	clevermous	952	call wait_for_hd_idle
		953	cmp [hd_error], 0
		954	jnz hd_read_error
3712	mario79	955
		956	; ATA with 28 or 48 bit for sector number?
		957	mov eax, [esp+4]
		958	; -10h because the PreCache hits the boundary between lba28 and lba48
		959	; 10h = 16 - size of PreCache
		960	cmp eax, 0x10000000-10h
		961	jae .lba48
		962	;--------------------------------------
		963	.lba28:
		964	pushfd
		965	cli
2288	clevermous	966	xor eax, eax
		967	mov edx, [hdbase]
		968	inc edx
3712	mario79	969	out dx, al ; ATA Features регистр "особенностей"
2288	clevermous	970	inc edx
3712	mario79	971	mov eax, 10h ; Sector Counter = 16 ; PreCache
		972	out dx, al ; ATA Sector Counter счётчик секторов
2288	clevermous	973	inc edx
3712	mario79	974	mov eax, [esp+4+4]
		975	out dx, al ; LBA Low LBA (7:0)
2288	clevermous	976	shr eax, 8
		977	inc edx
3712	mario79	978	out dx, al ; LBA Mid LBA (15:8)
2288	clevermous	979	shr eax, 8
		980	inc edx
3712	mario79	981	out dx, al ; LBA High LBA (23:16)
2288	clevermous	982	shr eax, 8
		983	inc edx
3712	mario79	984	and al, 0xF ; LBA (27:24)
2288	clevermous	985	add al, byte [hdid]
		986	add al, 11100000b
3712	mario79	987	out dx, al ; номер головки/номер диска
2288	clevermous	988	inc edx
3712	mario79	989	mov al, 0xC8 ; READ DMA
		990	out dx, al ; ATACommand регистр команд
		991	jmp .continue
		992	;--------------------------------------
		993	.lba48:
		994	pushfd
		995	cli
		996	xor eax, eax
		997	mov edx, [hdbase]
		998	inc edx
		999	out dx, al ; Features Previous Reserved
		1000	out dx, al ; Features Current Reserved
		1001	inc edx
		1002	out dx, al ; Sector Count Previous Sector count (15:8)
		1003	mov eax, 10h ; Sector Counter = 16 PreCache
		1004	out dx, al ; Sector Count Current Sector count (7:0)
		1005	inc edx
		1006	mov eax, [esp+4+4]
		1007	rol eax, 8
		1008	out dx, al ; LBA Low Previous LBA (31:24)
		1009	xor eax, eax ; because only 32 bit cache
		1010	inc edx
		1011	out dx, al ; LBA Mid Previous LBA (39:32)
		1012	inc edx
		1013	out dx, al ; LBA High Previous LBA (47:40)
		1014	sub edx, 2
		1015	mov eax, [esp+4+4]
		1016	out dx, al ; LBA Low Current LBA (7:0)
		1017	shr eax, 8
		1018	inc edx
		1019	out dx, al ; LBA Mid Current LBA (15:8)
		1020	shr eax, 8
		1021	inc edx
		1022	out dx, al ; LBA High Current LBA (23:16)
		1023	inc edx
		1024	mov al, byte [hdid]
		1025	add al, 128+64+32
		1026	out dx, al ; номер головки/номер диска
		1027	inc edx
		1028	mov al, 25h ; READ DMA EXT
		1029	out dx, al ; ATACommand регистр команд
		1030	;--------------------------------------
		1031	.continue:
3870	mario79	1032	; select controller Primary or Secondary
2288	clevermous	1033	mov dx, [IDEContrRegsBaseAddr]
3712	mario79	1034	mov eax, [hd_address_table]
		1035	cmp [hdbase], eax ; 0x1F0
2288	clevermous	1036	jz @f
		1037	add dx, 8
		1038	@@:
3870	mario79	1039	; set write to memory and Start Bus Master
2288	clevermous	1040	mov al, 9
		1041	out dx, al
3870	mario79	1042
2288	clevermous	1043	mov eax, [CURRENT_TASK]
		1044	mov [dma_process], eax
3870	mario79	1045
2288	clevermous	1046	mov eax, [TASK_BASE]
		1047	mov [dma_slot_ptr], eax
3870	mario79	1048
3712	mario79	1049	mov eax, [hd_address_table]
		1050	cmp [hdbase], eax ; 0x1F0
2288	clevermous	1051	jnz .ide1
3762	mario79	1052
		1053	mov [IDE_common_irq_param], irq14_num
2288	clevermous	1054	jmp @f
		1055	.ide1:
3762	mario79	1056	mov [IDE_common_irq_param], irq15_num
2288	clevermous	1057	@@:
3712	mario79	1058	popfd
3870	mario79	1059	; wait for interrupt
3712	mario79	1060	mov eax, [hd_address_table]
		1061	cmp [hdbase], eax ; 0x1F0
2288	clevermous	1062	jnz .wait_ide1
		1063	call wait_for_sector_dma_ide0
		1064	jmp @f
		1065	.wait_ide1:
		1066	call wait_for_sector_dma_ide1
		1067	@@:
		1068	cmp [hd_error], 0
		1069	jnz hd_read_error
		1070	mov eax, [hdpos]
		1071	mov [dma_hdpos], eax
		1072	pop edx
		1073	pop eax
		1074	mov [dma_cur_sector], eax
		1075	jmp hd_read_dma
3712	mario79	1076	;-----------------------------------------------------------------------------
3742	clevermous	1077	cache_write_dma:
3881	mario79	1078	mov eax, [cache_chain_ptr] ; for what?
2288	clevermous	1079	push esi
3881	mario79	1080	; set data for PRD Table
2288	clevermous	1081	mov eax, IDE_descriptor_table
		1082	mov edx, eax
		1083	pusha
		1084	mov edi, (OS_BASE+IDE_DMA)
		1085	mov dword [edx], IDE_DMA
		1086	movzx ecx, [cache_chain_size]
		1087	shl ecx, 9
		1088	mov word [edx+4], cx
		1089	shr ecx, 2
		1090	cld
		1091	rep movsd
		1092	popa
		1093	sub eax, OS_BASE
3881	mario79	1094	; select controller Primary or Secondary
2288	clevermous	1095	mov dx, [IDEContrRegsBaseAddr]
3774	mario79	1096	push eax
		1097	mov eax, [hd_address_table]
		1098	cmp [hdbase], eax ; 0x1F0
		1099	pop eax
2288	clevermous	1100	jz @f
		1101	add edx, 8
		1102	@@:
		1103	push edx
3881	mario79	1104	; Bus Master IDE PRD Table Address
2288	clevermous	1105	add edx, 4
3881	mario79	1106	; save IDE_descriptor_table
2288	clevermous	1107	out dx, eax
		1108	pop edx
3881	mario79	1109	; clear Bus Master IDE Command register
2288	clevermous	1110	mov al, 0
		1111	out dx, al
3881	mario79	1112	; clear Bus Master IDE Status register
		1113	; clear Error bit and Interrupt bit
2288	clevermous	1114	add edx, 2
		1115	mov al, 6
		1116	out dx, al
3712	mario79	1117	; Select the desired drive
		1118	mov edx, [hdbase]
		1119	add edx, 6 ; адрес регистра головок
		1120	mov al, byte [hdid]
		1121	add al, 128+64+32
		1122	out dx, al ; номер головки/номер диска
		1123
2288	clevermous	1124	call wait_for_hd_idle
		1125	cmp [hd_error], 0
		1126	jnz hd_write_error_dma
3712	mario79	1127
		1128	; ATA with 28 or 48 bit for sector number?
		1129	mov esi, [cache_chain_ptr]
		1130	mov eax, [esi]
		1131	; -40h because the PreCache hits the boundary between lba28 and lba48
		1132	; 40h = 64 - the maximum number of sectors to be written for one command
		1133	cmp eax, 0x10000000-40h
		1134	jae .lba48
		1135	;--------------------------------------
		1136	.lba28:
		1137	pushfd
		1138	cli
2288	clevermous	1139	xor eax, eax
		1140	mov edx, [hdbase]
		1141	inc edx
3712	mario79	1142	out dx, al ; ATA Features регистр "особенностей"
2288	clevermous	1143	inc edx
3712	mario79	1144	mov al, [cache_chain_size] ; Sector Counter
		1145	out dx, al ; ATA Sector Counter счётчик секторов
2288	clevermous	1146	inc edx
		1147	mov eax, [esi]
3712	mario79	1148	out dx, al ; LBA Low LBA (7:0)
2288	clevermous	1149	shr eax, 8
		1150	inc edx
3712	mario79	1151	out dx, al ; LBA Mid LBA (15:8)
2288	clevermous	1152	shr eax, 8
		1153	inc edx
3712	mario79	1154	out dx, al ; LBA High LBA (23:16)
2288	clevermous	1155	shr eax, 8
		1156	inc edx
3712	mario79	1157	and al, 0xF ; LBA (27:24)
2288	clevermous	1158	add al, byte [hdid]
		1159	add al, 11100000b
3712	mario79	1160	out dx, al ; номер головки/номер диска
2288	clevermous	1161	inc edx
3712	mario79	1162	mov al, 0xCA ; WRITE DMA
		1163	out dx, al ; ATACommand регистр команд
		1164	jmp .continue
		1165	;--------------------------------------
		1166	.lba48:
		1167	pushfd
		1168	cli
		1169	xor eax, eax
		1170	mov edx, [hdbase]
		1171	inc edx
		1172	out dx, al ; Features Previous Reserved
		1173	out dx, al ; Features Current Reserved
		1174	inc edx
		1175	out dx, al ; Sector Count Previous Sector count (15:8)
		1176	mov al, [cache_chain_size] ; Sector Counter
		1177	out dx, al ; Sector Count Current Sector count (7:0)
		1178	inc edx
		1179	mov eax, [esi]
		1180	rol eax, 8
		1181	out dx, al ; LBA Low Previous LBA (31:24)
		1182	xor eax, eax ; because only 32 bit cache
		1183	inc edx
		1184	out dx, al ; LBA Mid Previous LBA (39:32)
		1185	inc edx
		1186	out dx, al ; LBA High Previous LBA (47:40)
		1187	sub edx, 2
		1188	mov eax, [esi]
		1189	out dx, al ; LBA Low Current LBA (7:0)
		1190	shr eax, 8
		1191	inc edx
		1192	out dx, al ; LBA Mid Current LBA (15:8)
		1193	shr eax, 8
		1194	inc edx
		1195	out dx, al ; LBA High Current LBA (23:16)
		1196	inc edx
		1197	mov al, byte [hdid]
		1198	add al, 128+64+32
		1199	out dx, al ; номер головки/номер диска
		1200	inc edx
		1201	mov al, 35h ; WRITE DMA EXT
		1202	out dx, al ; ATACommand регистр команд
		1203	;--------------------------------------
		1204	.continue:
3881	mario79	1205	; select controller Primary or Secondary
2288	clevermous	1206	mov dx, [IDEContrRegsBaseAddr]
3712	mario79	1207	mov eax, [hd_address_table]
		1208	cmp [hdbase], eax ; 0x1F0
2288	clevermous	1209	jz @f
		1210	add dx, 8
		1211	@@:
3881	mario79	1212	; set write to device and Start Bus Master
2288	clevermous	1213	mov al, 1
		1214	out dx, al
		1215	mov eax, [CURRENT_TASK]
		1216	mov [dma_process], eax
		1217	mov eax, [TASK_BASE]
		1218	mov [dma_slot_ptr], eax
3712	mario79	1219	mov eax, [hd_address_table]
		1220	cmp [hdbase], eax ; 0x1F0
2288	clevermous	1221	jnz .ide1
3762	mario79	1222
		1223	mov [IDE_common_irq_param], irq14_num
2288	clevermous	1224	jmp @f
		1225	.ide1:
3762	mario79	1226	mov [IDE_common_irq_param], irq15_num
2288	clevermous	1227	@@:
3712	mario79	1228	popfd
3881	mario79	1229	; wait for interrupt
2288	clevermous	1230	mov [dma_cur_sector], not 0x40
3712	mario79	1231	mov eax, [hd_address_table]
		1232	cmp [hdbase], eax ; 0x1F0
2288	clevermous	1233	jnz .wait_ide1
		1234	call wait_for_sector_dma_ide0
		1235	jmp @f
		1236	.wait_ide1:
		1237	call wait_for_sector_dma_ide1
		1238	@@:
		1239	cmp [hd_error], 0
		1240	jnz hd_write_error_dma
		1241	pop esi
		1242	ret
3712	mario79	1243	;-----------------------------------------------------------------------------
2288	clevermous	1244	uglobal
3881	mario79	1245	align 4
3762	mario79	1246	IDE_Interrupt dw ?
3712	mario79	1247	IDEContrRegsBaseAddr dw ?
		1248	IDEContrProgrammingInterface dw ?
3711	clevermous	1249	IDE_BAR0_val dw ?
		1250	IDE_BAR1_val dw ?
		1251	IDE_BAR2_val dw ?
		1252	IDE_BAR3_val dw ?
2288	clevermous	1253	endg
3712	mario79	1254	;-----------------------------------------------------------------------------
2288	clevermous	1255	; \begin{diamond}
		1256	uglobal
3712	mario79	1257	bios_hdpos dd 0 ; 0 is invalid value for [hdpos]
		1258	bios_cur_sector dd ?
		1259	bios_read_len dd ?
2288	clevermous	1260	endg
3712	mario79	1261	;-----------------------------------------------------------------------------
		1262	align 4
2288	clevermous	1263	bd_read:
		1264	push eax
		1265	push edx
		1266	mov edx, [bios_hdpos]
		1267	cmp edx, [hdpos]
		1268	jne .notread
		1269	mov edx, [bios_cur_sector]
		1270	cmp eax, edx
		1271	jb .notread
		1272	add edx, [bios_read_len]
		1273	dec edx
		1274	cmp eax, edx
		1275	ja .notread
		1276	sub eax, [bios_cur_sector]
		1277	shl eax, 9
		1278	add eax, (OS_BASE+0x9A000)
3742	clevermous	1279	push ecx esi
2288	clevermous	1280	mov esi, eax
		1281	mov ecx, 512/4
		1282	cld
		1283	rep movsd
3742	clevermous	1284	pop esi ecx
2288	clevermous	1285	pop edx
		1286	pop eax
		1287	ret
		1288	.notread:
		1289	push ecx
		1290	mov dl, 42h
		1291	mov ecx, 16
		1292	call int13_call
		1293	pop ecx
		1294	test eax, eax
		1295	jnz .v86err
		1296	test edx, edx
		1297	jz .readerr
		1298	mov [bios_read_len], edx
		1299	mov edx, [hdpos]
		1300	mov [bios_hdpos], edx
		1301	pop edx
		1302	pop eax
		1303	mov [bios_cur_sector], eax
		1304	jmp bd_read
		1305	.readerr:
		1306	.v86err:
		1307	mov [hd_error], 1
		1308	jmp hd_read_error
3712	mario79	1309	;-----------------------------------------------------------------------------
		1310	align 4
2288	clevermous	1311	bd_write_cache_chain:
		1312	pusha
		1313	mov edi, OS_BASE + 0x9A000
		1314	movzx ecx, [cache_chain_size]
		1315	push ecx
		1316	shl ecx, 9-2
		1317	rep movsd
		1318	pop ecx
		1319	mov dl, 43h
		1320	mov eax, [cache_chain_ptr]
		1321	mov eax, [eax]
		1322	call int13_call
		1323	test eax, eax
		1324	jnz .v86err
		1325	cmp edx, ecx
		1326	jnz .writeerr
		1327	popa
		1328	ret
		1329	.v86err:
		1330	.writeerr:
		1331	popa
		1332	mov [hd_error], 1
		1333	jmp hd_write_error
3712	mario79	1334	;-----------------------------------------------------------------------------
2288	clevermous	1335	uglobal
3712	mario79	1336	int13_regs_in rb sizeof.v86_regs
		1337	int13_regs_out rb sizeof.v86_regs
2288	clevermous	1338	endg
3712	mario79	1339	;-----------------------------------------------------------------------------
		1340	align 4
2288	clevermous	1341	int13_call:
		1342	; Because this code uses fixed addresses,
		1343	; it can not be run simultaniously by many threads.
3742	clevermous	1344	; In current implementation it is protected by common mutex 'ide_status'
2288	clevermous	1345	mov word [OS_BASE + 510h], 10h ; packet length
		1346	mov word [OS_BASE + 512h], cx ; number of sectors
		1347	mov dword [OS_BASE + 514h], 9A000000h ; buffer 9A00:0000
		1348	mov dword [OS_BASE + 518h], eax
		1349	and dword [OS_BASE + 51Ch], 0
		1350	push ebx ecx esi edi
		1351	mov ebx, int13_regs_in
		1352	mov edi, ebx
2384	hidnplayr	1353	mov ecx, sizeof.v86_regs/4
2288	clevermous	1354	xor eax, eax
		1355	rep stosd
		1356	mov byte [ebx+v86_regs.eax+1], dl
		1357	mov eax, [hdpos]
		1358	lea eax, [BiosDisksData+(eax-80h)*4]
		1359	mov dl, [eax]
		1360	mov byte [ebx+v86_regs.edx], dl
		1361	movzx edx, byte [eax+1]
		1362	; mov dl, 5
		1363	test edx, edx
		1364	jnz .hasirq
		1365	dec edx
		1366	jmp @f
		1367	.hasirq:
		1368	pushad
		1369	stdcall enable_irq, edx
		1370	popad
		1371	@@:
		1372	mov word [ebx+v86_regs.esi], 510h
		1373	mov word [ebx+v86_regs.ss], 9000h
		1374	mov word [ebx+v86_regs.esp], 0A000h
		1375	mov word [ebx+v86_regs.eip], 500h
		1376	mov [ebx+v86_regs.eflags], 20200h
		1377	mov esi, [sys_v86_machine]
		1378	mov ecx, 0x502
		1379	push fs
		1380	call v86_start
		1381	pop fs
		1382	and [bios_hdpos], 0
		1383	pop edi esi ecx ebx
		1384	movzx edx, byte [OS_BASE + 512h]
		1385	test byte [int13_regs_out+v86_regs.eflags], 1
		1386	jnz @f
		1387	mov edx, ecx
		1388	@@:
		1389	ret
		1390	; \end{diamond}

Subversion Repositories Kolibri OS

(root)/kernel/trunk/blkdev/hd_drv.inc – Rev 4273