Subversion Repositories Kolibri OS

Rev

Rev 2434 | Rev 3555 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
431 serge 1
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
2
;;                                                              ;;
2465 Serge 3
;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
431 serge 4
;; Distributed under terms of the GNU General Public License    ;;
5
;;                                                              ;;
6
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
7
 
593 mikedld 8
$Revision: 2465 $
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
;-----------------------------------------------------------
33
    pushad
2434 Serge 34
        mov     eax, [CDSectorAddress]
35
        mov     ebx, [CDDataBuf_pointer]
585 mario79 36
    call  cd_calculate_cache
2434 Serge 37
        xor     edi, edi
38
        add     esi, 8
1276 Lrz 39
    inc   edi
585 mario79 40
.hdreadcache:
41
;    cmp   dword [esi+4],0       ; empty
42
;    je    .nohdcache
2434 Serge 43
        cmp     [esi], eax      ; correct sector
1168 Lrz 44
    je    .yeshdcache
585 mario79 45
.nohdcache:
2434 Serge 46
        add     esi, 8
585 mario79 47
    inc   edi
48
    dec   ecx
49
    jnz   .hdreadcache
1168 Lrz 50
    call  find_empty_slot_CD_cache       ; ret in edi
585 mario79 51
 
52
    push  edi
53
    push  eax
54
    call  cd_calculate_cache_2
2434 Serge 55
        shl     edi, 11
56
        add     edi, eax
57
        mov     [CDDataBuf_pointer], edi
585 mario79 58
    pop   eax
59
    pop   edi
60
 
61
    call  ReadCDWRetr_1
2434 Serge 62
        cmp     [DevErrorCode], 0
628 mario79 63
    jne   .exit
64
 
2434 Serge 65
        mov     [CDDataBuf_pointer], ebx
585 mario79 66
    call  cd_calculate_cache_1
2434 Serge 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:
2434 Serge 71
        mov     esi, edi
72
        shl     esi, 11;9
585 mario79 73
    push  eax
74
    call  cd_calculate_cache_2
2434 Serge 75
        add     esi, eax
585 mario79 76
    pop   eax
2434 Serge 77
        mov     edi, ebx;[CDDataBuf_pointer]
78
        mov     ecx, 512;/4
585 mario79 79
    cld
1168 Lrz 80
    rep   movsd                 ; move data
628 mario79 81
.exit:
585 mario79 82
    popad
83
    ret
84
 
85
ReadCDWRetr_1:
1168 Lrz 86
        pushad
585 mario79 87
 
87 mario79 88
; Цикл, пока команда не выполнена успешно или не
89
; исчерпано количество попыток
2434 Serge 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:
105
	push	ecx
106
;        pusha
107
; Задать размер сектора
108
;        mov       [CDBlockSize],2048 ;2352
109
; Очистить буфер пакетной команды
110
        call  clear_packet_buffer
111
; Сформировать пакетную команду для считывания
112
; сектора данных
113
; Задать код команды Read CD
2434 Serge 114
        mov     [PacketCommand], byte 0x28;0xBE
1276 Lrz 115
; Задать адрес сектора
2434 Serge 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
; Задать количество считываемых секторов
2434 Serge 125
        mov     [PacketCommand+8], byte 1
1276 Lrz 126
; Задать считывание данных в полном объеме
127
;        mov     [PacketCommand+9],byte 0xF8
128
; Подать команду
129
        call  SendPacketDatCommand
130
        pop   ecx
131
;        ret
585 mario79 132
 
1276 Lrz 133
;        cmp       [DevErrorCode],0
2434 Serge 134
        test    eax, eax
1276 Lrz 135
        jz    @@End_4
136
 
2434 Serge 137
        or      ecx, ecx        ;{SPraid.simba} (for cd load)
1168 Lrz 138
        jz    @@End_4
139
        dec   ecx
585 mario79 140
 
2434 Serge 141
        cmp     [timer_ticks_enable], 0
1168 Lrz 142
        jne   @f
