WebSVN – Kolibri OS – Blame – /kernel/branches/Kolibri-acpi/blkdev/flp_drv.inc

Rev	Author	Line No.	Line
431	serge	1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		2	;; ;;
2465	Serge	3	;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
431	serge	4	;; Distributed under terms of the GNU General Public License ;;
		5	;; ;;
		6	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		7
593	mikedld	8	$Revision: 3555 $
		9
		10
1	ha	11	;**********************************************************
3555	Serge	12	; Непосредственная работа с контроллером гибкого диска
1	ha	13	;**********************************************************
3555	Serge	14	; Автор исходного текста Кулаков Владимир Геннадьевич.
		15	; Адаптация и доработка Mario79
1	ha	16
3555	Serge	17	;give_back_application_data: ; переслать приложению
465	serge	18	; mov edi,[TASK_BASE]
		19	; mov edi,[edi+TASKDATA.mem_start]
		20	; add edi,ecx
1	ha	21	give_back_application_data_1:
2434	Serge	22	mov esi, FDD_BUFF;FDD_DataBuffer ;0x40000
		23	xor ecx, ecx
		24	mov cx, 128
3555	Serge	25	cld
		26	rep movsd
		27	ret
1	ha	28
3555	Serge	29	;take_data_from_application: ; взять из приложени
465	serge	30	; mov esi,[TASK_BASE]
		31	; mov esi,[esi+TASKDATA.mem_start]
		32	; add esi,ecx
1	ha	33	take_data_from_application_1:
2434	Serge	34	mov edi, FDD_BUFF;FDD_DataBuffer ;0x40000
		35	xor ecx, ecx
		36	mov cx, 128
3555	Serge	37	cld
		38	rep movsd
		39	ret
1	ha	40
3555	Serge	41	; Коды завершения операции с контроллером (FDC_Status)
		42	FDC_Normal equ 0 ;нормальное завершение
		43	FDC_TimeOut equ 1 ;ошибка тайм-аута
		44	FDC_DiskNotFound equ 2 ;в дисководе нет диска
		45	FDC_TrackNotFound equ 3 ;дорожка не найдена
		46	FDC_SectorNotFound equ 4 ;сектор не найден
1	ha	47
3555	Serge	48	; Максимальные значения координат сектора (заданные
		49	; значения соответствуют параметрам стандартного
		50	; трехдюймового гибкого диска объемом 1,44 Мб)
1	ha	51	MAX_Track equ 79
		52	MAX_Head equ 1
		53	MAX_Sector equ 18
		54
75	diamond	55	uglobal
3555	Serge	56	; Счетчик тиков таймера
1	ha	57	TickCounter dd ?
3555	Serge	58	; Код завершения операции с контроллером НГМД
1	ha	59	FDC_Status DB ?
3555	Serge	60	; Флаг прерывания от НГМД
1	ha	61	FDD_IntFlag DB ?
3555	Serge	62	; Момент начала последней операции с НГМД
1	ha	63	FDD_Time DD ?
3555	Serge	64	; Номер дисковода
1	ha	65	FDD_Type db 0
3555	Serge	66	; Координаты сектора
1	ha	67	FDD_Track DB ?
		68	FDD_Head DB ?
		69	FDD_Sector DB ?
		70
3555	Serge	71	; Блок результата операции
1	ha	72	FDC_ST0 DB ?
		73	FDC_ST1 DB ?
		74	FDC_ST2 DB ?
		75	FDC_C DB ?
		76	FDC_H DB ?
		77	FDC_R DB ?
		78	FDC_N DB ?
3555	Serge	79	; Счетчик повторения операции чтени
1	ha	80	ReadRepCounter DB ?
3555	Serge	81	; Счетчик повторения операции рекалибровки
1	ha	82	RecalRepCounter DB ?
75	diamond	83	endg
3555	Serge	84	; Область памяти для хранения прочитанного сектора
1	ha	85	;FDD_DataBuffer: times 512 db 0 ;DB 512 DUP (?)
		86	fdd_motor_status db 0
		87	timer_fdd_motor dd 0
		88
		89	;*************************************
3555	Serge	90	;* ИНИЦИАЛИЗАЦИЯ РЕЖИМА ПДП ДЛЯ НГМД *
1	ha	91	;*************************************
		92	Init_FDC_DMA:
		93	pushad
