WebSVN – Kolibri OS – Blame – /kernel/branches/Kolibri-acpi/detect/dev_hdcd.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: 5201 $
		9
		10
1	ha	11	;******************************************************
3555	Serge	12	; поиск приводов HDD и CD
		13	; автор исходного текста Кулаков Владимир Геннадьевич.
		14	; адаптация и доработка Mario79
1	ha	15	;******************************************************
		16
		17	;****************************************************
3555	Serge	18	;* ПОИСК HDD и CD *
1	ha	19	;****************************************************
5201	serge	20	cmp [ecx+IDE_DATA.ProgrammingInterface], 0
3908	Serge	21	je EndFindHDD
		22
1	ha	23	FindHDD:
5201	serge	24	push ecx
		25
		26	xor ebx, ebx
		27	inc ebx
		28
		29	cmp ecx, IDE_controller_2
		30	jne @f
		31
		32	add bl, 5
		33	jmp .find
		34	@@:
		35	cmp ecx, IDE_controller_3
		36	jne .find
		37
		38	add bl, 10
		39	;--------------------------------------
		40	.find:
		41
2434	Serge	42	mov [ChannelNumber], 1
		43	mov [DiskNumber], 0
5201	serge	44	call FindHDD_2
		45
2434	Serge	46	mov [DiskNumber], 1
5201	serge	47	call FindHDD_2
		48
1	ha	49	inc [ChannelNumber]
5201	serge	50
2434	Serge	51	mov [DiskNumber], 0
5201	serge	52	call FindHDD_2
		53
2434	Serge	54	mov [DiskNumber], 1
1	ha	55	call FindHDD_1
389	serge	56
5201	serge	57	pop ecx
1	ha	58	jmp EndFindHDD
5201	serge	59	;-----------------------------------------------------------------------------
		60	FindHDD_2:
		61	call FindHDD_1
		62	shl byte [ebx+DRIVE_DATA], 2
		63	ret
		64	;-----------------------------------------------------------------------------
1	ha	65	FindHDD_1:
3725	Serge	66	DEBUGF 1, "K : Channel %d ",[ChannelNumber]:2
		67	DEBUGF 1, "Disk %d\n",[DiskNumber]:1
5201	serge	68	push ebx ecx
1	ha	69	call ReadHDD_ID
5201	serge	70	pop ecx ebx
		71	cmp [DevErrorCode], 7
		72	je .end
2434	Serge	73	cmp [DevErrorCode], 0
5201	serge	74	jne .FindCD
		75
2434	Serge	76	cmp [Sector512+6], word 16
5201	serge	77	ja .FindCD
		78
2434	Serge	79	cmp [Sector512+12], word 255
5201	serge	80	ja .FindCD
		81
		82	inc byte [ebx+DRIVE_DATA]
		83	jmp .Print_Device_Name
		84	;--------------------------------------
		85	.FindCD:
		86	push ebx ecx
346	diamond	87	call DeviceReset
5201	serge	88	pop ecx ebx
2434	Serge	89	cmp [DevErrorCode], 0
5201	serge	90	jne .end
		91
		92	push ebx ecx
1	ha	93	call ReadCD_ID
5201	serge	94	pop ecx ebx
2434	Serge	95	cmp [DevErrorCode], 0
5201	serge	96	jne .end
		97
		98	add [ebx+DRIVE_DATA], byte 2
		99	;--------------------------------------
		100	.Print_Device_Name:
3725	Serge	101	pushad
		102	pushfd
5201	serge	103
		104	xor ebx, ebx
		105	mov bx, [ChannelNumber]
		106	dec ebx
		107	shl ebx, 1
		108	add bl, [DiskNumber]
		109	shl ebx, 1
		110
		111	call calculate_IDE_device_values_storage
		112	;--------------------------------------
		113	.copy_dev_name:
3725	Serge	114	mov esi, Sector512+27*2
		115	mov edi, dev_name
		116	mov ecx, 20
		117	cld
5201	serge	118	;--------------------------------------
3725	Serge	119	@@:
		120	lodsw
		121	xchg ah, al
		122	stosw
		123	loop @b
5201	serge	124
3725	Serge	125	DEBUGF 1, "K : Dev: %s \n", dev_name
3908	Serge	126
		127	xor eax, eax
		128	mov ax, [Sector512+64*2]