2434 Serge 143
        mov     eax, NoTickWaitTime
538 spraid 144
.wait:
1168 Lrz 145
        dec   eax
1276 Lrz 146
;        test  eax,eax
147
        jz    @@NextRetr
1168 Lrz 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
1168 Lrz 157
        loop  @@NextRetr
87 mario79 158
@@End_4:
2434 Serge 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
; Область памяти для формирования пакетной команды
2434 Serge 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
; Адрес считываемого сектора данных
2434 Serge 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:
2434 Serge 202
        xor     eax, eax
1276 Lrz 203
;        mov	byte [DevErrorCode],al
87 mario79 204
; Задать режим CHS
2434 Serge 205
        mov     byte [ATAAddressMode], al
87 mario79 206
; Послать ATA-команду передачи пакетной команды
2434 Serge 207
        mov     byte [ATAFeatures], al
208
        mov     byte [ATASectorCount], al
209
        mov     byte [ATASectorNumber], al
1168 Lrz 210
        ; Загрузить размер передаваемого блока
2434 Serge 211
        mov     [ATAHead], al
1276 Lrz 212
;        mov     AX,[CDBlockSize]
2434 Serge 213
        mov     [ATACylinder], CDBlockSize
214
        mov     [ATACommand], 0A0h
1168 Lrz 215
        call    SendCommandToHDD_1
2434 Serge 216
        test    eax, eax
1276 Lrz 217
;        cmp     [DevErrorCode],0 ;проверить код ошибки
218
        jnz     @@End_8    ;закончить, сохранив код ошибки
87 mario79 219
 
220
; Ожидание готовности дисковода к приему
221
; пакетной команды
2434 Serge 222
        mov     DX, [ATABasePortAddr]
223
        add     DX, 7    ;порт 1х7h
224
        mov     ecx, NoTickWaitTime
87 mario79 225
@@WaitDevice0:
2434 Serge 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
        ; Проверить время выполнения команды
2434 Serge 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:
2434 Serge 241
        in      AL, DX
242
        test    AL, 80h  ;состояние сигнала BSY
1168 Lrz 243
        jnz     @@WaitDevice0
2434 Serge 244
        test    AL, 1    ;состояние сигнала ERR
2010 serge 245
        jnz     @@Err6
2434 Serge 246
        test    AL, 08h  ;состояние сигнала DRQ
1168 Lrz 247
        jz      @@WaitDevice0
87 mario79 248
; Послать пакетную команду
1168 Lrz 249
        cli
2434 Serge 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
; Ожидание готовности данных
2434 Serge 265
        mov     DX, [ATABasePortAddr]
266
        add     DX, 7  ;порт 1х7h
267
        mov     ecx, NoTickWaitTime
87 mario79 268
@@WaitDevice1:
2434 Serge 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
        ; Проверить время выполнения команды
2434 Serge 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:
2434 Serge 284
        in      AL, DX
285
        test    AL, 80h  ;состояние сигнала BSY
1168 Lrz 286
        jnz     @@WaitDevice1
2434 Serge 287
        test    AL, 1    ;состояние сигнала ERR
2010 serge 288
        jnz     @@Err6_temp
2434 Serge 289
        test    AL, 08h  ;состояние сигнала DRQ
1168 Lrz 290
        jz      @@WaitDevice1
87 mario79 291
; Принять блок данных от контроллера
2434 Serge 292
        mov     EDI, [CDDataBuf_pointer];0x7000  ;CDDataBuf
1168 Lrz 293
        ; Загрузить адрес регистра данных контроллера
2434 Serge 294
        mov     DX, [ATABasePortAddr];порт 1x0h
1168 Lrz 295
        ; Загрузить в счетчик размер блока в байтах
2434 Serge 296
        xor     ecx, ecx
297
        mov     CX, CDBlockSize
1168 Lrz 298
        ; Вычислить размер блока в 16-разрядных словах
2434 Serge 299
        shr     CX, 1;разделить размер блока на 2