2434	Serge	94	mov al, 0
		95	out 0x0c, al; reset the flip-flop to a known state.
		96	mov al, 6 ; mask channel 2 so we can reprogram it.
		97	out 0x0a, al
		98	mov al, [dmamode]; 0x46 -> Read from floppy - 0x4A Write to floppy
		99	out 0x0b, al
		100	mov al, 0
		101	out 0x0c, al; reset the flip-flop to a known state.
		102	mov eax, 0xD000
		103	out 0x04, al; set the channel 2 starting address to 0
		104	shr eax, 8
		105	out 0x04, al
		106	shr eax, 8
		107	out 0x81, al
		108	mov al, 0
		109	out 0x0c, al; reset flip-flop
		110	mov al, 0xff;set count (actual size -1)
3555	Serge	111	out 0x5, al
2434	Serge	112	mov al, 0x1;[dmasize] ;(0x1ff = 511 / 0x23ff =9215)
		113	out 0x5, al
		114	mov al, 2
		115	out 0xa, al
1	ha	116	popad
		117	ret
		118
		119	;***********************************
3555	Serge	120	;* ЗАПИСАТЬ БАЙТ В ПОРТ ДАННЫХ FDC *
		121	;* Параметры: *
		122	;* AL - выводимый байт. *
1	ha	123	;***********************************
		124	FDCDataOutput:
		125	; pusha
3555	Serge	126	push eax ecx edx
		127	mov AH, AL ;запомнить байт в AH
		128	; Сбросить переменную состояния контроллера
2434	Serge	129	mov [FDC_Status], FDC_Normal
3555	Serge	130	; Проверить готовность контроллера к приему данных
		131	mov DX, 3F4h ;(порт состояния FDC)
		132	mov ecx, 0x10000 ;установить счетчик тайм-аута
1	ha	133	@@TestRS:
3555	Serge	134	in AL, DX ;прочитать регистр RS
		135	and AL, 0C0h ;выделить разряды 6 и 7
		136	cmp AL, 80h ;проверить разряды 6 и 7
1	ha	137	je @@OutByteToFDC
		138	loop @@TestRS
3555	Serge	139	; Ошибка тайм-аута
2434	Serge	140	mov [FDC_Status], FDC_TimeOut
3555	Serge	141	jmp @@End_5
		142	; Вывести байт в порт данных
1	ha	143	@@OutByteToFDC:
		144	inc DX
2434	Serge	145	mov AL, AH
		146	out DX, AL
1	ha	147	@@End_5:
		148	; popa
3555	Serge	149	pop edx ecx eax
1	ha	150	ret
		151
		152	;******************************************
3555	Serge	153	;* ПРОЧИТАТЬ БАЙТ ИЗ ПОРТА ДАННЫХ FDC *
		154	;* Процедура не имеет входных параметров. *
		155	;* Выходные данные: *
		156	;* AL - считанный байт. *
1	ha	157	;******************************************
		158	FDCDataInput:
		159	push ECX
		160	push DX
3555	Serge	161	; Сбросить переменную состояния контроллера
2434	Serge	162	mov [FDC_Status], FDC_Normal
3555	Serge	163	; Проверить готовность контроллера к передаче данных
		164	mov DX, 3F4h ;(порт состояния FDC)
		165	xor CX, CX ;установить счетчик тайм-аута
1	ha	166	@@TestRS_1:
3555	Serge	167	in AL, DX ;прочитать регистр RS
		168	and AL, 0C0h ;выдлить разряды 6 и 7
		169	cmp AL, 0C0h ;проверить разряды 6 и 7
1	ha	170	je @@GetByteFromFDC
		171	loop @@TestRS_1
3555	Serge	172	; Ошибка тайм-аута
2434	Serge	173	mov [FDC_Status], FDC_TimeOut
3555	Serge	174	jmp @@End_6
		175	; Ввести байт из порта данных
1	ha	176	@@GetByteFromFDC:
		177	inc DX
2434	Serge	178	in AL, DX
		179	@@End_6:
		180	pop DX
1	ha	181	pop ECX
		182	ret
		183
		184	;*********************************************
3555	Serge	185	;* ОБРАБОТЧИК ПРЕРЫВАНИЯ ОТ КОНТРОЛЛЕРА НГМД *
1	ha	186	;*********************************************
		187	FDCInterrupt:
