WebSVN – Kolibri OS – Blame – /kernel/trunk/detect/dev_hdcd.inc

Rev	Author	Line No.	Line
2288	clevermous	1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		2	;; ;;
5363	yogev_ezra	3	;; Copyright (C) KolibriOS team 2004-2015. All rights reserved. ;;
2288	clevermous	4	;; Distributed under terms of the GNU General Public License ;;
		5	;; ;;
		6	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		7
		8	$Revision: 5363 $
		9
		10
		11	;******************************************************
3539	clevermous	12	; поиск приводов HDD и CD
		13	; автор исходного текста Кулаков Владимир Геннадьевич.
		14	; адаптация и доработка Mario79
2288	clevermous	15	;******************************************************
		16
		17	;****************************************************
3539	clevermous	18	;* ПОИСК HDD и CD *
2288	clevermous	19	;****************************************************
4700	mario79	20	cmp [ecx+IDE_DATA.ProgrammingInterface], 0
3785	mario79	21	je EndFindHDD
		22
2288	clevermous	23	FindHDD:
4700	mario79	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
2288	clevermous	42	mov [ChannelNumber], 1
		43	mov [DiskNumber], 0
4700	mario79	44	call FindHDD_2
		45
2288	clevermous	46	mov [DiskNumber], 1
4700	mario79	47	call FindHDD_2
		48
2288	clevermous	49	inc [ChannelNumber]
4700	mario79	50
2288	clevermous	51	mov [DiskNumber], 0
4700	mario79	52	call FindHDD_2
		53
2288	clevermous	54	mov [DiskNumber], 1
		55	call FindHDD_1
4700	mario79	56
		57	pop ecx
2288	clevermous	58	jmp EndFindHDD
4700	mario79	59	;-----------------------------------------------------------------------------
		60	FindHDD_2:
		61	call FindHDD_1
		62	shl byte [ebx+DRIVE_DATA], 2
		63	ret
		64	;-----------------------------------------------------------------------------
2288	clevermous	65	FindHDD_1:
3706	mario79	66	DEBUGF 1, "K : Channel %d ",[ChannelNumber]:2
		67	DEBUGF 1, "Disk %d\n",[DiskNumber]:1
4772	mario79	68	push ebx ecx
2288	clevermous	69	call ReadHDD_ID
4772	mario79	70	pop ecx ebx
5030	clevermous	71	cmp [DevErrorCode], 7
		72	je .end
2288	clevermous	73	cmp [DevErrorCode], 0
4700	mario79	74	jne .FindCD
		75
2288	clevermous	76	cmp [Sector512+6], word 16
4700	mario79	77	ja .FindCD
		78
2288	clevermous	79	cmp [Sector512+12], word 255
4700	mario79	80	ja .FindCD
		81
		82	inc byte [ebx+DRIVE_DATA]
		83	jmp .Print_Device_Name
		84	;--------------------------------------
		85	.FindCD:
4772	mario79	86	push ebx ecx
2288	clevermous	87	call DeviceReset
4772	mario79	88	pop ecx ebx
2288	clevermous	89	cmp [DevErrorCode], 0
4700	mario79	90	jne .end
		91
4772	mario79	92	push ebx ecx
2288	clevermous	93	call ReadCD_ID
4772	mario79	94	pop ecx ebx
2288	clevermous	95	cmp [DevErrorCode], 0
4700	mario79	96	jne .end
		97
		98	add [ebx+DRIVE_DATA], byte 2
		99	;--------------------------------------
		100	.Print_Device_Name:
3711	clevermous	101	pushad
		102	pushfd
4772	mario79	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:
3711	clevermous	114	mov esi, Sector512+27*2
		115	mov edi, dev_name
		116	mov ecx, 20
		117	cld
4772	mario79	118	;--------------------------------------
3702	mario79	119	@@:
3711	clevermous	120	lodsw
		121	xchg ah, al
		122	stosw
		123	loop @b