5201	serge	129	DEBUGF 1, "K : PIO possible modes %x\n", al
		130
		131	mov ax, [Sector512+51*2]
		132	mov al, ah
		133	call convert_Sector512_value
		134	DEBUGF 1, "K : PIO set mode %x\n", ah
		135
3908	Serge	136	mov ax, [Sector512+63*2]
5201	serge	137	DEBUGF 1, "K : Multiword DMA possible modes %x\n", al
		138
		139	mov al, ah
		140	call convert_Sector512_value
		141	DEBUGF 1, "K : Multiword DMA set mode %x\n", ah
		142
3908	Serge	143	mov ax, [Sector512+88*2]
5201	serge	144	DEBUGF 1, "K : Ultra DMA possible modes %x\n", al
		145
		146	mov [ebx+IDE_DEVICE.UDMA_possible_modes], al
		147
		148	mov al, ah
		149	call convert_Sector512_value
		150	DEBUGF 1, "K : Ultra DMA set mode %x\n", ah
		151
		152	mov [ebx+IDE_DEVICE.UDMA_set_mode], ah
		153
		154	popfd
		155	popad
1	ha	156	ret
5201	serge	157	;--------------------------------------
		158	.end:
		159	DEBUGF 1, "K : Device not found\n"
		160	ret
		161	;-----------------------------------------------------------------------------
		162	calculate_IDE_device_values_storage:
		163	cmp ecx, IDE_controller_1
		164	jne @f
1	ha	165
5201	serge	166	add ebx, IDE_device_1
		167	jmp .exit
		168	;--------------------------------------
		169	@@:
		170	cmp ecx, IDE_controller_2
		171	jne @f
		172
		173	add ebx, IDE_device_2
		174	jmp .exit
		175	;--------------------------------------
		176	@@:
		177	add ebx, IDE_device_3
		178	;--------------------------------------
		179	.exit:
1	ha	180	ret
5201	serge	181	;-----------------------------------------------------------------------------
		182	convert_Sector512_value:
		183	mov ecx, 8
		184	xor ah, ah
		185	;--------------------------------------
		186	@@:
		187	test al, 1b
		188	jnz .end
1	ha	189
5201	serge	190	shr al, 1
		191	inc ah
		192	loop @b
		193
		194	xor ah, ah
		195	;--------------------------------------
		196	.end:
		197	ret
		198	;-----------------------------------------------------------------------------
3555	Serge	199	; Адрес считываемого сектора в режиме LBA
1276	Lrz	200	uglobal
5201	serge	201	SectorAddress dd ?
3725	Serge	202	dev_name:
		203	rb 41
1276	Lrz	204	endg
5201	serge	205	;-----------------------------------------------------------------------------
1	ha	206	;*************************************************
3555	Serge	207	;* ЧТЕНИЕ ИДЕНТИФИКАТОРА ЖЕСТКОГО ДИСКА *
		208	;* Входные параметры передаются через глобальные *
		209	;* переменные: *
		210	;* ChannelNumber - номер канала (1 или 2); *
		211	;* DiskNumber - номер диска на канале (0 или 1). *
		212	;* Идентификационный блок данных считывается *
		213	;* в массив Sector512. *
1	ha	214	;*************************************************
		215	ReadHDD_ID:
3555	Serge	216	; Задать режим CHS
2434	Serge	217	mov [ATAAddressMode], 0
3555	Serge	218	; Послать команду идентификации устройства
2434	Serge	219	mov [ATAFeatures], 0
		220	mov [ATAHead], 0
5201	serge	221	mov [ATACommand], 0xEC
1	ha	222	call SendCommandToHDD
5201	serge	223	cmp [DevErrorCode], 0 ;проверить код ошибки
3555	Serge	224	jne @@End ;закончить, сохранив код ошибки
5201	serge	225
		226	mov dx, [ATABasePortAddr]
		227	add dx, 7 ;адрес регистра состояни
2434	Serge	228	mov ecx, 0xffff
1	ha	229	@@WaitCompleet:
3555	Serge	230	; Проверить время выполнения команды
2434	Serge	231	dec ecx
3555	Serge	232	jz @@Error1 ;ошибка тайм-аута
		233	; Проверить готовность
5201	serge	234	in al, dx
		235	test al, 80h ;состояние сигнала BSY
1	ha	236	jnz @@WaitCompleet
5201	serge	237
		238	test al, 1 ;состояние сигнала ERR