1168 Lrz 300
        ; Принять блок данных
301
        cli
302
        cld
303
        rep     insw
304
        sti
1276 Lrz 305
; Успешное завершение приема данных
306
@@End_8:
2434 Serge 307
        xor     eax, eax
1276 Lrz 308
        ret
87 mario79 309
 
310
; Записать код ошибки
311
@@Err1_1:
2434 Serge 312
        xor     eax, eax
1276 Lrz 313
	inc	eax
314
	ret
315
;        mov     [DevErrorCode],1
316
;	ret
87 mario79 317
@@Err6_temp:
2434 Serge 318
        mov     eax, 7
1276 Lrz 319
	ret
320
;        mov     [DevErrorCode],7
321
;	ret
87 mario79 322
@@Err6:
2434 Serge 323
        mov     eax, 6
1276 Lrz 324
	ret
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
2434 Serge 342
        xor     eax, eax
1276 Lrz 343
;        mov     byte [DevErrorCode],al
87 mario79 344
; Задать режим CHS
2434 Serge 345
        mov     byte [ATAAddressMode], al
87 mario79 346
; Послать ATA-команду передачи пакетной команды
2434 Serge 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 ;проверить код ошибки
2434 Serge 355
        test    eax, eax
1276 Lrz 356
        jnz     @@End_9  ;закончить, сохранив код ошибки
87 mario79 357
; Ожидание готовности дисковода к приему
358
; пакетной команды
2434 Serge 359
        mov     DX, [ATABasePortAddr]
360
        add     DX, 7  ;порт 1х7h
87 mario79 361
@@WaitDevice0_1:
1168 Lrz 362
        call    change_task
363
        ; Проверить время ожидания
2434 Serge 364
        mov     EAX, [timer_ticks]
365
        sub     EAX, [TickCounter_1]
366
        cmp     EAX, BSYWaitTime
1168 Lrz 367
        ja      @@Err1_3   ;ошибка тайм-аута
368
        ; Проверить готовность
2434 Serge 369
        in      AL, DX
370
        test    AL, 80h  ;состояние сигнала BSY
1168 Lrz 371
        jnz     @@WaitDevice0_1
2434 Serge 372
        test    AL, 1    ;состояние сигнала ERR
1168 Lrz 373
        jnz     @@Err6_1
2434 Serge 374
        test    AL, 08h  ;состояние сигнала DRQ
1168 Lrz 375
        jz      @@WaitDevice0_1
87 mario79 376
; Послать пакетную команду
377
;        cli
2434 Serge 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
2434 Serge 392
        cmp     [ignore_CD_eject_wait], 1
1276 Lrz 393
	je  @@clear_DEC
87 mario79 394
; Ожидание подтверждения приема команды
2434 Serge 395
        mov     DX, [ATABasePortAddr]
396
        add     DX, 7  ;порт 1х7h
87 mario79 397
@@WaitDevice1_1:
1168 Lrz 398
        call    change_task
399
        ; Проверить время выполнения команды
2434 Serge 400
        mov     EAX, [timer_ticks]
401
        sub     EAX, [TickCounter_1]
402
        cmp     EAX, MaxCDWaitTime
1168 Lrz 403
        ja      @@Err1_3   ;ошибка тайм-аута
404
        ; Ожидать освобождения устройства
2434 Serge 405
        in      AL, DX
406
        test    AL, 80h  ;состояние сигнала BSY
1168 Lrz 407
        jnz     @@WaitDevice1_1
2434 Serge 408
        test    AL, 1    ;состояние сигнала ERR
1168 Lrz 409
        jnz     @@Err6_1
2434 Serge 410
        test    AL, 40h  ;состояние сигнала DRDY
1168 Lrz 411
        jz      @@WaitDevice1_1
1276 Lrz 412
@@clear_DEC:
2434 Serge 413
        and     [DevErrorCode], 0
1276 Lrz 414
        popad
415
        ret