4700	mario79	124
3702	mario79	125	DEBUGF 1, "K : Dev: %s \n", dev_name
3881	mario79	126
		127	xor eax, eax
		128	mov ax, [Sector512+64*2]
4772	mario79	129	DEBUGF 1, "K : PIO possible modes %x\n", al
4700	mario79	130
4624	mario79	131	mov ax, [Sector512+51*2]
		132	mov al, ah
		133	call convert_Sector512_value
4772	mario79	134	DEBUGF 1, "K : PIO set mode %x\n", ah
4700	mario79	135
3881	mario79	136	mov ax, [Sector512+63*2]
4624	mario79	137	DEBUGF 1, "K : Multiword DMA possible modes %x\n", al
4700	mario79	138
4624	mario79	139	mov al, ah
		140	call convert_Sector512_value
		141	DEBUGF 1, "K : Multiword DMA set mode %x\n", ah
4700	mario79	142
3881	mario79	143	mov ax, [Sector512+88*2]
4624	mario79	144	DEBUGF 1, "K : Ultra DMA possible modes %x\n", al
4700	mario79	145
4772	mario79	146	mov [ebx+IDE_DEVICE.UDMA_possible_modes], al
		147
4624	mario79	148	mov al, ah
		149	call convert_Sector512_value
		150	DEBUGF 1, "K : Ultra DMA set mode %x\n", ah
4700	mario79	151
4772	mario79	152	mov [ebx+IDE_DEVICE.UDMA_set_mode], ah
		153
4700	mario79	154	popfd
		155	popad
2288	clevermous	156	ret
4700	mario79	157	;--------------------------------------
		158	.end:
		159	DEBUGF 1, "K : Device not found\n"
2288	clevermous	160	ret
4624	mario79	161	;-----------------------------------------------------------------------------
4772	mario79	162	calculate_IDE_device_values_storage:
		163	cmp ecx, IDE_controller_1
		164	jne @f
		165
		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:
		180	ret
		181	;-----------------------------------------------------------------------------
4624	mario79	182	convert_Sector512_value:
		183	mov ecx, 8
		184	xor ah, ah
4772	mario79	185	;--------------------------------------
4624	mario79	186	@@:
		187	test al, 1b
		188	jnz .end
2288	clevermous	189
4624	mario79	190	shr al, 1
		191	inc ah
		192	loop @b
		193
		194	xor ah, ah
4772	mario79	195	;--------------------------------------
4624	mario79	196	.end:
		197	ret
		198	;-----------------------------------------------------------------------------
3539	clevermous	199	; Адрес считываемого сектора в режиме LBA
2288	clevermous	200	uglobal
4700	mario79	201	SectorAddress dd ?
3702	mario79	202	dev_name:
3711	clevermous	203	rb 41
2288	clevermous	204	endg
4700	mario79	205	;-----------------------------------------------------------------------------
2288	clevermous	206	;*************************************************
3539	clevermous	207	;* ЧТЕНИЕ ИДЕНТИФИКАТОРА ЖЕСТКОГО ДИСКА *
		208	;* Входные параметры передаются через глобальные *
		209	;* переменные: *
		210	;* ChannelNumber - номер канала (1 или 2); *
		211	;* DiskNumber - номер диска на канале (0 или 1). *
		212	;* Идентификационный блок данных считывается *
		213	;* в массив Sector512. *
2288	clevermous	214	;*************************************************
		215	ReadHDD_ID:
3539	clevermous	216	; Задать режим CHS
2288	clevermous	217	mov [ATAAddressMode], 0
3539	clevermous	218	; Послать команду идентификации устройства
2288	clevermous	219	mov [ATAFeatures], 0
		220	mov [ATAHead], 0