1	ha	239	jnz @@Error6
5201	serge	240
		241	test al, 08h ;состояние сигнала DRQ
1	ha	242	jz @@WaitCompleet
3555	Serge	243	; Принять блок данных от контроллера
5201	serge	244	mov edi, Sector512
		245	mov dx, [ATABasePortAddr];регистр данных
		246	mov cx, 256 ;число считываемых слов
3555	Serge	247	rep insw ;принять блок данных
2434	Serge	248	ret
3555	Serge	249	; Записать код ошибки
1	ha	250	@@Error1:
2434	Serge	251	mov [DevErrorCode], 1
		252	ret
1	ha	253	@@Error6:
2434	Serge	254	mov [DevErrorCode], 6
		255	@@End:
		256	ret
5201	serge	257	;-----------------------------------------------------------------------------
		258	uglobal
3555	Serge	259	; Стандартные базовые адреса каналов 1 и 2
5201	serge	260	StandardATABases dw ?, ? ; 1F0h, 170h
3555	Serge	261	; Номер канала
5201	serge	262	ChannelNumber dw ?
3555	Serge	263	; Номер диска
5201	serge	264	DiskNumber db ?
3555	Serge	265	; Базовый адрес группы портов контроллера ATA
5201	serge	266	ATABasePortAddr dw ?
3555	Serge	267	; Параметры ATA-команды
5201	serge	268	ATAFeatures db ? ;особенности
		269	ATASectorCount db ? ;количество обрабатываемых секторов
		270	ATASectorNumber db ? ;номер начального сектора
		271	ATACylinder dw ? ;номер начального цилиндра
		272	ATAHead db ? ;номер начальной головки
		273	ATAAddressMode db ? ;режим адресации (0 - CHS, 1 - LBA)
		274	ATACommand db ? ;код команды, подлежащей выполнению
3555	Serge	275	; Код ошибки (0 - нет ошибок, 1 - превышен допустимый
		276	; интервал ожидания, 2 - неверный код режима адресации,
		277	; 3 - неверный номер канала, 4 - неверный номер диска,
		278	; 5 - неверный номер головки, 6 - ошибка при выполнении
5201	serge	279	; команды, 7 - таймаут при выборе канала)
1276	Lrz	280	DevErrorCode dd ?
		281	endg
5201	serge	282	;-----------------------------------------------------------------------------
1	ha	283	;****************************************************
3555	Serge	284	;* ПОСЛАТЬ КОМАНДУ ЗАДАННОМУ ДИСКУ *
		285	;* Входные параметры передаются через глобальные *
		286	;* переменные: *
		287	;* ChannelNumber - номер канала (1 или 2); *
		288	;* DiskNumber - номер диска (0 или 1); *
		289	;* ATAFeatures - "особенности"; *
		290	;* ATASectorCount - количество секторов; *
		291	;* ATASectorNumber - номер начального сектора; *
		292	;* ATACylinder - номер начального цилиндра; *
		293	;* ATAHead - номер начальной головки; *
		294	;* ATAAddressMode - режим адресации (0-CHS, 1-LBA); *
		295	;* ATACommand - код команды. *
		296	;* После успешного выполнения функции: *
		297	;* в ATABasePortAddr - базовый адрес HDD; *
		298	;* в DevErrorCode - ноль. *
		299	;* При возникновении ошибки в DevErrorCode будет *
		300	;* возвращен код ошибки. *
1	ha	301	;****************************************************
		302	SendCommandToHDD:
3555	Serge	303	; Проверить значение кода режима
2434	Serge	304	cmp [ATAAddressMode], 1
1	ha	305	ja @@Err2
3555	Serge	306	; Проверить корректность номера канала
5201	serge	307	mov bx, [ChannelNumber]
		308	cmp bx, 1
1	ha	309	jb @@Err3
5201	serge	310
		311	cmp bx, 2
1	ha	312	ja @@Err3
3555	Serge	313	; Установить базовый адрес
5201	serge	314	dec bx
		315	shl bx, 1
2434	Serge	316	movzx ebx, bx
5201	serge	317	mov ax, [ebx+StandardATABases]
		318	mov [ATABasePortAddr], ax
3555	Serge	319	; Ожидание готовности HDD к приему команды
		320	; Выбрать нужный диск