87 mario79 416
; Записать код ошибки
417
@@Err1_3:
2434 Serge 418
        xor     eax, eax
1276 Lrz 419
	inc	eax
1168 Lrz 420
        jmp @@End_9
87 mario79 421
@@Err6_1:
2434 Serge 422
        mov     eax, 6
87 mario79 423
@@End_9:
2434 Serge 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
449
;        mov   	[DevErrorCode],0	not need
87 mario79 450
; Проверить значение кода режима
2434 Serge 451
        cmp     [ATAAddressMode], 1
1168 Lrz 452
        ja      @@Err2_4
87 mario79 453
; Проверить корректность номера канала
2434 Serge 454
        mov     BX, [ChannelNumber]
455
        cmp     BX, 1
1168 Lrz 456
        jb      @@Err3_4
2434 Serge 457
        cmp     BX, 2
1168 Lrz 458
        ja      @@Err3_4
87 mario79 459
; Установить базовый адрес
1168 Lrz 460
        dec     BX
2434 Serge 461
        shl     BX, 1
462
        movzx   ebx, bx
463
        mov     AX, [ebx+StandardATABases]
464
        mov     [ATABasePortAddr], AX
87 mario79 465
; Ожидание готовности HDD к приему команды
1168 Lrz 466
        ; Выбрать нужный диск
2434 Serge 467
        mov     DX, [ATABasePortAddr]
468
        add     DX, 6   ;адрес регистра головок
469
        mov     AL, [DiskNumber]
470
        cmp     AL, 1   ;проверить номера диска
1168 Lrz 471
        ja      @@Err4_4
2434 Serge 472
        shl     AL, 4
473
        or      AL, 10100000b
474
        out     DX, AL
1168 Lrz 475
        ; Ожидать, пока диск не будет готов
476
        inc     DX
2434 Serge 477
        mov     eax, [timer_ticks]
478
        mov     [TickCounter_1], eax
479
        mov     ecx, NoTickWaitTime
87 mario79 480
@@WaitHDReady_2:
2434 Serge 481
        cmp     [timer_ticks_enable], 0
1168 Lrz 482
        jne    @f
483
        dec    ecx
1276 Lrz 484
;        test   ecx,ecx
485
        jz     @@Err1_4
1168 Lrz 486
        jmp    .test
538 spraid 487
@@:
1168 Lrz 488
        call    change_task
489
        ; Проверить время ожидания
2434 Serge 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:
2434 Serge 496
        in      AL, DX
1168 Lrz 497
        ; Проверить состояние сигнала BSY
2434 Serge 498
        test    AL, 80h
1168 Lrz 499
        jnz     @@WaitHDReady_2
500
        ; Проверить состояние сигнала DRQ
2434 Serge 501
        test    AL, 08h
1168 Lrz 502
        jnz     @@WaitHDReady_2
538 spraid 503
 
87 mario79 504
; Загрузить команду в регистры контроллера
1168 Lrz 505
        cli
2434 Serge 506
        mov     DX, [ATABasePortAddr]
1168 Lrz 507
        inc     DX      ;регистр "особенностей"
2434 Serge 508
        mov     AL, [ATAFeatures]
509
        out     DX, AL
1168 Lrz 510
        inc     DX      ;счетчик секторов
2434 Serge 511
        mov     AL, [ATASectorCount]
512
        out     DX, AL
1168 Lrz 513
        inc     DX      ;регистр номера сектора
2434 Serge 514
        mov     AL, [ATASectorNumber]
515
        out     DX, AL
1168 Lrz 516
        inc     DX      ;номер цилиндра (младший байт)
2434 Serge 517
        mov     AX, [ATACylinder]
518
        out     DX, AL
1168 Lrz 519
        inc     DX      ;номер цилиндра (старший байт)
2434 Serge 520
        mov     AL, AH
521
        out     DX, AL
1168 Lrz 522
        inc     DX      ;номер головки/номер диска
2434 Serge 523
        mov     AL, [DiskNumber]
524
        shl     AL, 4
