Subversion Repositories Kolibri OS

Rev

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