3555	Serge	188	; Установить флаг прерывани
2434	Serge	189	mov [FDD_IntFlag], 1
1	ha	190	ret
		191
		192
		193	;******************************************
3555	Serge	194	;* УСТАНОВИТЬ НОВЫЙ ОБРАБОТЧИК ПРЕРЫВАНИЙ *
		195	;* НГМД *
1	ha	196	;******************************************
		197	SetUserInterrupts:
2434	Serge	198	mov [fdc_irq_func], FDCInterrupt
3555	Serge	199	ret
1	ha	200
		201	;*******************************************
3555	Serge	202	;* ОЖИДАНИЕ ПРЕРЫВАНИЯ ОТ КОНТРОЛЛЕРА НГМД *
1	ha	203	;*******************************************
		204	WaitFDCInterrupt:
		205	pusha
3555	Serge	206	; Сбросить байт состояния операции
2434	Serge	207	mov [FDC_Status], FDC_Normal
3555	Serge	208	; Сбросить флаг прерывани
2434	Serge	209	mov [FDD_IntFlag], 0
3555	Serge	210	; Обнулить счетчик тиков
2434	Serge	211	mov eax, [timer_ticks]
		212	mov [TickCounter], eax
3555	Serge	213	; Ожидать установки флага прерывания НГМД
1	ha	214	@@TestRS_2:
2434	Serge	215	cmp [FDD_IntFlag], 0
3555	Serge	216	jnz @@End_7 ;прерывание произошло
19	mario79	217	call change_task
2434	Serge	218	mov eax, [timer_ticks]
		219	sub eax, [TickCounter]
3555	Serge	220	cmp eax, 50 ;25 ;5 ;ожидать 5 тиков
1	ha	221	jb @@TestRS_2
		222	; jl @@TestRS_2
3555	Serge	223	; Ошибка тайм-аута
2434	Serge	224	mov [FDC_Status], FDC_TimeOut
1	ha	225	; mov [flp_status],0
2434	Serge	226	@@End_7:
		227	popa
1	ha	228	ret
		229
		230	;*********************************
3555	Serge	231	;* ВКЛЮЧИТЬ МОТОР ДИСКОВОДА "A:" *
1	ha	232	;*********************************
		233	FDDMotorON:
		234	pusha
		235	; cmp [fdd_motor_status],1
		236	; je fdd_motor_on
2434	Serge	237	mov al, [flp_number]
		238	cmp [fdd_motor_status], al
1	ha	239	je fdd_motor_on
3555	Serge	240	; Произвести сброс контроллера НГМД
		241	mov DX, 3F2h;порт управления двигателями
2434	Serge	242	mov AL, 0
		243	out DX, AL
3555	Serge	244	; Выбрать и включить мотор дисковода
2434	Serge	245	cmp [flp_number], 1
1	ha	246	jne FDDMotorON_B
		247	; call FDDMotorOFF_B
2434	Serge	248	mov AL, 1Ch ; Floppy A
1	ha	249	jmp FDDMotorON_1
		250	FDDMotorON_B:
		251	; call FDDMotorOFF_A
2434	Serge	252	mov AL, 2Dh ; Floppy B
1	ha	253	FDDMotorON_1:
2434	Serge	254	out DX, AL
3555	Serge	255	; Обнулить счетчик тиков
2434	Serge	256	mov eax, [timer_ticks]
		257	mov [TickCounter], eax
3555	Serge	258	; Ожидать 0,5 с
1	ha	259	@@dT:
19	mario79	260	call change_task
2434	Serge	261	mov eax, [timer_ticks]
		262	sub eax, [TickCounter]
		263	cmp eax, 50 ;10
1	ha	264	jb @@dT
2434	Serge	265	cmp [flp_number], 1
1	ha	266	jne fdd_motor_on_B
2434	Serge	267	mov [fdd_motor_status], 1
1	ha	268	jmp fdd_motor_on
		269	fdd_motor_on_B:
2434	Serge	270	mov [fdd_motor_status], 2
1	ha	271	fdd_motor_on:
		272	call save_timer_fdd_motor
		273	popa
		274	ret
		275
		276	;*****************************************
3555	Serge	277	;* СОХРАНЕНИЕ УКАЗАТЕЛЯ ВРЕМЕНИ *
1	ha	278	;*****************************************
		279	save_timer_fdd_motor:
2434	Serge	280	mov eax, [timer_ticks]
		281	mov [timer_fdd_motor], eax
1	ha	282	ret
		283
		284	;*****************************************
3555	Serge	285	;* ПРОВЕРКА ЗАДЕРЖКИ ВЫКЛЮЧЕНИЯ МОТОРА *
1	ha	286	;*****************************************
3555	Serge	287	proc check_fdd_motor_status_has_work?
		288	cmp [flp_status], 0
		289	jnz .yes
		290	cmp [fdd_motor_status], 0
		291	jz .no
		292	mov eax, [timer_ticks]
		293	sub eax, [timer_fdd_motor]
		294	cmp eax, 500
		295	jb .no
		296	.yes:
		297	xor eax, eax
		298	inc eax
		299	ret
		300	.no:
		301	xor eax, eax
		302	ret
		303	endp
		304
1168	Lrz	305	align 4
1	ha	306	check_fdd_motor_status:
2434	Serge	307	cmp [fdd_motor_status], 0
19	mario79	308	je end_check_fdd_motor_status_1
2434	Serge	309	mov eax, [timer_ticks]
		310	sub eax, [timer_fdd_motor]
		311	cmp eax, 500
1	ha	312	jb end_check_fdd_motor_status
		313	call FDDMotorOFF
2434	Serge	314	mov [fdd_motor_status], 0
19	mario79	315	end_check_fdd_motor_status_1:
2434	Serge	316	mov [flp_status], 0
1	ha	317	end_check_fdd_motor_status:
		318	ret
		319
		320	;**********************************
3555	Serge	321	;* ВЫКЛЮЧИТЬ МОТОР ДИСКОВОДА *
1	ha	322	;**********************************
		323	FDDMotorOFF:
		324	push AX
		325	push DX
2434	Serge	326	cmp [flp_number], 1
1	ha	327	jne FDDMotorOFF_1
		328	call FDDMotorOFF_A
		329	jmp FDDMotorOFF_2
		330	FDDMotorOFF_1:
		331	call FDDMotorOFF_B
		332	FDDMotorOFF_2:
		333	pop DX
		334	pop AX
3555	Serge	335	; сброс флагов кеширования в связи с устареванием информации
2434	Serge	336	mov [root_read], 0
		337	mov [flp_fat], 0
1	ha	338	ret
		339
		340	FDDMotorOFF_A:
3555	Serge	341	mov DX, 3F2h;порт управления двигателями
2434	Serge	342	mov AL, 0Ch ; Floppy A
		343	out DX, AL
1	ha	344	ret
		345
		346	FDDMotorOFF_B:
3555	Serge	347	mov DX, 3F2h;порт управления двигателями
2434	Serge	348	mov AL, 5h ; Floppy B
		349	out DX, AL
1	ha	350	ret
		351
		352	;*******************************
3555	Serge	353	;* РЕКАЛИБРОВКА ДИСКОВОДА "A:" *
1	ha	354	;*******************************
		355	RecalibrateFDD:
		356	pusha
		357	call save_timer_fdd_motor
3555	Serge	358	; Подать команду "Рекалибровка"
2434	Serge	359	mov AL, 07h
1	ha	360	call FDCDataOutput
2434	Serge	361	mov AL, 00h
1	ha	362	call FDCDataOutput
3555	Serge	363	; Ожидать завершения операции
1	ha	364	call WaitFDCInterrupt
		365	; cmp [FDC_Status],0
		366	; je no_fdc_status_error
		367	; mov [flp_status],0
		368	;no_fdc_status_error:
		369	call save_timer_fdd_motor
		370	popa
		371	ret
		372
		373	;*****************************************************
3555	Serge	374	;* ПОИСК ДОРОЖКИ *
		375	;* Параметры передаются через глобальные переменные: *
		376	;* FDD_Track - номер дорожки (0-79); *
		377	;* FDD_Head - номер головки (0-1). *
		378	;* Результат операции заносится в FDC_Status. *
1	ha	379	;*****************************************************
		380	SeekTrack:
		381	pusha
		382	call save_timer_fdd_motor
3555	Serge	383	; Подать команду "Поиск"
2434	Serge	384	mov AL, 0Fh
1	ha	385	call FDCDataOutput
3555	Serge	386	; Передать байт номера головки/накопител
2434	Serge	387	mov AL, [FDD_Head]
		388	shl AL, 2