525
        cmp     [ATAHead], 0Fh;проверить номер головки
1168 Lrz 526
        ja      @@Err5_4
2434 Serge 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
; Послать команду
2434 Serge 534
        mov     AL, [ATACommand]
1168 Lrz 535
        inc     DX      ;регистр команд
2434 Serge 536
        out     DX, AL
1168 Lrz 537
        sti
87 mario79 538
; Сбросить признак ошибки
1276 Lrz 539
;        mov     [DevErrorCode],0
540
@@End_10:
2434 Serge 541
        xor     eax, eax
1276 Lrz 542
	ret
87 mario79 543
; Записать код ошибки
544
@@Err1_4:
2434 Serge 545
        xor     eax, eax
1276 Lrz 546
	inc	eax
547
;        mov     [DevErrorCode],1
548
	ret
87 mario79 549
@@Err2_4:
2434 Serge 550
        mov     eax, 2
1276 Lrz 551
;        mov     [DevErrorCode],2
552
	ret
87 mario79 553
@@Err3_4:
2434 Serge 554
        mov     eax, 3
1276 Lrz 555
;        mov     [DevErrorCode],3
556
	ret
87 mario79 557
@@Err4_4:
2434 Serge 558
        mov     eax, 4
1276 Lrz 559
;        mov     [DevErrorCode],4
560
	ret
87 mario79 561
@@Err5_4:
2434 Serge 562
        mov     eax, 5
1276 Lrz 563
;        mov     [DevErrorCode],5
87 mario79 564
; Завершение работы программы
1276 Lrz 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
; Запомнить время начала операции
2434 Serge 579
        mov     EAX, [timer_ticks]
580
        mov     [WURStartTime], EAX
87 mario79 581
; Очистить буфер пакетной команды
1168 Lrz 582
        call  clear_packet_buffer
87 mario79 583
; Сформировать команду TEST UNIT READY
2434 Serge 584
        mov     [PacketCommand], word 00h
87 mario79 585
; ЦИКЛ ОЖИДАНИЯ ГОТОВНОСТИ УСТРОЙСТВА
2434 Serge 586
        mov     ecx, NoTickWaitTime
87 mario79 587
@@SendCommand:
1168 Lrz 588
        ; Подать команду проверки готовности
589
        call    SendPacketNoDatCommand
2434 Serge 590
        cmp     [timer_ticks_enable], 0
1168 Lrz 591
        jne     @f
2434 Serge 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
        ; Проверить код ошибки
2434 Serge 601
        cmp     [DevErrorCode], 0
1168 Lrz 602
        je      @@End_11
603
        ; Проверить время ожидания готовности
2434 Serge 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
        ; Ошибка тайм-аута
2434 Serge 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
; Очистить буфер пакетной команды
1168 Lrz 625
        call  clear_packet_buffer
585 mario79 626
; Задать код команды
2434 Serge 627
        mov     [PacketCommand], byte 0x1E
585 mario79 628
; Задать код запрета
2434 Serge 629
        mov     [PacketCommand+4], byte 11b
585 mario79 630
; Подать команду
1168 Lrz 631
        call SendPacketNoDatCommand
2434 Serge 632
        mov     eax, ATAPI_IDE0_lock
633
        add     eax, [cdpos]
1168 Lrz 634
        dec  eax
2434 Serge 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
; Очистить буфер пакетной команды
1168 Lrz 649
        call  clear_packet_buffer
585 mario79 650
; Задать код команды
2434 Serge 651
        mov     [PacketCommand], byte 0x1E
585 mario79 652
; Задать код запрета
2434 Serge 653
        mov     [PacketCommand+4], byte 00b
585 mario79 654
; Подать команду
1168 Lrz 655
        call SendPacketNoDatCommand
2434 Serge 656
        mov     eax, ATAPI_IDE0_lock
657
        add     eax, [cdpos]
1168 Lrz 658
        dec  eax
2434 Serge 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
; Очистить буфер пакетной команды
1168 Lrz 673
        call  clear_packet_buffer