4700	mario79	221	mov [ATACommand], 0xEC
2288	clevermous	222	call SendCommandToHDD
4700	mario79	223	cmp [DevErrorCode], 0 ;проверить код ошибки
3539	clevermous	224	jne @@End ;закончить, сохранив код ошибки
4700	mario79	225
		226	mov dx, [ATABasePortAddr]
		227	add dx, 7 ;адрес регистра состояни
2288	clevermous	228	mov ecx, 0xffff
		229	@@WaitCompleet:
3539	clevermous	230	; Проверить время выполнения команды
2288	clevermous	231	dec ecx
3539	clevermous	232	jz @@Error1 ;ошибка тайм-аута
		233	; Проверить готовность
4700	mario79	234	in al, dx
		235	test al, 80h ;состояние сигнала BSY
2288	clevermous	236	jnz @@WaitCompleet
4700	mario79	237
		238	test al, 1 ;состояние сигнала ERR
2288	clevermous	239	jnz @@Error6
4700	mario79	240
		241	test al, 08h ;состояние сигнала DRQ
2288	clevermous	242	jz @@WaitCompleet
3539	clevermous	243	; Принять блок данных от контроллера
4700	mario79	244	mov edi, Sector512
		245	mov dx, [ATABasePortAddr];регистр данных
		246	mov cx, 256 ;число считываемых слов
3539	clevermous	247	rep insw ;принять блок данных
2288	clevermous	248	ret
3539	clevermous	249	; Записать код ошибки
2288	clevermous	250	@@Error1:
		251	mov [DevErrorCode], 1
		252	ret
		253	@@Error6:
		254	mov [DevErrorCode], 6
		255	@@End:
		256	ret
4700	mario79	257	;-----------------------------------------------------------------------------
		258	uglobal
3539	clevermous	259	; Стандартные базовые адреса каналов 1 и 2
4700	mario79	260	StandardATABases dw ?, ? ; 1F0h, 170h
3539	clevermous	261	; Номер канала
4700	mario79	262	ChannelNumber dw ?
3539	clevermous	263	; Номер диска
4700	mario79	264	DiskNumber db ?
3539	clevermous	265	; Базовый адрес группы портов контроллера ATA
4700	mario79	266	ATABasePortAddr dw ?
3539	clevermous	267	; Параметры ATA-команды
4700	mario79	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 ? ;код команды, подлежащей выполнению
3539	clevermous	275	; Код ошибки (0 - нет ошибок, 1 - превышен допустимый
		276	; интервал ожидания, 2 - неверный код режима адресации,
		277	; 3 - неверный номер канала, 4 - неверный номер диска,
		278	; 5 - неверный номер головки, 6 - ошибка при выполнении
5030	clevermous	279	; команды, 7 - таймаут при выборе канала)
2288	clevermous	280	DevErrorCode dd ?
		281	endg
4700	mario79	282	;-----------------------------------------------------------------------------
2288	clevermous	283	;****************************************************
3539	clevermous	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	;* возвращен код ошибки. *
2288	clevermous	301	;****************************************************
		302	SendCommandToHDD:
3539	clevermous	303	; Проверить значение кода режима
2288	clevermous	304	cmp [ATAAddressMode], 1
		305	ja @@Err2
3539	clevermous	306	; Проверить корректность номера канала
4700	mario79	307	mov bx, [ChannelNumber]
		308	cmp bx, 1
2288	clevermous	309	jb @@Err3
4700	mario79	310
		311	cmp bx, 2
2288	clevermous	312	ja @@Err3
3539	clevermous	313	; Установить базовый адрес
4700	mario79	314	dec bx
		315	shl bx, 1
2288	clevermous	316	movzx ebx, bx
4700	mario79	317	mov ax, [ebx+StandardATABases]
		318	mov [ATABasePortAddr], ax
3539	clevermous	319	; Ожидание готовности HDD к приему команды
		320	; Выбрать нужный диск