1	ha	389	call FDCDataOutput
3555	Serge	390	; Передать байт номера дорожки
2434	Serge	391	mov AL, [FDD_Track]
1	ha	392	call FDCDataOutput
3555	Serge	393	; Ожидать завершения операции
1	ha	394	call WaitFDCInterrupt
2434	Serge	395	cmp [FDC_Status], FDC_Normal
1	ha	396	jne @@Exit
3555	Serge	397	; Сохранить результат поиска
2434	Serge	398	mov AL, 08h
1	ha	399	call FDCDataOutput
		400	call FDCDataInput
2434	Serge	401	mov [FDC_ST0], AL
1	ha	402	call FDCDataInput
2434	Serge	403	mov [FDC_C], AL
3555	Serge	404	; Проверить результат поиска
		405	; Поиск завершен?
2434	Serge	406	test [FDC_ST0], 100000b
1	ha	407	je @@Err
3555	Serge	408	; Заданный трек найден?
2434	Serge	409	mov AL, [FDC_C]
		410	cmp AL, [FDD_Track]
1	ha	411	jne @@Err
3555	Serge	412	; Номер головки совпадает с заданным?
2434	Serge	413	mov AL, [FDC_ST0]
		414	and AL, 100b
		415	shr AL, 2
		416	cmp AL, [FDD_Head]
1	ha	417	jne @@Err
3555	Serge	418	; Операция завершена успешно
2434	Serge	419	mov [FDC_Status], FDC_Normal
3555	Serge	420	jmp @@Exit
		421	@@Err: ; Трек не найден
2434	Serge	422	mov [FDC_Status], FDC_TrackNotFound
1	ha	423	; mov [flp_status],0
		424	@@Exit:
		425	call save_timer_fdd_motor
		426	popa
		427	ret
		428
		429	;*******************************************************
3555	Serge	430	;* ЧТЕНИЕ СЕКТОРА ДАННЫХ *
		431	;* Параметры передаются через глобальные переменные: *
		432	;* FDD_Track - номер дорожки (0-79); *
		433	;* FDD_Head - номер головки (0-1); *
		434	;* FDD_Sector - номер сектора (1-18). *
		435	;* Результат операции заносится в FDC_Status. *
		436	;* В случае успешного выполнения операции чтения *
		437	;* содержимое сектора будет занесено в FDD_DataBuffer. *
1	ha	438	;*******************************************************
		439	ReadSector:
		440	pushad
		441	call save_timer_fdd_motor
3555	Serge	442	; Установить скорость передачи 500 Кбайт/с
2434	Serge	443	mov AX, 0
		444	mov DX, 03F7h
		445	out DX, AL
3555	Serge	446	; Инициализировать канал прямого доступа к памяти
2434	Serge	447	mov [dmamode], 0x46
1	ha	448	call Init_FDC_DMA
3555	Serge	449	; Подать команду "Чтение данных"
		450	mov AL, 0E6h ;чтение в мультитрековом режиме
1	ha	451	call FDCDataOutput
2434	Serge	452	mov AL, [FDD_Head]
		453	shl AL, 2
1	ha	454	call FDCDataOutput
2434	Serge	455	mov AL, [FDD_Track]
1	ha	456	call FDCDataOutput
2434	Serge	457	mov AL, [FDD_Head]
1	ha	458	call FDCDataOutput
2434	Serge	459	mov AL, [FDD_Sector]
1	ha	460	call FDCDataOutput
3555	Serge	461	mov AL, 2 ;код размера сектора (512 байт)
1	ha	462	call FDCDataOutput
3555	Serge	463	mov AL, 18 ;+1; 3Fh ;число секторов на дорожке
1	ha	464	call FDCDataOutput
3555	Serge	465	mov AL, 1Bh ;значение GPL
1	ha	466	call FDCDataOutput
3555	Serge	467	mov AL, 0FFh;значение DTL
1	ha	468	call FDCDataOutput
3555	Serge	469	; Ожидаем прерывание по завершении операции
1	ha	470	call WaitFDCInterrupt
2434	Serge	471	cmp [FDC_Status], FDC_Normal
1	ha	472	jne @@Exit_1
3555	Serge	473	; Считываем статус завершения операции
1	ha	474	call GetStatusInfo
2434	Serge	475	test [FDC_ST0], 11011000b
1	ha	476	jnz @@Err_1
2434	Serge	477	mov [FDC_Status], FDC_Normal
3555	Serge	478	jmp @@Exit_1
2434	Serge	479	@@Err_1:
		480	mov [FDC_Status], FDC_SectorNotFound