87 mario79 674
; Сформировать команду START/STOP UNIT
1168 Lrz 675
        ; Задать код команды
2434 Serge 676
        mov     [PacketCommand], word 1Bh
1168 Lrz 677
        ; Задать операцию загрузки носителя
2434 Serge 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
; Очистить буфер пакетной команды
1168 Lrz 694
        call  clear_packet_buffer
87 mario79 695
; Сформировать команду START/STOP UNIT
1168 Lrz 696
        ; Задать код команды
2434 Serge 697
        mov     [PacketCommand], word 1Bh
1168 Lrz 698
        ; Задать операцию извлечения носителя
2434 Serge 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
2434 Serge 716
        mov     eax, [timer_ticks]
717
        sub     eax, [timer_ATAPI_check]
718
        cmp     eax, 100
1168 Lrz 719
    jb   .end_1
2434 Serge 720
        mov     al, [DRIVE_DATA+1]
721
        and     al, 11b
722
        cmp     al, 10b
1168 Lrz 723
    jz  .ide3
618 mario79 724
.ide2_1:
2434 Serge 725
        mov     al, [DRIVE_DATA+1]
726
        and     al, 1100b
727
        cmp     al, 1000b
1168 Lrz 728
    jz  .ide2
618 mario79 729
.ide1_1:
2434 Serge 730
        mov     al, [DRIVE_DATA+1]
731
        and     al, 110000b
732
        cmp     al, 100000b
1168 Lrz 733
    jz  .ide1
618 mario79 734
.ide0_1:
2434 Serge 735
        mov     al, [DRIVE_DATA+1]
736
        and     al, 11000000b
737
        cmp     al, 10000000b
1168 Lrz 738
    jz  .ide0
618 mario79 739
.end:
740
 
741
    sti
2434 Serge 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:
749
    cli
2434 Serge 750
        cmp     [ATAPI_IDE3_lock], 1
618 mario79 751
    jne  .ide2_1
2434 Serge 752
        cmp     [IDE_Channel_2], 0
618 mario79 753
    jne  .ide1_1
2434 Serge 754
        cmp     [cd_status], 0
618 mario79 755
    jne  .end
2434 Serge 756
        mov     [IDE_Channel_2], 1
618 mario79 757
    call reserve_ok2
2434 Serge 758
        mov     [ChannelNumber], 2
759
        mov     [DiskNumber], 1
760
        mov     [cdpos], 4
1168 Lrz 761
        call GetEvent_StatusNotification
2434 Serge 762
        cmp     [CDDataBuf+4], byte 1
1168 Lrz 763
        je   .eject_ide3
764
        call syscall_cdaudio.free
618 mario79 765
    jmp  .ide2_1
766
.eject_ide3:
767
    call .eject
1168 Lrz 768
        call syscall_cdaudio.free
618 mario79 769
    jmp  .ide2_1
770
 
771
.ide2:
772
    cli
2434 Serge 773
        cmp     [ATAPI_IDE2_lock], 1
618 mario79 774
    jne  .ide1_1
2434 Serge 775
        cmp     [IDE_Channel_2], 0
618 mario79 776
    jne  .ide1_1
2434 Serge 777
        cmp     [cd_status], 0
618 mario79 778
    jne  .end
2434 Serge 779
        mov     [IDE_Channel_2], 1
618 mario79 780
    call  reserve_ok2
2434 Serge 781
        mov     [ChannelNumber], 2
782
        mov     [DiskNumber], 0
783
        mov     [cdpos], 3
1168 Lrz 784
        call GetEvent_StatusNotification
2434 Serge 785
        cmp     [CDDataBuf+4], byte 1
1168 Lrz 786
        je   .eject_ide2
787
        call syscall_cdaudio.free
618 mario79 788
    jmp  .ide1_1
789
.eject_ide2:
790
    call .eject
1168 Lrz 791
        call syscall_cdaudio.free
618 mario79 792
    jmp  .ide1_1