4700	mario79	321	mov dx, [ATABasePortAddr]
		322	add dx, 6 ;адрес регистра головок
		323	mov al, [DiskNumber]
		324	cmp al, 1 ;проверить номера диска
2288	clevermous	325	ja @@Err4
4700	mario79	326
		327	shl al, 4
		328	or al, 10100000b
		329	out dx, al
3539	clevermous	330	; Ожидать, пока диск не будет готов
4700	mario79	331	inc dx
2288	clevermous	332	mov ecx, 0xfff
		333	@@WaitHDReady:
3539	clevermous	334	; Проверить время ожидани
2288	clevermous	335	dec ecx
		336	jz @@Err1
3539	clevermous	337	; Прочитать регистр состояни
4700	mario79	338	in al, dx
3539	clevermous	339	; Проверить состояние сигнала BSY
4700	mario79	340	test al, 80h
2288	clevermous	341	jnz @@WaitHDReady
3539	clevermous	342	; Проверить состояние сигнала DRQ
4700	mario79	343	test al, 08h
2288	clevermous	344	jnz @@WaitHDReady
3539	clevermous	345	; Загрузить команду в регистры контроллера
2288	clevermous	346	cli
4700	mario79	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 ;проверить номер головки
2288	clevermous	367	ja @@Err5
4700	mario79	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
3539	clevermous	375	; Послать команду
4700	mario79	376	mov al, [ATACommand]
		377	inc dx ;регистр команд
		378	out dx, al
2288	clevermous	379	sti
3539	clevermous	380	; Сбросить признак ошибки
2288	clevermous	381	mov [DevErrorCode], 0
		382	ret
3539	clevermous	383	; Записать код ошибки
2288	clevermous	384	@@Err1:
5030	clevermous	385	mov [DevErrorCode], 7
2288	clevermous	386	ret
		387	@@Err2:
		388	mov [DevErrorCode], 2
		389	ret
		390	@@Err3:
		391	mov [DevErrorCode], 3
		392	ret
		393	@@Err4:
		394	mov [DevErrorCode], 4
		395	ret
		396	@@Err5:
		397	mov [DevErrorCode], 5
3539	clevermous	398	; Завершение работы программы
2288	clevermous	399	ret
4700	mario79	400	;-----------------------------------------------------------------------------
2288	clevermous	401	;*************************************************
3539	clevermous	402	;* ЧТЕНИЕ ИДЕНТИФИКАТОРА УСТРОЙСТВА ATAPI *
		403	;* Входные параметры передаются через глобальные *
		404	;* перменные: *
		405	;* ChannelNumber - номер канала; *
		406	;* DiskNumber - номер диска на канале. *
		407	;* Идентификационный блок данных считывается *
		408	;* в массив Sector512. *
2288	clevermous	409	;*************************************************
		410	ReadCD_ID:
3539	clevermous	411	; Задать режим CHS
2288	clevermous	412	mov [ATAAddressMode], 0
3539	clevermous	413	; Послать команду идентификации устройства
2288	clevermous	414	mov [ATAFeatures], 0
		415	mov [ATASectorCount], 0
		416	mov [ATASectorNumber], 0
		417	mov [ATACylinder], 0
		418	mov [ATAHead], 0
4700	mario79	419	mov [ATACommand], 0xA1
2288	clevermous	420	call SendCommandToHDD
3539	clevermous	421	cmp [DevErrorCode], 0;проверить код ошибки
		422	jne @@End_1 ;закончить, сохранив код ошибки
		423	; Ожидать готовность данных HDD
4700	mario79	424	mov dx, [ATABasePortAddr]
		425	add dx, 7 ;порт 1х7h
2288	clevermous	426	mov ecx, 0xffff
		427	@@WaitCompleet_1:
3539	clevermous	428	; Проверить врем
2288	clevermous	429	dec ecx
3539	clevermous	430	jz @@Error1_1 ;ошибка тайм-аута
		431	; Проверить готовность
