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