5201	serge	321	mov dx, [ATABasePortAddr]
		322	add dx, 6 ;адрес регистра головок
		323	mov al, [DiskNumber]
		324	cmp al, 1 ;проверить номера диска
1	ha	325	ja @@Err4
5201	serge	326
		327	shl al, 4
		328	or al, 10100000b
		329	out dx, al
3555	Serge	330	; Ожидать, пока диск не будет готов
5201	serge	331	inc dx
2434	Serge	332	mov ecx, 0xfff
1	ha	333	@@WaitHDReady:
3555	Serge	334	; Проверить время ожидани
2434	Serge	335	dec ecx
		336	jz @@Err1
3555	Serge	337	; Прочитать регистр состояни
5201	serge	338	in al, dx
3555	Serge	339	; Проверить состояние сигнала BSY
5201	serge	340	test al, 80h
1	ha	341	jnz @@WaitHDReady
3555	Serge	342	; Проверить состояние сигнала DRQ
5201	serge	343	test al, 08h
1	ha	344	jnz @@WaitHDReady
3555	Serge	345	; Загрузить команду в регистры контроллера
1	ha	346	cli
5201	serge	347	mov dx, [ATABasePortAddr]
		348	inc dx ;регистр "особенностей"
		349	mov al, [ATAFeatures]
		350	out dx, AL
		351	inc dx ;счетчик секторов
		352	mov al, [ATASectorCount]
		353	out dx, AL
		354	inc dx ;регистр номера сектора
		355	mov al, [ATASectorNumber]
		356	out dx, AL
		357	inc dx ;номер цилиндра (младший байт)
		358	mov ax, [ATACylinder]
		359	out dx, AL
		360	inc dx ;номер цилиндра (старший байт)
		361	mov al, AH
		362	out dx, AL
		363	inc dx ;номер головки/номер диска
		364	mov al, [DiskNumber]
		365	shl al, 4
		366	cmp [ATAHead], 0xF ;проверить номер головки
1	ha	367	ja @@Err5
5201	serge	368
		369	or al, [ATAHead]
		370	or al, 10100000b
		371	mov ah, [ATAAddressMode]
		372	shl ah, 6
		373	or al, ah
		374	out dx, al
3555	Serge	375	; Послать команду
5201	serge	376	mov al, [ATACommand]
		377	inc dx ;регистр команд
		378	out dx, al
1	ha	379	sti
3555	Serge	380	; Сбросить признак ошибки
2434	Serge	381	mov [DevErrorCode], 0
1276	Lrz	382	ret
3555	Serge	383	; Записать код ошибки
2434	Serge	384	@@Err1:
5201	serge	385	mov [DevErrorCode], 7
1276	Lrz	386	ret
2434	Serge	387	@@Err2:
		388	mov [DevErrorCode], 2
1276	Lrz	389	ret
2434	Serge	390	@@Err3:
		391	mov [DevErrorCode], 3
1276	Lrz	392	ret
2434	Serge	393	@@Err4:
		394	mov [DevErrorCode], 4
1276	Lrz	395	ret
2434	Serge	396	@@Err5:
		397	mov [DevErrorCode], 5
3555	Serge	398	; Завершение работы программы
1	ha	399	ret
5201	serge	400	;-----------------------------------------------------------------------------
1	ha	401	;*************************************************
3555	Serge	402	;* ЧТЕНИЕ ИДЕНТИФИКАТОРА УСТРОЙСТВА ATAPI *
		403	;* Входные параметры передаются через глобальные *
		404	;* перменные: *
		405	;* ChannelNumber - номер канала; *
		406	;* DiskNumber - номер диска на канале. *
		407	;* Идентификационный блок данных считывается *
		408	;* в массив Sector512. *
1	ha	409	;*************************************************
		410	ReadCD_ID:
3555	Serge	411	; Задать режим CHS
2434	Serge	412	mov [ATAAddressMode], 0
3555	Serge	413	; Послать команду идентификации устройства
2434	Serge	414	mov [ATAFeatures], 0
		415	mov [ATASectorCount], 0
		416	mov [ATASectorNumber], 0
		417	mov [ATACylinder], 0
		418	mov [ATAHead], 0
5201	serge	419	mov [ATACommand], 0xA1
1	ha	420	call SendCommandToHDD
3555	Serge	421	cmp [DevErrorCode], 0;проверить код ошибки
		422	jne @@End_1 ;закончить, сохранив код ошибки
		423	; Ожидать готовность данных HDD