4700	mario79	432	in al, dx
		433	test al, 80h ;состояние сигнала BSY
2288	clevermous	434	jnz @@WaitCompleet_1
4700	mario79	435
		436	test al, 1 ;состояние сигнала ERR
2288	clevermous	437	jnz @@Error6_1
4700	mario79	438
		439	test al, 08h ;состояние сигнала DRQ
2288	clevermous	440	jz @@WaitCompleet_1
3539	clevermous	441	; Принять блок данных от контроллера
4700	mario79	442	mov edi, Sector512 ;offset Sector512
		443	mov dx, [ATABasePortAddr];порт 1x0h
		444	mov cx, 256;число считываемых слов
2288	clevermous	445	rep insw
		446	ret
3539	clevermous	447	; Записать код ошибки
2288	clevermous	448	@@Error1_1:
		449	mov [DevErrorCode], 1
		450	ret
		451	@@Error6_1:
		452	mov [DevErrorCode], 6
		453	@@End_1:
		454	ret
4700	mario79	455	;-----------------------------------------------------------------------------
2288	clevermous	456	;*************************************************
3539	clevermous	457	;* СБРОС УСТРОЙСТВА *
		458	;* Входные параметры передаются через глобальные *
		459	;* переменные: *
		460	;* ChannelNumber - номер канала (1 или 2); *
		461	;* DiskNumber - номер диска (0 или 1). *
2288	clevermous	462	;*************************************************
		463	DeviceReset:
3539	clevermous	464	; Проверить корректность номера канала
4700	mario79	465	mov bx, [ChannelNumber]
		466	cmp bx, 1
2288	clevermous	467	jb @@Err3_2
4700	mario79	468
		469	cmp bx, 2
2288	clevermous	470	ja @@Err3_2
3539	clevermous	471	; Установить базовый адрес
4700	mario79	472	dec bx
		473	shl bx, 1
2288	clevermous	474	movzx ebx, bx
4700	mario79	475	mov dx, [ebx+StandardATABases]
		476	mov [ATABasePortAddr], dx
3539	clevermous	477	; Выбрать нужный диск
4700	mario79	478	add dx, 6 ;адрес регистра головок
		479	mov al, [DiskNumber]
		480	cmp al, 1 ;проверить номера диска
2288	clevermous	481	ja @@Err4_2
4700	mario79	482
		483	shl al, 4
		484	or al, 10100000b
		485	out dx, al
3539	clevermous	486	; Послать команду "Сброс"
4700	mario79	487	mov al, 0x8
		488	inc dx ;регистр команд
		489	out dx, al
2288	clevermous	490	mov ecx, 0x80000
		491	@@WaitHDReady_1:
3539	clevermous	492	; Проверить время ожидани
2288	clevermous	493	dec ecx
3539	clevermous	494	je @@Err1_2 ;ошибка тайм-аута
		495	; Прочитать регистр состояни
4700	mario79	496	in al, dx
3539	clevermous	497	; Проверить состояние сигнала BSY
4700	mario79	498	test al, 80h
2288	clevermous	499	jnz @@WaitHDReady_1
3539	clevermous	500	; Сбросить признак ошибки
2288	clevermous	501	mov [DevErrorCode], 0
		502	ret
3539	clevermous	503	; Обработка ошибок
2288	clevermous	504	@@Err1_2:
		505	mov [DevErrorCode], 1
		506	ret
		507	@@Err3_2:
		508	mov [DevErrorCode], 3
		509	ret
		510	@@Err4_2:
		511	mov [DevErrorCode], 4
3539	clevermous	512	; Записать код ошибки
2288	clevermous	513	ret
4700	mario79	514	;-----------------------------------------------------------------------------
2288	clevermous	515	EndFindHDD:

Subversion Repositories Kolibri OS

(root)/kernel/trunk/detect/dev_hdcd.inc – Rev 5363