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

Subversion Repositories Kolibri OS

(root)/kernel/trunk/blkdev/hd_drv.inc @ 472 – Rev 3881