793
 
794
.ide1:
795
    cli
2434 Serge 796
        cmp     [ATAPI_IDE1_lock], 1
618 mario79 797
    jne  .ide0_1
2434 Serge 798
        cmp     [IDE_Channel_1], 0
618 mario79 799
    jne  .end
2434 Serge 800
        cmp     [cd_status], 0
618 mario79 801
    jne  .end
2434 Serge 802
        mov     [IDE_Channel_1], 1
618 mario79 803
    call reserve_ok2
2434 Serge 804
        mov     [ChannelNumber], 1
805
        mov     [DiskNumber], 1
806
        mov     [cdpos], 2
1168 Lrz 807
        call GetEvent_StatusNotification
2434 Serge 808
        cmp     [CDDataBuf+4], byte 1
1168 Lrz 809
        je   .eject_ide1
810
        call syscall_cdaudio.free
618 mario79 811
    jmp  .ide0_1
812
.eject_ide1:
813
    call .eject
1168 Lrz 814
        call syscall_cdaudio.free
618 mario79 815
    jmp  .ide0_1
816
 
817
.ide0:
818
    cli
2434 Serge 819
        cmp     [ATAPI_IDE0_lock], 1
618 mario79 820
    jne  .end
2434 Serge 821
        cmp     [IDE_Channel_1], 0
618 mario79 822
    jne  .end
2434 Serge 823
        cmp     [cd_status], 0
618 mario79 824
    jne  .end
2434 Serge 825
        mov     [IDE_Channel_1], 1
618 mario79 826
    call reserve_ok2
2434 Serge 827
        mov     [ChannelNumber], 1
828
        mov     [DiskNumber], 0
829
        mov     [cdpos], 1
1168 Lrz 830
        call GetEvent_StatusNotification
2434 Serge 831
        cmp     [CDDataBuf+4], byte 1
1168 Lrz 832
        je   .eject_ide0
833
        call syscall_cdaudio.free
618 mario79 834
    jmp  .end
835
.eject_ide0:
836
    call .eject
1168 Lrz 837
        call syscall_cdaudio.free
618 mario79 838
    jmp  .end
839
 
840
.eject:
1168 Lrz 841
        call clear_CD_cache
842
        call allow_medium_removal
2434 Serge 843
        mov     [ignore_CD_eject_wait], 1
1168 Lrz 844
        call EjectMedium
2434 Serge 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
2434 Serge 865
        mov     [CDDataBuf_pointer], CDDataBuf
87 mario79 866
; Очистить буфер пакетной команды
1168 Lrz 867
        call  clear_packet_buffer
618 mario79 868
; Задать код команды
2434 Serge 869
        mov     [PacketCommand], byte 4Ah
870
        mov     [PacketCommand+1], byte 00000001b
618 mario79 871
; Задать запрос класса сообщений
2434 Serge 872
        mov     [PacketCommand+4], byte 00010000b
628 mario79 873
; Размер выделенной области
2434 Serge 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
2434 Serge 890
        mov     [CDDataBuf_pointer], CDDataBuf
758 mario79 891
; Очистить буфер пакетной команды
1168 Lrz 892
        call  clear_packet_buffer
758 mario79 893
; Сформировать пакетную команду для считывания
894
; сектора данных
2434 Serge 895
        mov     [PacketCommand], byte 0x43
1168 Lrz 896
        ; Задать формат
2434 Serge 897
        mov     [PacketCommand+2], byte 1
758 mario79 898
; Размер выделенной области
2434 Serge 899
        mov     [PacketCommand+7], byte 0xFF
900
        mov     [PacketCommand+8], byte 0h
758 mario79 901
; Подать команду
1168 Lrz 902
        call  SendPacketDatCommand
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
; Очистить буфер пакетной команды
2434 Serge 928
        and     [PacketCommand], dword 0
929
        and     [PacketCommand+4], dword 0
930
        and     [PacketCommand+8], dword 0
1168 Lrz 931
        ret