Rev 593 | Rev 628 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
431 | serge | 1 | ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;; |
2 | ;; ;; |
||
3 | ;; Copyright (C) KolibriOS team 2004-2007. All rights reserved. ;; |
||
4 | ;; Distributed under terms of the GNU General Public License ;; |
||
5 | ;; ;; |
||
6 | ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;; |
||
7 | |||
593 | mikedld | 8 | $Revision: 618 $ |
9 | |||
10 | |||
87 | mario79 | 11 | ;********************************************************** |
12 | ; Непосредственная работа с устройством СD (ATAPI) |
||
13 | ;********************************************************** |
||
618 | mario79 | 14 | ; Автор части исходного текста Кулаков Владимир Геннадьевич |
15 | ; Адаптация, доработка и разработка Mario79 |
||
87 | mario79 | 16 | |
17 | ; Максимальное количество повторений операции чтения |
||
543 | spraid | 18 | MaxRetr equ 10 |
87 | mario79 | 19 | ; Предельное время ожидания готовности к приему команды |
20 | ; (в тиках) |
||
21 | BSYWaitTime equ 1000 ;2 |
||
538 | spraid | 22 | NoTickWaitTime equ 0xfffff |
87 | mario79 | 23 | ;************************************************* |
24 | ;* ПОЛНОЕ ЧТЕНИЕ СЕКТОРА КОМПАКТ-ДИСКА * |
||
25 | ;* Считываются данные пользователя, информация * |
||
26 | ;* субканала и контрольная информация * |
||
27 | ;* Входные параметры передаются через глобальные * |
||
28 | ;* перменные: * |
||
29 | ;* ChannelNumber - номер канала; * |
||
30 | ;* DiskNumber - номер диска на канале; * |
||
31 | ;* CDSectorAddress - адрес считываемого сектора. * |
||
32 | ;* Данные считывается в массив CDDataBuf. * |
||
33 | ;************************************************* |
||
34 | ReadCD: |
||
585 | mario79 | 35 | pusha |
87 | mario79 | 36 | ; Задать размер сектора |
585 | mario79 | 37 | mov [CDBlockSize],2048 ;2352 |
87 | mario79 | 38 | ; Очистить буфер пакетной команды |
585 | mario79 | 39 | call clear_packet_buffer |
87 | mario79 | 40 | ; Сформировать пакетную команду для считывания |
41 | ; сектора данных |
||
585 | mario79 | 42 | ; Задать код команды Read CD |
43 | mov [PacketCommand],byte 0x28 ;0xBE |
||
44 | ; Задать адрес сектора |
||
45 | mov AX,word [CDSectorAddress+2] |
||
46 | xchg AL,AH |
||
47 | mov word [PacketCommand+2],AX |
||
48 | mov AX,word [CDSectorAddress] |
||
49 | xchg AL,AH |
||
50 | mov word [PacketCommand+4],AX |
||
87 | mario79 | 51 | ; mov eax,[CDSectorAddress] |
52 | ; mov [PacketCommand+2],eax |
||
585 | mario79 | 53 | ; Задать количество считываемых секторов |
54 | mov [PacketCommand+8],byte 1 |
||
55 | ; Задать считывание данных в полном объеме |
||
87 | mario79 | 56 | ; mov [PacketCommand+9],byte 0xF8 |
57 | ; Подать команду |
||
585 | mario79 | 58 | call SendPacketDatCommand |
87 | mario79 | 59 | ; call test_mario79 |
585 | mario79 | 60 | popa |
61 | ret |
||
87 | mario79 | 62 | |
63 | ;******************************************** |
||
64 | ;* ЧТЕНИЕ СЕКТОРА С ПОВТОРАМИ * |
||
65 | ;* Многократное повторение чтения при сбоях * |
||
66 | ;******************************************** |
||
67 | ReadCDWRetr: |
||
585 | mario79 | 68 | ;----------------------------------------------------------- |
69 | ; input : eax = block to read |
||
70 | ; ebx = destination |
||
71 | ;----------------------------------------------------------- |
||
72 | pushad |
||
73 | mov eax,[CDSectorAddress] |
||
74 | mov ebx,[CDDataBuf_pointer] |
||
75 | call cd_calculate_cache |
||
76 | add esi,8 |
||
77 | mov edi,1 |
||
78 | .hdreadcache: |
||
79 | ; cmp dword [esi+4],0 ; empty |
||
80 | ; je .nohdcache |
||
81 | cmp [esi],eax ; correct sector |
||
82 | je .yeshdcache |
||
83 | .nohdcache: |
||
84 | add esi,8 |
||
85 | inc edi |
||
86 | dec ecx |
||
87 | jnz .hdreadcache |
||
88 | call find_empty_slot_CD_cache ; ret in edi |
||
89 | |||
90 | push edi |
||
91 | push eax |
||
92 | call cd_calculate_cache_2 |
||
93 | shl edi,11 |
||
94 | add edi,eax |
||
95 | mov [CDDataBuf_pointer],edi |
||
96 | pop eax |
||
97 | pop edi |
||
98 | |||
99 | call ReadCDWRetr_1 |
||
100 | mov [CDDataBuf_pointer],ebx |
||
101 | call cd_calculate_cache_1 |
||
102 | lea esi,[edi*8+esi] |
||
103 | mov [esi],eax ; sector number |
||
104 | ; mov dword [esi+4],1 ; hd read - mark as same as in hd |
||
105 | .yeshdcache: |
||
106 | mov esi,edi |
||
107 | shl esi,11 ;9 |
||
108 | push eax |
||
109 | call cd_calculate_cache_2 |
||
110 | add esi,eax |
||
111 | pop eax |
||
112 | mov edi,ebx ;[CDDataBuf_pointer] |
||
113 | mov ecx,512 ;/4 |
||
114 | cld |
||
115 | rep movsd ; move data |
||
116 | popad |
||
117 | ret |
||
118 | |||
119 | ReadCDWRetr_1: |
||
120 | pushad |
||
121 | |||
87 | mario79 | 122 | ; Цикл, пока команда не выполнена успешно или не |
123 | ; исчерпано количество попыток |
||
585 | mario79 | 124 | mov ECX,MaxRetr |
87 | mario79 | 125 | @@NextRetr: |
126 | ; Подать команду |
||
585 | mario79 | 127 | call ReadCD |
128 | cmp [DevErrorCode],0 |
||
129 | je @@End_4 |
||
130 | |||
131 | or ecx,ecx ;{SPraid.simba} (for cd load) |
||
132 | jz @@End_4 |
||
133 | dec ecx |
||
134 | |||
135 | cmp [timer_ticks_enable],0 |
||
136 | jne @f |
||
137 | mov eax,NoTickWaitTime |
||
538 | spraid | 138 | .wait: |
585 | mario79 | 139 | dec eax |
140 | cmp eax,0 |
||
141 | je @@NextRetr |
||
142 | jmp .wait |
||
538 | spraid | 143 | @@: |
87 | mario79 | 144 | ; Задержка на 2,5 секунды |
585 | mario79 | 145 | mov EAX,[timer_ticks] |
146 | add EAX,250 ;50 |
||
87 | mario79 | 147 | @@Wait: |
585 | mario79 | 148 | call change_task |
149 | cmp EAX,[timer_ticks] |
||
150 | ja @@Wait |
||
151 | loop @@NextRetr |
||
87 | mario79 | 152 | @@End_4: |
585 | mario79 | 153 | popad |
154 | ret |
||
87 | mario79 | 155 | |
156 | |||
157 | ; Универсальные процедуры, обеспечивающие выполнение |
||
158 | ; пакетных команд в режиме PIO |
||
159 | |||
160 | ; Максимально допустимое время ожидания реакции |
||
161 | ; устройства на пакетную команду (в тиках) |
||
162 | MaxCDWaitTime equ 1000 ;200 ;10 секунд |
||
163 | |||
164 | ; Область памяти для формирования пакетной команды |
||
585 | mario79 | 165 | PacketCommand: rb 12 ;DB 12 DUP (?) |
87 | mario79 | 166 | ; Область памяти для приема данных от дисковода |
167 | ;CDDataBuf DB 4096 DUP (0) |
||
168 | ; Размер принимаемого блока данных в байтах |
||
585 | mario79 | 169 | CDBlockSize DW ? |
87 | mario79 | 170 | ; Адрес считываемого сектора данных |
171 | CDSectorAddress: DD ? |
||
172 | ; Время начала очередной операции с диском |
||
173 | TickCounter_1 DD 0 |
||
174 | ; Время начала ожидания готовности устройства |
||
175 | WURStartTime DD 0 |
||
176 | ; указатель буфера для считывания |
||
177 | CDDataBuf_pointer dd 0 |
||
178 | |||
179 | ;**************************************************** |
||
180 | ;* ПОСЛАТЬ УСТРОЙСТВУ ATAPI ПАКЕТНУЮ КОМАНДУ, * |
||
181 | ;* ПРЕДУСМАТРИВАЮЩУЮ ПЕРЕДАЧУ ОДНОГО СЕКТОРА ДАННЫХ * |
||
182 | ;* РАЗМЕРОМ 2048 БАЙТ ОТ УСТРОЙСТВА К ХОСТУ * |
||
183 | ;* Входные параметры передаются через глобальные * |
||
184 | ;* перменные: * |
||
185 | ;* ChannelNumber - номер канала; * |
||
186 | ;* DiskNumber - номер диска на канале; * |
||
187 | ;* PacketCommand - 12-байтный командный пакет; * |
||
188 | ;* CDBlockSize - размер принимаемого блока данных. * |
||
189 | ;**************************************************** |
||
190 | SendPacketDatCommand: |
||
585 | mario79 | 191 | pushad |
87 | mario79 | 192 | ; Задать режим CHS |
585 | mario79 | 193 | mov [ATAAddressMode],0 |
87 | mario79 | 194 | ; Послать ATA-команду передачи пакетной команды |
585 | mario79 | 195 | mov [ATAFeatures],0 |
196 | mov [ATASectorCount],0 |
||
197 | mov [ATASectorNumber],0 |
||
198 | ; Загрузить размер передаваемого блока |
||
199 | mov AX,[CDBlockSize] |
||
200 | mov [ATACylinder],AX |
||
201 | mov [ATAHead],0 |
||
202 | mov [ATACommand],0A0h |
||
203 | call SendCommandToHDD_1 |
||
204 | cmp [DevErrorCode],0 ;проверить код ошибки |
||
205 | jne @@End_8 ;закончить, сохранив код ошибки |
||
87 | mario79 | 206 | |
207 | ; Ожидание готовности дисковода к приему |
||
208 | ; пакетной команды |
||
585 | mario79 | 209 | mov DX,[ATABasePortAddr] |
210 | add DX,7 ;порт 1х7h |
||
211 | mov ecx,NoTickWaitTime |
||
87 | mario79 | 212 | @@WaitDevice0: |
585 | mario79 | 213 | cmp [timer_ticks_enable],0 |
214 | jne @f |
||
215 | dec ecx |
||
216 | cmp ecx,0 |
||
217 | je @@Err1_1 |
||
218 | jmp .test |
||
538 | spraid | 219 | @@: |
585 | mario79 | 220 | call change_task |
221 | ; Проверить время выполнения команды |
||
222 | mov EAX,[timer_ticks] |
||
223 | sub EAX,[TickCounter_1] |
||
224 | cmp EAX,BSYWaitTime |
||
225 | ja @@Err1_1 ;ошибка тайм-аута |
||
226 | ; Проверить готовность |
||
538 | spraid | 227 | .test: |
585 | mario79 | 228 | in AL,DX |
229 | test AL,80h ;состояние сигнала BSY |
||
230 | jnz @@WaitDevice0 |
||
231 | test AL,08h ;состояние сигнала DRQ |
||
232 | jz @@WaitDevice0 |
||
233 | test AL,1 ;состояние сигнала ERR |
||
234 | jnz @@Err6 |
||
87 | mario79 | 235 | ; Послать пакетную команду |
585 | mario79 | 236 | cli |
237 | mov DX,[ATABasePortAddr] |
||
238 | mov AX,[PacketCommand] |
||
239 | out DX,AX |
||
240 | mov AX,[PacketCommand+2] |
||
241 | out DX,AX |
||
242 | mov AX,[PacketCommand+4] |
||
243 | out DX,AX |
||
244 | mov AX,[PacketCommand+6] |
||
245 | out DX,AX |
||
246 | mov AX,[PacketCommand+8] |
||
247 | out DX,AX |
||
248 | mov AX,[PacketCommand+10] |
||
249 | out DX,AX |
||
250 | sti |
||
87 | mario79 | 251 | ; Ожидание готовности данных |
585 | mario79 | 252 | mov DX,[ATABasePortAddr] |
253 | add DX,7 ;порт 1х7h |
||
254 | mov ecx,NoTickWaitTime |
||
87 | mario79 | 255 | @@WaitDevice1: |
585 | mario79 | 256 | cmp [timer_ticks_enable],0 |
257 | jne @f |
||
258 | dec ecx |
||
259 | cmp ecx,0 |
||
260 | je @@Err1_1 |
||
261 | jmp .test_1 |
||
538 | spraid | 262 | @@: |
585 | mario79 | 263 | call change_task |
264 | ; Проверить время выполнения команды |
||
265 | mov EAX,[timer_ticks] |
||
266 | sub EAX,[TickCounter_1] |
||
267 | cmp EAX,MaxCDWaitTime |
||
268 | ja @@Err1_1 ;ошибка тайм-аута |
||
269 | ; Проверить готовность |
||
538 | spraid | 270 | .test_1: |
585 | mario79 | 271 | in AL,DX |
272 | test AL,80h ;состояние сигнала BSY |
||
273 | jnz @@WaitDevice1 |
||
274 | test AL,08h ;состояние сигнала DRQ |
||
275 | jz @@WaitDevice1 |
||
276 | test AL,1 ;состояние сигнала ERR |
||
277 | jnz @@Err6_temp |
||
87 | mario79 | 278 | ; Принять блок данных от контроллера |
585 | mario79 | 279 | mov EDI,[CDDataBuf_pointer] ;0x7000 ;CDDataBuf |
280 | ; Загрузить адрес регистра данных контроллера |
||
281 | mov DX,[ATABasePortAddr] ;порт 1x0h |
||
282 | ; Загрузить в счетчик размер блока в байтах |
||
283 | xor ecx,ecx |
||
284 | mov CX,[CDBlockSize] |
||
285 | ; Вычислить размер блока в 16-разрядных словах |
||
286 | shr CX,1 ;разделить размер блока на 2 |
||
287 | ; Принять блок данных |
||
288 | cli |
||
289 | cld |
||
290 | rep insw |
||
291 | sti |
||
292 | ; Успешное завершение приема данных |
||
293 | jmp @@End_8 |
||
87 | mario79 | 294 | |
295 | ; Записать код ошибки |
||
296 | @@Err1_1: |
||
585 | mario79 | 297 | mov [DevErrorCode],1 |
298 | jmp @@End_8 |
||
87 | mario79 | 299 | @@Err6_temp: |
585 | mario79 | 300 | mov [DevErrorCode],7 |
301 | jmp @@End_8 |
||
87 | mario79 | 302 | @@Err6: |
585 | mario79 | 303 | mov [DevErrorCode],6 |
87 | mario79 | 304 | |
305 | @@End_8: |
||
585 | mario79 | 306 | popad |
307 | ret |
||
87 | mario79 | 308 | |
309 | |||
310 | |||
311 | ;*********************************************** |
||
312 | ;* ПОСЛАТЬ УСТРОЙСТВУ ATAPI ПАКЕТНУЮ КОМАНДУ, * |
||
313 | ;* НЕ ПРЕДУСМАТРИВАЮЩУЮ ПЕРЕДАЧИ ДАННЫХ * |
||
314 | ;* Входные параметры передаются через * |
||
315 | ;* глобальные перменные: * |
||
316 | ;* ChannelNumber - номер канала; * |
||
317 | ;* DiskNumber - номер диска на канале; * |
||
318 | ;* PacketCommand - 12-байтный командный пакет. * |
||
319 | ;*********************************************** |
||
320 | SendPacketNoDatCommand: |
||
585 | mario79 | 321 | pushad |
87 | mario79 | 322 | ; Задать режим CHS |
585 | mario79 | 323 | mov [ATAAddressMode],0 |
87 | mario79 | 324 | ; Послать ATA-команду передачи пакетной команды |
585 | mario79 | 325 | mov [ATAFeatures],0 |
326 | mov [ATASectorCount],0 |
||
327 | mov [ATASectorNumber],0 |
||
328 | mov [ATACylinder],0 |
||
329 | mov [ATAHead],0 |
||
330 | mov [ATACommand],0A0h |
||
331 | call SendCommandToHDD_1 |
||
332 | cmp [DevErrorCode],0 ;проверить код ошибки |
||
333 | jne @@End_9 ;закончить, сохранив код ошибки |
||
87 | mario79 | 334 | ; Ожидание готовности дисковода к приему |
335 | ; пакетной команды |
||
585 | mario79 | 336 | mov DX,[ATABasePortAddr] |
337 | add DX,7 ;порт 1х7h |
||
87 | mario79 | 338 | @@WaitDevice0_1: |
585 | mario79 | 339 | call change_task |
340 | ; Проверить время ожидания |
||
341 | mov EAX,[timer_ticks] |
||
342 | sub EAX,[TickCounter_1] |
||
343 | cmp EAX,BSYWaitTime |
||
344 | ja @@Err1_3 ;ошибка тайм-аута |
||
345 | ; Проверить готовность |
||
346 | in AL,DX |
||
347 | test AL,80h ;состояние сигнала BSY |
||
348 | jnz @@WaitDevice0_1 |
||
349 | test AL,1 ;состояние сигнала ERR |
||
350 | jnz @@Err6_1 |
||
351 | test AL,08h ;состояние сигнала DRQ |
||
352 | jz @@WaitDevice0_1 |
||
87 | mario79 | 353 | ; Послать пакетную команду |
354 | ; cli |
||
585 | mario79 | 355 | mov DX,[ATABasePortAddr] |
356 | mov AX,word [PacketCommand] |
||
357 | out DX,AX |
||
358 | mov AX,word [PacketCommand+2] |
||
359 | out DX,AX |
||
360 | mov AX,word [PacketCommand+4] |
||
361 | out DX,AX |
||
362 | mov AX,word [PacketCommand+6] |
||
363 | out DX,AX |
||
364 | mov AX,word [PacketCommand+8] |
||
365 | out DX,AX |
||
366 | mov AX,word [PacketCommand+10] |
||
367 | out DX,AX |
||
87 | mario79 | 368 | ; sti |
618 | mario79 | 369 | cmp [ignore_CD_eject_wait],1 |
370 | je @@End_9 |
||
87 | mario79 | 371 | ; Ожидание подтверждения приема команды |
585 | mario79 | 372 | mov DX,[ATABasePortAddr] |
373 | add DX,7 ;порт 1х7h |
||
87 | mario79 | 374 | @@WaitDevice1_1: |
585 | mario79 | 375 | call change_task |
376 | ; Проверить время выполнения команды |
||
377 | mov EAX,[timer_ticks] |
||
378 | sub EAX,[TickCounter_1] |
||
379 | cmp EAX,MaxCDWaitTime |
||
380 | ja @@Err1_3 ;ошибка тайм-аута |
||
381 | ; Ожидать освобождения устройства |
||
382 | in AL,DX |
||
383 | test AL,80h ;состояние сигнала BSY |
||
384 | jnz @@WaitDevice1_1 |
||
385 | test AL,1 ;состояние сигнала ERR |
||
386 | jnz @@Err6_1 |
||
387 | test AL,40h ;состояние сигнала DRDY |
||
388 | jz @@WaitDevice1_1 |
||
389 | jmp @@End_9 |
||
87 | mario79 | 390 | |
391 | ; Записать код ошибки |
||
392 | @@Err1_3: |
||
585 | mario79 | 393 | mov [DevErrorCode],1 |
394 | jmp @@End_9 |
||
87 | mario79 | 395 | @@Err6_1: |
585 | mario79 | 396 | mov [DevErrorCode],6 |
87 | mario79 | 397 | @@End_9: |
585 | mario79 | 398 | popad |
399 | ret |
||
87 | mario79 | 400 | |
401 | ;**************************************************** |
||
402 | ;* ПОСЛАТЬ КОМАНДУ ЗАДАННОМУ ДИСКУ * |
||
403 | ;* Входные параметры передаются через глобальные * |
||
404 | ;* переменные: * |
||
405 | ;* ChannelNumber - номер канала (1 или 2); * |
||
406 | ;* DiskNumber - номер диска (0 или 1); * |
||
407 | ;* ATAFeatures - "особенности"; * |
||
408 | ;* ATASectorCount - количество секторов; * |
||
409 | ;* ATASectorNumber - номер начального сектора; * |
||
410 | ;* ATACylinder - номер начального цилиндра; * |
||
411 | ;* ATAHead - номер начальной головки; * |
||
412 | ;* ATAAddressMode - режим адресации (0-CHS, 1-LBA); * |
||
413 | ;* ATACommand - код команды. * |
||
414 | ;* После успешного выполнения функции: * |
||
415 | ;* в ATABasePortAddr - базовый адрес HDD; * |
||
416 | ;* в DevErrorCode - ноль. * |
||
417 | ;* При возникновении ошибки в DevErrorCode будет * |
||
418 | ;* возвращен код ошибки. * |
||
419 | ;**************************************************** |
||
420 | SendCommandToHDD_1: |
||
585 | mario79 | 421 | pushad |
87 | mario79 | 422 | ; Проверить значение кода режима |
585 | mario79 | 423 | cmp [ATAAddressMode],1 |
424 | ja @@Err2_4 |
||
87 | mario79 | 425 | ; Проверить корректность номера канала |
585 | mario79 | 426 | mov BX,[ChannelNumber] |
427 | cmp BX,1 |
||
428 | jb @@Err3_4 |
||
429 | cmp BX,2 |
||
430 | ja @@Err3_4 |
||
87 | mario79 | 431 | ; Установить базовый адрес |
585 | mario79 | 432 | dec BX |
433 | shl BX,1 |
||
434 | movzx ebx,bx |
||
435 | mov AX,[ebx+StandardATABases] |
||
436 | mov [ATABasePortAddr],AX |
||
87 | mario79 | 437 | ; Ожидание готовности HDD к приему команды |
585 | mario79 | 438 | ; Выбрать нужный диск |
439 | mov DX,[ATABasePortAddr] |
||
440 | add DX,6 ;адрес регистра головок |
||
441 | mov AL,[DiskNumber] |
||
442 | cmp AL,1 ;проверить номера диска |
||
443 | ja @@Err4_4 |
||
444 | shl AL,4 |
||
445 | or AL,10100000b |
||
446 | out DX,AL |
||
447 | ; Ожидать, пока диск не будет готов |
||
448 | inc DX |
||
449 | mov eax,[timer_ticks] |
||
450 | mov [TickCounter_1],eax |
||
451 | mov ecx,NoTickWaitTime |
||
87 | mario79 | 452 | @@WaitHDReady_2: |
585 | mario79 | 453 | cmp [timer_ticks_enable],0 |
454 | jne @f |
||
455 | dec ecx |
||
456 | cmp ecx,0 |
||
457 | je @@Err1_4 |
||
458 | jmp .test |
||
538 | spraid | 459 | @@: |
585 | mario79 | 460 | call change_task |
461 | ; Проверить время ожидания |
||
462 | mov eax,[timer_ticks] |
||
463 | sub eax,[TickCounter_1] |
||
464 | cmp eax,BSYWaitTime ;300 ;ожидать 3 сек. |
||
465 | ja @@Err1_4 ;ошибка тайм-аута |
||
466 | ; Прочитать регистр состояния |
||
538 | spraid | 467 | .test: |
585 | mario79 | 468 | in AL,DX |
469 | ; Проверить состояние сигнала BSY |
||
470 | test AL,80h |
||
471 | jnz @@WaitHDReady_2 |
||
472 | ; Проверить состояние сигнала DRQ |
||
473 | test AL,08h |
||
474 | jnz @@WaitHDReady_2 |
||
538 | spraid | 475 | |
87 | mario79 | 476 | ; Загрузить команду в регистры контроллера |
585 | mario79 | 477 | cli |
478 | mov DX,[ATABasePortAddr] |
||
479 | inc DX ;регистр "особенностей" |
||
480 | mov AL,[ATAFeatures] |
||
481 | out DX,AL |
||
482 | inc DX ;счетчик секторов |
||
483 | mov AL,[ATASectorCount] |
||
484 | out DX,AL |
||
485 | inc DX ;регистр номера сектора |
||
486 | mov AL,[ATASectorNumber] |
||
487 | out DX,AL |
||
488 | inc DX ;номер цилиндра (младший байт) |
||
489 | mov AX,[ATACylinder] |
||
490 | out DX,AL |
||
491 | inc DX ;номер цилиндра (старший байт) |
||
492 | mov AL,AH |
||
493 | out DX,AL |
||
494 | inc DX ;номер головки/номер диска |
||
495 | mov AL,[DiskNumber] |
||
496 | shl AL,4 |
||
497 | cmp [ATAHead],0Fh ;проверить номер головки |
||
498 | ja @@Err5_4 |
||
499 | or AL,[ATAHead] |
||
500 | or AL,10100000b |
||
501 | mov AH,[ATAAddressMode] |
||
502 | shl AH,6 |
||
503 | or AL,AH |
||
504 | out DX,AL |
||
87 | mario79 | 505 | ; Послать команду |
585 | mario79 | 506 | mov AL,[ATACommand] |
507 | inc DX ;регистр команд |
||
508 | out DX,AL |
||
509 | sti |
||
87 | mario79 | 510 | ; Сбросить признак ошибки |
585 | mario79 | 511 | mov [DevErrorCode],0 |
512 | jmp @@End_10 |
||
87 | mario79 | 513 | ; Записать код ошибки |
514 | @@Err1_4: |
||
585 | mario79 | 515 | mov [DevErrorCode],1 |
516 | jmp @@End_10 |
||
87 | mario79 | 517 | @@Err2_4: |
585 | mario79 | 518 | mov [DevErrorCode],2 |
519 | jmp @@End_10 |
||
87 | mario79 | 520 | @@Err3_4: |
585 | mario79 | 521 | mov [DevErrorCode],3 |
522 | jmp @@End_10 |
||
87 | mario79 | 523 | @@Err4_4: |
585 | mario79 | 524 | mov [DevErrorCode],4 |
525 | jmp @@End_10 |
||
87 | mario79 | 526 | @@Err5_4: |
585 | mario79 | 527 | mov [DevErrorCode],5 |
87 | mario79 | 528 | ; Завершение работы программы |
529 | @@End_10: |
||
538 | spraid | 530 | ; sti |
585 | mario79 | 531 | popad |
532 | ret |
||
533 | |||
87 | mario79 | 534 | ;************************************************* |
535 | ;* ОЖИДАНИЕ ГОТОВНОСТИ УСТРОЙСТВА К РАБОТЕ * |
||
536 | ;* Входные параметры передаются через глобальные * |
||
537 | ;* перменные: * |
||
538 | ;* ChannelNumber - номер канала; * |
||
539 | ;* DiskNumber - номер диска на канале. * |
||
540 | ;************************************************* |
||
541 | WaitUnitReady: |
||
585 | mario79 | 542 | pusha |
87 | mario79 | 543 | ; Запомнить время начала операции |
585 | mario79 | 544 | mov EAX,[timer_ticks] |
545 | mov [WURStartTime],EAX |
||
87 | mario79 | 546 | ; Очистить буфер пакетной команды |
585 | mario79 | 547 | call clear_packet_buffer |
87 | mario79 | 548 | ; Сформировать команду TEST UNIT READY |
585 | mario79 | 549 | mov [PacketCommand],word 00h |
87 | mario79 | 550 | ; ЦИКЛ ОЖИДАНИЯ ГОТОВНОСТИ УСТРОЙСТВА |
551 | @@SendCommand: |
||
585 | mario79 | 552 | ; Подать команду проверки готовности |
553 | call SendPacketNoDatCommand |
||
554 | call change_task |
||
555 | ; Проверить код ошибки |
||
556 | cmp [DevErrorCode],0 |
||
557 | je @@End_11 |
||
558 | ; Проверить время ожидания готовности |
||
559 | mov EAX,[timer_ticks] |
||
560 | sub EAX,[WURStartTime] |
||
561 | cmp EAX,MaxCDWaitTime |
||
562 | jb @@SendCommand |
||
563 | ; Ошибка тайм-аута |
||
564 | mov [DevErrorCode],1 |
||
87 | mario79 | 565 | @@End_11: |
585 | mario79 | 566 | popa |
567 | ret |
||
87 | mario79 | 568 | |
569 | ;************************************************* |
||
585 | mario79 | 570 | ;* ЗАПРЕТИТЬ СМЕНУ ДИСКА * |
571 | ;* Входные параметры передаются через глобальные * |
||
572 | ;* перменные: * |
||
573 | ;* ChannelNumber - номер канала; * |
||
574 | ;* DiskNumber - номер диска на канале. * |
||
575 | ;************************************************* |
||
576 | prevent_medium_removal: |
||
577 | pusha |
||
578 | ; Очистить буфер пакетной команды |
||
579 | call clear_packet_buffer |
||
580 | ; Задать код команды |
||
581 | mov [PacketCommand],byte 0x1E |
||
582 | ; Задать код запрета |
||
583 | mov [PacketCommand+4],byte 11b |
||
584 | ; Подать команду |
||
585 | call SendPacketNoDatCommand |
||
618 | mario79 | 586 | mov eax,ATAPI_IDE0_lock |
587 | add eax,[cdpos] |
||
588 | dec eax |
||
589 | mov [eax],byte 1 |
||
585 | mario79 | 590 | popa |
591 | ret |
||
592 | |||
593 | ;************************************************* |
||
594 | ;* РАЗРЕШИТЬ СМЕНУ ДИСКА * |
||
595 | ;* Входные параметры передаются через глобальные * |
||
596 | ;* перменные: * |
||
597 | ;* ChannelNumber - номер канала; * |
||
598 | ;* DiskNumber - номер диска на канале. * |
||
618 | mario79 | 599 | ;************************************************* |
585 | mario79 | 600 | allow_medium_removal: |
601 | pusha |
||
602 | ; Очистить буфер пакетной команды |
||
603 | call clear_packet_buffer |
||
604 | ; Задать код команды |
||
605 | mov [PacketCommand],byte 0x1E |
||
606 | ; Задать код запрета |
||
607 | mov [PacketCommand+4],byte 00b |
||
608 | ; Подать команду |
||
609 | call SendPacketNoDatCommand |
||
618 | mario79 | 610 | mov eax,ATAPI_IDE0_lock |
611 | add eax,[cdpos] |
||
612 | dec eax |
||
613 | mov [eax],byte 0 |
||
585 | mario79 | 614 | popa |
615 | ret |
||
616 | |||
617 | ;************************************************* |
||
87 | mario79 | 618 | ;* ЗАГРУЗИТЬ НОСИТЕЛЬ В ДИСКОВОД * |
619 | ;* Входные параметры передаются через глобальные * |
||
620 | ;* перменные: * |
||
621 | ;* ChannelNumber - номер канала; * |
||
622 | ;* DiskNumber - номер диска на канале. * |
||
623 | ;************************************************* |
||
624 | LoadMedium: |
||
585 | mario79 | 625 | pusha |
87 | mario79 | 626 | ; Очистить буфер пакетной команды |
585 | mario79 | 627 | call clear_packet_buffer |
87 | mario79 | 628 | ; Сформировать команду START/STOP UNIT |
585 | mario79 | 629 | ; Задать код команды |
630 | mov [PacketCommand],word 1Bh |
||
631 | ; Задать операцию загрузки носителя |
||
632 | mov [PacketCommand+4],word 00000011b |
||
87 | mario79 | 633 | ; Подать команду |
585 | mario79 | 634 | call SendPacketNoDatCommand |
635 | popa |
||
636 | ret |
||
87 | mario79 | 637 | |
638 | ;************************************************* |
||
639 | ;* ИЗВЛЕЧЬ НОСИТЕЛЬ ИЗ ДИСКОВОДА * |
||
640 | ;* Входные параметры передаются через глобальные * |
||
641 | ;* перменные: * |
||
642 | ;* ChannelNumber - номер канала; * |
||
643 | ;* DiskNumber - номер диска на канале. * |
||
644 | ;************************************************* |
||
585 | mario79 | 645 | EjectMedium: |
646 | pusha |
||
87 | mario79 | 647 | ; Очистить буфер пакетной команды |
585 | mario79 | 648 | call clear_packet_buffer |
87 | mario79 | 649 | ; Сформировать команду START/STOP UNIT |
585 | mario79 | 650 | ; Задать код команды |
651 | mov [PacketCommand],word 1Bh |
||
652 | ; Задать операцию извлечения носителя |
||
653 | mov [PacketCommand+4],word 00000010b |
||
87 | mario79 | 654 | ; Подать команду |
585 | mario79 | 655 | call SendPacketNoDatCommand |
656 | popa |
||
657 | ret |
||
87 | mario79 | 658 | |
659 | ;************************************************* |
||
618 | mario79 | 660 | ;* Проверить событие нажатия кнопки извлечения * |
661 | ;* диска * |
||
87 | mario79 | 662 | ;* Входные параметры передаются через глобальные * |
663 | ;* переменные: * |
||
664 | ;* ChannelNumber - номер канала; * |
||
665 | ;* DiskNumber - номер диска на канале. * |
||
666 | ;************************************************* |
||
618 | mario79 | 667 | check_ATAPI_device_event: |
585 | mario79 | 668 | pusha |
618 | mario79 | 669 | mov eax,[timer_ticks] |
670 | sub eax,[timer_ATAPI_check] |
||
671 | cmp eax,100 |
||
672 | jb .end_1 |
||
673 | mov al,[DRIVE_DATA+1] |
||
674 | and al,11b |
||
675 | cmp al,10b |
||
676 | jz .ide3 |
||
677 | .ide2_1: |
||
678 | mov al,[DRIVE_DATA+1] |
||
679 | and al,1100b |
||
680 | cmp al,1000b |
||
681 | jz .ide2 |
||
682 | .ide1_1: |
||
683 | mov al,[DRIVE_DATA+1] |
||
684 | and al,110000b |
||
685 | cmp al,100000b |
||
686 | jz .ide1 |
||
687 | .ide0_1: |
||
688 | mov al,[DRIVE_DATA+1] |
||
689 | and al,11000000b |
||
690 | cmp al,10000000b |
||
691 | jz .ide0 |
||
692 | .end: |
||
693 | |||
694 | sti |
||
695 | mov eax,[timer_ticks] |
||
696 | mov [timer_ATAPI_check],eax |
||
697 | .end_1: |
||
698 | popa |
||
699 | ret |
||
700 | |||
701 | .ide3: |
||
702 | cli |
||
703 | cmp [ATAPI_IDE3_lock],1 |
||
704 | jne .ide2_1 |
||
705 | cmp [IDE_Channel_2],0 |
||
706 | jne .ide1_1 |
||
707 | cmp [cd_status],0 |
||
708 | jne .end |
||
709 | mov [IDE_Channel_2],1 |
||
710 | call reserve_ok2 |
||
711 | mov [ChannelNumber],2 |
||
712 | mov [DiskNumber],1 |
||
713 | mov [cdpos],4 |
||
714 | call GetEvent_StatusNotification |
||
715 | cmp [CDDataBuf+4],byte 1 |
||
716 | je .eject_ide3 |
||
717 | call syscall_cdaudio.free |
||
718 | jmp .ide2_1 |
||
719 | .eject_ide3: |
||
720 | call .eject |
||
721 | call syscall_cdaudio.free |
||
722 | jmp .ide2_1 |
||
723 | |||
724 | .ide2: |
||
725 | cli |
||
726 | cmp [ATAPI_IDE2_lock],1 |
||
727 | jne .ide1_1 |
||
728 | cmp [IDE_Channel_2],0 |
||
729 | jne .ide1_1 |
||
730 | cmp [cd_status],0 |
||
731 | jne .end |
||
732 | mov [IDE_Channel_2],1 |
||
733 | call reserve_ok2 |
||
734 | mov [ChannelNumber],2 |
||
735 | mov [DiskNumber],0 |
||
736 | mov [cdpos],3 |
||
737 | call GetEvent_StatusNotification |
||
738 | cmp [CDDataBuf+4],byte 1 |
||
739 | je .eject_ide2 |
||
740 | call syscall_cdaudio.free |
||
741 | jmp .ide1_1 |
||
742 | .eject_ide2: |
||
743 | call .eject |
||
744 | call syscall_cdaudio.free |
||
745 | jmp .ide1_1 |
||
746 | |||
747 | .ide1: |
||
748 | cli |
||
749 | cmp [ATAPI_IDE1_lock],1 |
||
750 | jne .ide0_1 |
||
751 | cmp [IDE_Channel_1],0 |
||
752 | jne .end |
||
753 | cmp [cd_status],0 |
||
754 | jne .end |
||
755 | mov [IDE_Channel_1],1 |
||
756 | call reserve_ok2 |
||
757 | mov [ChannelNumber],1 |
||
758 | mov [DiskNumber],1 |
||
759 | mov [cdpos],2 |
||
760 | call GetEvent_StatusNotification |
||
761 | cmp [CDDataBuf+4],byte 1 |
||
762 | je .eject_ide1 |
||
763 | call syscall_cdaudio.free |
||
764 | jmp .ide0_1 |
||
765 | .eject_ide1: |
||
766 | call .eject |
||
767 | call syscall_cdaudio.free |
||
768 | jmp .ide0_1 |
||
769 | |||
770 | .ide0: |
||
771 | cli |
||
772 | cmp [ATAPI_IDE0_lock],1 |
||
773 | jne .end |
||
774 | cmp [IDE_Channel_1],0 |
||
775 | jne .end |
||
776 | cmp [cd_status],0 |
||
777 | jne .end |
||
778 | mov [IDE_Channel_1],1 |
||
779 | call reserve_ok2 |
||
780 | mov [ChannelNumber],1 |
||
781 | mov [DiskNumber],0 |
||
782 | mov [cdpos],1 |
||
783 | call GetEvent_StatusNotification |
||
784 | cmp [CDDataBuf+4],byte 1 |
||
785 | je .eject_ide0 |
||
786 | call syscall_cdaudio.free |
||
787 | jmp .end |
||
788 | .eject_ide0: |
||
789 | call .eject |
||
790 | call syscall_cdaudio.free |
||
791 | jmp .end |
||
792 | |||
793 | .eject: |
||
794 | call clear_CD_cache |
||
795 | call allow_medium_removal |
||
796 | mov [ignore_CD_eject_wait],1 |
||
797 | call EjectMedium |
||
798 | mov [ignore_CD_eject_wait],0 |
||
799 | ret |
||
800 | |||
801 | timer_ATAPI_check dd 0 |
||
802 | ATAPI_IDE0_lock db 0 |
||
803 | ATAPI_IDE1_lock db 0 |
||
804 | ATAPI_IDE2_lock db 0 |
||
805 | ATAPI_IDE3_lock db 0 |
||
806 | ignore_CD_eject_wait db 0 |
||
807 | |||
808 | ;************************************************* |
||
809 | ;* Получить сообщение о событии или состоянии * |
||
810 | ;* устройства * |
||
811 | ;* Входные параметры передаются через глобальные * |
||
812 | ;* переменные: * |
||
813 | ;* ChannelNumber - номер канала; * |
||
814 | ;* DiskNumber - номер диска на канале. * |
||
815 | ;************************************************* |
||
816 | GetEvent_StatusNotification: |
||
817 | pusha |
||
818 | mov [CDDataBuf_pointer],CDDataBuf |
||
87 | mario79 | 819 | ; Очистить буфер пакетной команды |
585 | mario79 | 820 | call clear_packet_buffer |
618 | mario79 | 821 | ; Задать код команды |
822 | mov [PacketCommand],word 4Ah |
||
823 | mov [PacketCommand+1],byte 00000001b |
||
824 | ; Задать запрос класса сообщений |
||
825 | mov [PacketCommand+4],byte 00010000b |
||
826 | ; Задать запрос класса сообщений |
||
827 | mov [PacketCommand+7],byte 8 |
||
828 | mov [PacketCommand+8],byte 0 |
||
87 | mario79 | 829 | ; Подать команду |
618 | mario79 | 830 | ; mov [timer_ticks_enable],0 |
585 | mario79 | 831 | call SendPacketDatCommand |
618 | mario79 | 832 | ; mov [timer_ticks_enable],1 |
585 | mario79 | 833 | popa |
834 | ret |
||
87 | mario79 | 835 | |
618 | mario79 | 836 | ;************************************************* |
837 | ;* ОПРЕДЕЛИТЬ ОБЩЕЕ КОЛИЧЕСТВО СЕКТОРОВ НА ДИСКЕ * |
||
838 | ;* Входные параметры передаются через глобальные * |
||
839 | ;* переменные: * |
||
840 | ;* ChannelNumber - номер канала; * |
||
841 | ;* DiskNumber - номер диска на канале. * |
||
842 | ;************************************************* |
||
843 | ;ReadCapacity: |
||
844 | ; pusha |
||
845 | ;; Очистить буфер пакетной команды |
||
846 | ; call clear_packet_buffer |
||
847 | ;; Задать размер буфера в байтах |
||
848 | ; mov [CDBlockSize],8 |
||
849 | ;; Сформировать команду READ CAPACITY |
||
850 | ; mov [PacketCommand],word 25h |
||
851 | ;; Подать команду |
||
852 | ; call SendPacketDatCommand |
||
853 | ; popa |
||
854 | ; ret |
||
855 | |||
585 | mario79 | 856 | clear_packet_buffer: |
87 | mario79 | 857 | ; Очистить буфер пакетной команды |
585 | mario79 | 858 | mov [PacketCommand],dword 0 |
859 | mov [PacketCommand+4],dword 0 |
||
860 | mov [PacketCommand+8],dword 0 |
||
861 | ret |
||
87 | mario79 | 862 |