1	ha	481	; mov [flp_status],0
		482	@@Exit_1:
		483	call save_timer_fdd_motor
		484	popad
		485	ret
		486
		487	;*******************************************************
3555	Serge	488	;* ЧТЕНИЕ СЕКТОРА (С ПОВТОРЕНИЕМ ОПЕРАЦИИ ПРИ СБОЕ) *
		489	;* Параметры передаются через глобальные переменные: *
		490	;* FDD_Track - номер дорожки (0-79); *
		491	;* FDD_Head - номер головки (0-1); *
		492	;* FDD_Sector - номер сектора (1-18). *
		493	;* Результат операции заносится в FDC_Status. *
		494	;* В случае успешного выполнения операции чтения *
		495	;* содержимое сектора будет занесено в FDD_DataBuffer. *
1	ha	496	;*******************************************************
		497	ReadSectWithRetr:
		498	pusha
3555	Serge	499	; Обнулить счетчик повторения операции рекалибровки
2434	Serge	500	mov [RecalRepCounter], 0
1	ha	501	@@TryAgain:
3555	Serge	502	; Обнулить счетчик повторения операции чтени
2434	Serge	503	mov [ReadRepCounter], 0
1	ha	504	@@ReadSector_1:
		505	call ReadSector
2434	Serge	506	cmp [FDC_Status], 0
1	ha	507	je @@Exit_2
2434	Serge	508	cmp [FDC_Status], 1
379	serge	509	je @@Err_3
3555	Serge	510	; Троекратное повторение чтени
1	ha	511	inc [ReadRepCounter]
2434	Serge	512	cmp [ReadRepCounter], 3
1	ha	513	jb @@ReadSector_1
3555	Serge	514	; Троекратное повторение рекалибровки
1	ha	515	call RecalibrateFDD
		516	call SeekTrack
		517	inc [RecalRepCounter]
2434	Serge	518	cmp [RecalRepCounter], 3
1	ha	519	jb @@TryAgain
		520	; mov [flp_status],0
		521	@@Exit_2:
		522	popa
		523	ret
		524	@@Err_3:
2434	Serge	525	mov [flp_status], 0
1	ha	526	popa
		527	ret
		528
		529	;*******************************************************
3555	Serge	530	;* ЗАПИСЬ СЕКТОРА ДАННЫХ *
		531	;* Параметры передаются через глобальные переменные: *
		532	;* FDD_Track - номер дорожки (0-79); *
		533	;* FDD_Head - номер головки (0-1); *
		534	;* FDD_Sector - номер сектора (1-18). *
		535	;* Результат операции заносится в FDC_Status. *
		536	;* В случае успешного выполнения операции записи *
		537	;* содержимое FDD_DataBuffer будет занесено в сектор. *
1	ha	538	;*******************************************************
		539	WriteSector:
		540	pushad
		541	call save_timer_fdd_motor
3555	Serge	542	; Установить скорость передачи 500 Кбайт/с
2434	Serge	543	mov AX, 0
		544	mov DX, 03F7h
		545	out DX, AL
3555	Serge	546	; Инициализировать канал прямого доступа к памяти
2434	Serge	547	mov [dmamode], 0x4A
1	ha	548	call Init_FDC_DMA
3555	Serge	549	; Подать команду "Запись данных"
		550	mov AL, 0xC5 ;0x45 ;запись в мультитрековом режиме
1	ha	551	call FDCDataOutput
2434	Serge	552	mov AL, [FDD_Head]
		553	shl AL, 2