5201	serge	424	mov dx, [ATABasePortAddr]
		425	add dx, 7 ;порт 1х7h
2434	Serge	426	mov ecx, 0xffff
1	ha	427	@@WaitCompleet_1:
3555	Serge	428	; Проверить врем
2434	Serge	429	dec ecx
3555	Serge	430	jz @@Error1_1 ;ошибка тайм-аута
		431	; Проверить готовность
5201	serge	432	in al, dx
		433	test al, 80h ;состояние сигнала BSY
1	ha	434	jnz @@WaitCompleet_1
5201	serge	435
		436	test al, 1 ;состояние сигнала ERR
1	ha	437	jnz @@Error6_1
5201	serge	438
		439	test al, 08h ;состояние сигнала DRQ
1	ha	440	jz @@WaitCompleet_1
3555	Serge	441	; Принять блок данных от контроллера
5201	serge	442	mov edi, Sector512 ;offset Sector512
		443	mov dx, [ATABasePortAddr];порт 1x0h
		444	mov cx, 256;число считываемых слов
2434	Serge	445	rep insw
1276	Lrz	446	ret
3555	Serge	447	; Записать код ошибки
1	ha	448	@@Error1_1:
2434	Serge	449	mov [DevErrorCode], 1
1276	Lrz	450	ret
1	ha	451	@@Error6_1:
2434	Serge	452	mov [DevErrorCode], 6
1	ha	453	@@End_1:
		454	ret
5201	serge	455	;-----------------------------------------------------------------------------
1	ha	456	;*************************************************
3555	Serge	457	;* СБРОС УСТРОЙСТВА *
		458	;* Входные параметры передаются через глобальные *
		459	;* переменные: *
		460	;* ChannelNumber - номер канала (1 или 2); *
		461	;* DiskNumber - номер диска (0 или 1). *
1	ha	462	;*************************************************
		463	DeviceReset:
3555	Serge	464	; Проверить корректность номера канала
5201	serge	465	mov bx, [ChannelNumber]
		466	cmp bx, 1
1	ha	467	jb @@Err3_2
5201	serge	468
		469	cmp bx, 2
1	ha	470	ja @@Err3_2
3555	Serge	471	; Установить базовый адрес
5201	serge	472	dec bx
		473	shl bx, 1
2434	Serge	474	movzx ebx, bx
5201	serge	475	mov dx, [ebx+StandardATABases]
		476	mov [ATABasePortAddr], dx
3555	Serge	477	; Выбрать нужный диск
5201	serge	478	add dx, 6 ;адрес регистра головок
		479	mov al, [DiskNumber]
		480	cmp al, 1 ;проверить номера диска
1	ha	481	ja @@Err4_2
5201	serge	482
		483	shl al, 4
		484	or al, 10100000b
		485	out dx, al
3555	Serge	486	; Послать команду "Сброс"
5201	serge	487	mov al, 0x8
		488	inc dx ;регистр команд
		489	out dx, al
2434	Serge	490	mov ecx, 0x80000
1	ha	491	@@WaitHDReady_1:
3555	Serge	492	; Проверить время ожидани
1	ha	493	dec ecx
3555	Serge	494	je @@Err1_2 ;ошибка тайм-аута
		495	; Прочитать регистр состояни
5201	serge	496	in al, dx
3555	Serge	497	; Проверить состояние сигнала BSY
5201	serge	498	test al, 80h
1	ha	499	jnz @@WaitHDReady_1
3555	Serge	500	; Сбросить признак ошибки
2434	Serge	501	mov [DevErrorCode], 0
1276	Lrz	502	ret
3555	Serge	503	; Обработка ошибок
2434	Serge	504	@@Err1_2:
		505	mov [DevErrorCode], 1
1276	Lrz	506	ret
2434	Serge	507	@@Err3_2:
		508	mov [DevErrorCode], 3
1276	Lrz	509	ret
2434	Serge	510	@@Err4_2:
		511	mov [DevErrorCode], 4
3555	Serge	512	; Записать код ошибки
1	ha	513	ret
5201	serge	514	;-----------------------------------------------------------------------------
1	ha	515	EndFindHDD:

Subversion Repositories Kolibri OS

(root)/kernel/branches/Kolibri-acpi/detect/dev_hdcd.inc – Rev 5201