1	ha	554	call FDCDataOutput
2434	Serge	555	mov AL, [FDD_Track]
1	ha	556	call FDCDataOutput
2434	Serge	557	mov AL, [FDD_Head]
1	ha	558	call FDCDataOutput
2434	Serge	559	mov AL, [FDD_Sector]
1	ha	560	call FDCDataOutput
3555	Serge	561	mov AL, 2 ;код размера сектора (512 байт)
1	ha	562	call FDCDataOutput
3555	Serge	563	mov AL, 18; 3Fh ;число секторов на дорожке
1	ha	564	call FDCDataOutput
3555	Serge	565	mov AL, 1Bh ;значение GPL
1	ha	566	call FDCDataOutput
3555	Serge	567	mov AL, 0FFh;значение DTL
1	ha	568	call FDCDataOutput
3555	Serge	569	; Ожидаем прерывание по завершении операции
1	ha	570	call WaitFDCInterrupt
2434	Serge	571	cmp [FDC_Status], FDC_Normal
1	ha	572	jne @@Exit_3
3555	Serge	573	; Считываем статус завершения операции
1	ha	574	call GetStatusInfo
2434	Serge	575	test [FDC_ST0], 11000000b ;11011000b
1	ha	576	jnz @@Err_2
2434	Serge	577	mov [FDC_Status], FDC_Normal
3555	Serge	578	jmp @@Exit_3
2434	Serge	579	@@Err_2:
		580	mov [FDC_Status], FDC_SectorNotFound
1	ha	581	@@Exit_3:
		582	call save_timer_fdd_motor
		583	popad
		584	ret
		585
		586	;*******************************************************
3555	Serge	587	;* ЗАПИСЬ СЕКТОРА (С ПОВТОРЕНИЕМ ОПЕРАЦИИ ПРИ СБОЕ) *
		588	;* Параметры передаются через глобальные переменные: *
		589	;* FDD_Track - номер дорожки (0-79); *
		590	;* FDD_Head - номер головки (0-1); *
		591	;* FDD_Sector - номер сектора (1-18). *
		592	;* Результат операции заносится в FDC_Status. *
		593	;* В случае успешного выполнения операции записи *
		594	;* содержимое FDD_DataBuffer будет занесено в сектор. *
1	ha	595	;*******************************************************
		596	WriteSectWithRetr:
		597	pusha
3555	Serge	598	; Обнулить счетчик повторения операции рекалибровки
2434	Serge	599	mov [RecalRepCounter], 0
1	ha	600	@@TryAgain_1:
3555	Serge	601	; Обнулить счетчик повторения операции чтени
2434	Serge	602	mov [ReadRepCounter], 0
1	ha	603	@@WriteSector_1:
		604	call WriteSector
2434	Serge	605	cmp [FDC_Status], 0
1	ha	606	je @@Exit_4
2434	Serge	607	cmp [FDC_Status], 1
1	ha	608	je @@Err_4
3555	Serge	609	; Троекратное повторение чтени
1	ha	610	inc [ReadRepCounter]
2434	Serge	611	cmp [ReadRepCounter], 3
1	ha	612	jb @@WriteSector_1
3555	Serge	613	; Троекратное повторение рекалибровки
1	ha	614	call RecalibrateFDD
		615	call SeekTrack
		616	inc [RecalRepCounter]
2434	Serge	617	cmp [RecalRepCounter], 3
1	ha	618	jb @@TryAgain_1
		619	@@Exit_4:
		620	popa
		621	ret
		622	@@Err_4:
2434	Serge	623	mov [flp_status], 0
1	ha	624	popa
		625	ret
		626
		627	;*********************************************
3555	Serge	628	;* ПОЛУЧИТЬ ИНФОРМАЦИЮ О РЕЗУЛЬТАТЕ ОПЕРАЦИИ *
1	ha	629	;*********************************************
		630	GetStatusInfo:
		631	push AX
		632	call FDCDataInput
2434	Serge	633	mov [FDC_ST0], AL
1	ha	634	call FDCDataInput
2434	Serge	635	mov [FDC_ST1], AL
1	ha	636	call FDCDataInput
2434	Serge	637	mov [FDC_ST2], AL
1	ha	638	call FDCDataInput
2434	Serge	639	mov [FDC_C], AL
1	ha	640	call FDCDataInput
2434	Serge	641	mov [FDC_H], AL
1	ha	642	call FDCDataInput
2434	Serge	643	mov [FDC_R], AL
1	ha	644	call FDCDataInput
2434	Serge	645	mov [FDC_N], AL
1	ha	646	pop AX
		647	ret
		648

Subversion Repositories Kolibri OS

(root)/kernel/branches/Kolibri-acpi/blkdev/flp_drv.inc – Rev 3555