WebSVN – Kolibri OS – Diff – /kernel/branches/Kolibri-acpi/blkdev/cd_drv.inc

 ;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
 ;; Distributed under terms of the GNU General Public License    ;;
 ;;                                                              ;;
 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
-$Revision: 3908 $
+$Revision: 5201 $
 ;-----------------------------------------------------------------------------
 ;**********************************************************
 ;  Непосредственная работа с устройством СD (ATAPI)
 ;**********************************************************
         mov     ebx, [CDDataBuf_pointer]
         call    cd_calculate_cache
         xor     edi, edi
         add     esi, 8
         inc     edi
+;--------------------------------------
+align 4
 .hdreadcache:
-;    cmp   dword [esi+4],0       ; empty
-;    je    .nohdcache
         cmp     [esi], eax      ; correct sector
         je      .yeshdcache
-.nohdcache:
         add     esi, 8
         inc     edi
         dec     ecx
         jnz     .hdreadcache
         call    find_empty_slot_CD_cache ; ret in edi
         push    edi
         push    eax
         mov     [CDDataBuf_pointer], ebx
         call    cd_calculate_cache_1
         lea     esi, [edi*8+esi]
         mov     [esi], eax      ; sector number
-;    mov   dword [esi+4],1       ; hd read - mark as same as in hd
+;--------------------------------------
 .yeshdcache:
         mov     esi, edi
-        shl     esi, 11;9
+        shl     esi, 11 ;9
         push    eax
         pop     eax
-        mov     edi, ebx;[CDDataBuf_pointer]
+        mov     edi, ebx ;[CDDataBuf_pointer]
-        mov     ecx, 512;/4
+        mov     ecx, 512 ;/4
         cld
         rep movsd               ; move data
+;--------------------------------------
 .exit:
         popad
         ret
+;-----------------------------------------------------------------------------
 ReadCDWRetr_1:
         pushad
 ; Цикл, пока команда не выполнена успешно или не
 ; исчерпано количество попыток
-        mov     ECX, MaxRetr
+        mov     ecx, MaxRetr
+;--------------------------------------
+align 4
 @@NextRetr:
 ; Подать команду
 ;*************************************************
 ;*      ПОЛНОЕ ЧТЕНИЕ СЕКТОРА КОМПАКТ-ДИСКА      *
 ;* Считываются данные пользователя, информация   *
 ;* CDSectorAddress - адрес считываемого сектора. *
 ;* Данные считывается в массив CDDataBuf.        *
 ;*************************************************
 ;ReadCD:
         push    ecx
-;        pusha
-; Задать размер сектора
-;        mov       [CDBlockSize],2048 ;2352
 ; Очистить буфер пакетной команды
         call    clear_packet_buffer
 ; Сформировать пакетную команду для считывания
 ; сектора данных
 ; Задать код команды Read CD
-        mov     [PacketCommand], byte 0x28;0xBE
+        mov     [PacketCommand], byte 0x28 ;0xBE
 ; Задать адрес сектора
-        mov     AX, word [CDSectorAddress+2]
+        mov     ax, word [CDSectorAddress+2]
-        xchg    AL, AH
+        xchg    al, ah
-        mov     word [PacketCommand+2], AX
+        mov     word [PacketCommand+2], ax
-        mov     AX, word [CDSectorAddress]
+        mov     ax, word [CDSectorAddress]
-        xchg    AL, AH
+        xchg    al, ah
-        mov     word [PacketCommand+4], AX
+        mov     word [PacketCommand+4], ax
-;        mov   eax,[CDSectorAddress]
-;        mov   [PacketCommand+2],eax
 ; Задать количество считываемых секторов
         mov     [PacketCommand+8], byte 1
-; Задать считывание данных в полном объеме
-;        mov     [PacketCommand+9],byte 0xF8
 ; Подать команду
         call    SendPacketDatCommand
         pop     ecx
-;        ret
 ;        cmp       [DevErrorCode],0
         test    eax, eax
         jz      @@End_4
+        or      ecx, ecx        ;{SPraid.simba} (for cd load)
-        or      ecx, ecx        ;{SPraid.simba} (for cd load)
+        jz      @@End_4
         jz      @@End_4
         dec     ecx
         cmp     [timer_ticks_enable], 0
+        jne     @f
-        cmp     [timer_ticks_enable], 0
+        mov     eax, NoTickWaitTime
-        jne     @f
+;--------------------------------------
-        mov     eax, NoTickWaitTime
-.wait:
+align 4
+.wait:
         dec     eax
+        jz      @@NextRetr
-;        test  eax,eax
+        jmp     .wait
-        jz      @@NextRetr
-        jmp     .wait
-@@:
-; Задержка на 2,5 секунды
-;       mov     EAX,[timer_ticks]
-;       add     EAX,50  ;250
-;@@Wait:
-;       call    change_task
+;--------------------------------------
+align 4
-;       cmp     EAX,[timer_ticks]
+@@:
-;       ja      @@Wait
+        loop    @@NextRetr
-        loop    @@NextRetr
+;--------------------------------------
 @@End_4:
-        mov     dword [DevErrorCode], eax
-        popad
+        mov     dword [DevErrorCode], eax
-        ret
+        popad
         ret
-; Универсальные процедуры, обеспечивающие выполнение
+;-----------------------------------------------------------------------------
-;             пакетных команд в режиме PIO
+; Универсальные процедуры, обеспечивающие выполнение
+;             пакетных команд в режиме PIO
 ; Максимально допустимое время ожидания реакции
 ; устройства на пакетную команду (в тиках)
 ;-----------------------------------------------------------------------------
 MaxCDWaitTime equ 1000 ;200 ;10 секунд
 uglobal
-; Область памяти для формирования пакетной команды
-PacketCommand:
-                 rb 12  ;DB 12 DUP (?)
-; Область памяти для приема данных от дисковода
-;CDDataBuf       DB 4096 DUP (0)
+; Область памяти для формирования пакетной команды
-; Размер принимаемого блока данных в байтах
+PacketCommand:
-;CDBlockSize     DW ?
-; Адрес считываемого сектора данных
+                 rb 12  ;DB 12 DUP (?)
-CDSectorAddress:
+; Адрес считываемого сектора данных
-                 DD ?
+CDSectorAddress:   dd ?
 ; Время начала очередной операции с диском
-TickCounter_1 DD 0
+TickCounter_1     dd 0
 ; Время начала ожидания готовности устройства
-WURStartTime DD 0
+WURStartTime      dd 0
+; указатель буфера для считывания
-; указатель буфера для считывания
+CDDataBuf_pointer dd 0
-CDDataBuf_pointer dd 0
+endg
-endg
+;-----------------------------------------------------------------------------
 ;****************************************************
 ;*    ПОСЛАТЬ УСТРОЙСТВУ ATAPI ПАКЕТНУЮ КОМАНДУ,    *
 ;* CDBlockSize - размер принимаемого блока данных.  *
 ; return eax DevErrorCode
 ;****************************************************
 SendPacketDatCommand:
         xor     eax, eax
-;        mov    byte [DevErrorCode],al
 ; Задать режим CHS
         mov     byte [ATAAddressMode], al
 ; Послать ATA-команду передачи пакетной команды
         mov     byte [ATAFeatures], al
         mov     byte [ATASectorCount], al
         mov     byte [ATASectorNumber], al
         ; Загрузить размер передаваемого блока
         mov     [ATAHead], al
-;        mov     AX,[CDBlockSize]
         mov     [ATACylinder], CDBlockSize
-        mov     [ATACommand], 0A0h
+        mov     [ATACommand], 0xA0
         call    SendCommandToHDD_1
         test    eax, eax
-;        cmp     [DevErrorCode],0 ;проверить код ошибки
         jnz     @@End_8    ;закончить, сохранив код ошибки
 ; Ожидание готовности дисковода к приему
 ; пакетной команды
-        mov     DX, [ATABasePortAddr]
+        mov     dx, [ATABasePortAddr]
-        add     DX, 7    ;порт 1х7h
+        add     dx, 7    ;порт 1х7h
         mov     ecx, NoTickWaitTime
+;--------------------------------------
+align 4
 @@WaitDevice0:
         cmp     [timer_ticks_enable], 0
         jne     @f
         dec     ecx
-;        test    ecx,ecx
         jz      @@Err1_1
         jmp     .test
+;--------------------------------------
+align 4
 @@:
         call    change_task
         ; Проверить время выполнения команды
-        mov     EAX, [timer_ticks]
+        mov     eax, [timer_ticks]
-        sub     EAX, [TickCounter_1]
+        sub     eax, [TickCounter_1]
-        cmp     EAX, BSYWaitTime
+        cmp     eax, BSYWaitTime
         ja      @@Err1_1   ;ошибка тайм-аута
         ; Проверить готовность
+;--------------------------------------
+align 4
 .test:
-        in      AL, DX
+        in      al, dx
-        test    AL, 80h  ;состояние сигнала BSY
+        test    al, 0x80  ;состояние сигнала BSY
         jnz     @@WaitDevice0
-        test    AL, 1    ;состояние сигнала ERR
+        test    al, 1    ;состояние сигнала ERR
         jnz     @@Err6
-        test    AL, 08h  ;состояние сигнала DRQ
+        test    al, 0x8  ;состояние сигнала DRQ
         jz      @@WaitDevice0
 ; Послать пакетную команду
         cli
-        mov     DX, [ATABasePortAddr]
+        mov     dx, [ATABasePortAddr]
-        mov     AX, [PacketCommand]
+        mov     ax, [PacketCommand]
-        out     DX, AX
+        out     dx, ax
-        mov     AX, [PacketCommand+2]
+        mov     ax, [PacketCommand+2]
-        out     DX, AX
+        out     dx, ax
-        mov     AX, [PacketCommand+4]
+        mov     ax, [PacketCommand+4]
-        out     DX, AX
+        out     dx, ax
-        mov     AX, [PacketCommand+6]
+        mov     ax, [PacketCommand+6]
-        out     DX, AX
+        out     dx, ax
-        mov     AX, [PacketCommand+8]
+        mov     ax, [PacketCommand+8]
-        out     DX, AX
+        out     dx, ax
-        mov     AX, [PacketCommand+10]
+        mov     ax, [PacketCommand+10]
-        out     DX, AX
+        out     dx, ax
         sti
 ; Ожидание готовности данных
-        mov     DX, [ATABasePortAddr]
+        mov     dx, [ATABasePortAddr]
-        add     DX, 7  ;порт 1х7h
+        add     dx, 7  ;порт 1х7h
         mov     ecx, NoTickWaitTime
+;--------------------------------------
+align 4
 @@WaitDevice1:
         cmp     [timer_ticks_enable], 0
         jne     @f
         dec     ecx
-;        test    ecx,ecx
         jz      @@Err1_1
         jmp     .test_1
+;--------------------------------------
+align 4
 @@:
         call    change_task
         ; Проверить время выполнения команды
-        mov     EAX, [timer_ticks]
+        mov     eax, [timer_ticks]
-        sub     EAX, [TickCounter_1]
+        sub     eax, [TickCounter_1]
-        cmp     EAX, MaxCDWaitTime
+        cmp     eax, MaxCDWaitTime
         ja      @@Err1_1   ;ошибка тайм-аута
         ; Проверить готовность
+;--------------------------------------
+align 4
 .test_1:
-        in      AL, DX
+        in      al, dx
-        test    AL, 80h  ;состояние сигнала BSY
+        test    al, 0x80  ;состояние сигнала BSY
         jnz     @@WaitDevice1
-        test    AL, 1    ;состояние сигнала ERR
+        test    al, 1    ;состояние сигнала ERR
         jnz     @@Err6_temp
-        test    AL, 08h  ;состояние сигнала DRQ
+        test    al, 0x8  ;состояние сигнала DRQ
         jz      @@WaitDevice1
 ; Принять блок данных от контроллера
-        mov     EDI, [CDDataBuf_pointer];0x7000  ;CDDataBuf
+        mov     edi, [CDDataBuf_pointer]
         ; Загрузить адрес регистра данных контроллера
-        mov     DX, [ATABasePortAddr];порт 1x0h
+        mov     dx, [ATABasePortAddr]
         ; Загрузить в счетчик размер блока в байтах
         xor     ecx, ecx
-        mov     CX, CDBlockSize
+        mov     cx, CDBlockSize
         ; Вычислить размер блока в 16-разрядных словах
-        shr     CX, 1;разделить размер блока на 2
+        shr     cx, 1 ;разделить размер блока на 2
         ; Принять блок данных
         cli
         cld
         rep insw
         sti
+;--------------------------------------
 ; Успешное завершение приема данных
 @@End_8:
         xor     eax, eax
         ret
+;--------------------------------------
 ; Записать код ошибки
 @@Err1_1:
         xor     eax, eax
         inc     eax
         ret
-;        mov     [DevErrorCode],1
+;--------------------------------------
-;       ret
 @@Err6_temp:
         mov     eax, 7
         ret
-;        mov     [DevErrorCode],7
+;--------------------------------------
-;       ret
 @@Err6:
         mov     eax, 6
         ret
-;        mov     [DevErrorCode],6
+;-----------------------------------------------------------------------------
-;@@End_8:
-;        ret
 ;***********************************************
 ;*  ПОСЛАТЬ УСТРОЙСТВУ ATAPI ПАКЕТНУЮ КОМАНДУ, *
 ;*     НЕ ПРЕДУСМАТРИВАЮЩУЮ ПЕРЕДАЧИ ДАННЫХ    *
 ;* Входные параметры передаются через          *
 ;* глобальные перменные:                       *
 ;* PacketCommand - 12-байтный командный пакет. *
 ;***********************************************
 SendPacketNoDatCommand:
         pushad
         xor     eax, eax
-;        mov     byte [DevErrorCode],al
 ; Задать режим CHS
         mov     byte [ATAAddressMode], al
 ; Послать ATA-команду передачи пакетной команды
         mov     byte [ATAFeatures], al
         mov     byte [ATASectorCount], al
         mov     byte [ATASectorNumber], al
         mov     word [ATACylinder], ax
         mov     byte [ATAHead], al
-        mov     [ATACommand], 0A0h
+        mov     [ATACommand], 0xA0
         call    SendCommandToHDD_1
-;        cmp     [DevErrorCode],0 ;проверить код ошибки
         test    eax, eax
         jnz     @@End_9  ;закончить, сохранив код ошибки
 ; Ожидание готовности дисковода к приему
 ; пакетной команды
-        mov     DX, [ATABasePortAddr]
+        mov     dx, [ATABasePortAddr]
-        add     DX, 7  ;порт 1х7h
+        add     dx, 7  ;порт 1х7h
+;--------------------------------------
+align 4
 @@WaitDevice0_1:
         call    change_task
         ; Проверить время ожидания
-        mov     EAX, [timer_ticks]
+        mov     eax, [timer_ticks]
-        sub     EAX, [TickCounter_1]
+        sub     eax, [TickCounter_1]
-        cmp     EAX, BSYWaitTime
+        cmp     eax, BSYWaitTime
         ja      @@Err1_3   ;ошибка тайм-аута
         ; Проверить готовность
-        in      AL, DX
+        in      al, dx
-        test    AL, 80h  ;состояние сигнала BSY
+        test    al, 0x80  ;состояние сигнала BSY
         jnz     @@WaitDevice0_1
-        test    AL, 1    ;состояние сигнала ERR
+        test    al, 1    ;состояние сигнала ERR
         jnz     @@Err6_1
-        test    AL, 08h  ;состояние сигнала DRQ
+        test    al, 0x8  ;состояние сигнала DRQ
         jz      @@WaitDevice0_1
 ; Послать пакетную команду
 ;        cli
-        mov     DX, [ATABasePortAddr]
+        mov     dx, [ATABasePortAddr]
-        mov     AX, word [PacketCommand]
+        mov     ax, word [PacketCommand]
-        out     DX, AX
+        out     dx, ax
-        mov     AX, word [PacketCommand+2]
+        mov     ax, word [PacketCommand+2]
-        out     DX, AX
+        out     dx, ax
-        mov     AX, word [PacketCommand+4]
+        mov     ax, word [PacketCommand+4]
-        out     DX, AX
+        out     dx, ax
-        mov     AX, word [PacketCommand+6]
+        mov     ax, word [PacketCommand+6]
-        out     DX, AX
+        out     dx, ax
-        mov     AX, word [PacketCommand+8]
+        mov     ax, word [PacketCommand+8]
-        out     DX, AX
+        out     dx, ax
-        mov     AX, word [PacketCommand+10]
+        mov     ax, word [PacketCommand+10]
-        out     DX, AX
+        out     dx, ax
 ;        sti
         cmp     [ignore_CD_eject_wait], 1
         je      @@clear_DEC
 ; Ожидание подтверждения приема команды
-        mov     DX, [ATABasePortAddr]
+        mov     dx, [ATABasePortAddr]
-        add     DX, 7  ;порт 1х7h
+        add     dx, 7  ;порт 1х7h
+;--------------------------------------
+align 4
 @@WaitDevice1_1:
         call    change_task
         ; Проверить время выполнения команды
-        mov     EAX, [timer_ticks]
+        mov     eax, [timer_ticks]
-        sub     EAX, [TickCounter_1]
+        sub     eax, [TickCounter_1]
-        cmp     EAX, MaxCDWaitTime
+        cmp     eax, MaxCDWaitTime
         ja      @@Err1_3   ;ошибка тайм-аута
         ; Ожидать освобождения устройства
-        in      AL, DX
+        in      al, dx
-        test    AL, 80h  ;состояние сигнала BSY
+        test    al, 0x80  ;состояние сигнала BSY
         jnz     @@WaitDevice1_1
-        test    AL, 1    ;состояние сигнала ERR
+        test    al, 1    ;состояние сигнала ERR
         jnz     @@Err6_1
-        test    AL, 40h  ;состояние сигнала DRDY
+        test    al, 0x40  ;состояние сигнала DRDY
         jz      @@WaitDevice1_1
+;--------------------------------------
 @@clear_DEC:
         and     [DevErrorCode], 0
         popad
         ret
+;--------------------------------------
 ; Записать код ошибки
 @@Err1_3:
         xor     eax, eax
         inc     eax
         jmp     @@End_9
+;--------------------------------------
 @@Err6_1:
         mov     eax, 6
+;--------------------------------------
 @@End_9:
         mov     [DevErrorCode], eax
         popad
         ret
+;-----------------------------------------------------------------------------
 ;****************************************************
 ;*          ПОСЛАТЬ КОМАНДУ ЗАДАННОМУ ДИСКУ         *
 ;* Входные параметры передаются через глобальные    *
 ;* переменные:                                      *
 ;* ChannelNumber - номер канала (1 или 2);          *
 ;* в DevErrorCode - ноль.                           *
 ;* При возникновении ошибки в DevErrorCode будет    *
 ;* возвращен код ошибки в eax                       *
 ;****************************************************
 SendCommandToHDD_1:
-;        pushad
-;        mov    [DevErrorCode],0        not need
 ; Проверить значение кода режима
         cmp     [ATAAddressMode], 1
         ja      @@Err2_4
 ; Проверить корректность номера канала
-        mov     BX, [ChannelNumber]
+        mov     bx, [ChannelNumber]
-        cmp     BX, 1
+        cmp     bx, 1
         jb      @@Err3_4
-        cmp     BX, 2
+        cmp     bx, 2
         ja      @@Err3_4
 ; Установить базовый адрес
-        dec     BX
+        dec     bx
-        shl     BX, 1
+        shl     ebx, 2
         movzx   ebx, bx
+        mov     eax, [cdpos]
+        dec     eax
+        shr     eax, 2
+        imul    eax, sizeof.IDE_DATA
+        add     eax, IDE_controller_1
+        add     eax, ebx
-        mov     AX, [ebx+StandardATABases]
+        mov     ax, [eax+IDE_DATA.BAR0_val]
-        mov     [ATABasePortAddr], AX
+        mov     [ATABasePortAddr], ax
 ; Ожидание готовности HDD к приему команды
         ; Выбрать нужный диск
-        mov     DX, [ATABasePortAddr]
+        mov     dx, [ATABasePortAddr]
-        add     DX, 6   ;адрес регистра головок
+        add     dx, 6   ;адрес регистра головок
-        mov     AL, [DiskNumber]
+        mov     al, [DiskNumber]
-        cmp     AL, 1   ;проверить номера диска
+        cmp     al, 1   ;проверить номера диска
         ja      @@Err4_4
-        shl     AL, 4
+        shl     al, 4
-        or      AL, 10100000b
+        or      al, 10100000b
-        out     DX, AL
+        out     dx, al
         ; Ожидать, пока диск не будет готов
-        inc     DX
+        inc     dx
         mov     eax, [timer_ticks]
         mov     [TickCounter_1], eax
         mov     ecx, NoTickWaitTime
+;--------------------------------------
+align 4
 @@WaitHDReady_2:
         cmp     [timer_ticks_enable], 0
         jne     @f
         dec     ecx
-;        test   ecx,ecx
         jz      @@Err1_4
         jmp     .test
+;--------------------------------------
+align 4
 @@:
         call    change_task
         ; Проверить время ожидания
         mov     eax, [timer_ticks]
         sub     eax, [TickCounter_1]
-        cmp     eax, BSYWaitTime;300    ;ожидать 3 сек.
+        cmp     eax, BSYWaitTime ;300    ;ожидать 3 сек.
         ja      @@Err1_4   ;ошибка тайм-аута
-        ; Прочитать регистр состояния
+;--------------------------------------
+align 4
 .test:
-        in      AL, DX
+        in      al, dx ; Прочитать регистр состояния
         ; Проверить состояние сигнала BSY
-        test    AL, 80h
+        test    al, 0x80
         jnz     @@WaitHDReady_2
         ; Проверить состояние сигнала DRQ
-        test    AL, 08h
+        test    al, 0x8
         jnz     @@WaitHDReady_2
 ; Загрузить команду в регистры контроллера
         cli
-        mov     DX, [ATABasePortAddr]
+        mov     dx, [ATABasePortAddr]
-        inc     DX      ;регистр "особенностей"
+        inc     dx      ;регистр "особенностей"
-        mov     AL, [ATAFeatures]
+        mov     al, [ATAFeatures]
-        out     DX, AL
+        out     dx, al
-        inc     DX      ;счетчик секторов
+        inc     dx      ;счетчик секторов
-        mov     AL, [ATASectorCount]
+        mov     al, [ATASectorCount]
-        out     DX, AL
+        out     dx, al
-        inc     DX      ;регистр номера сектора
+        inc     dx      ;регистр номера сектора
-        mov     AL, [ATASectorNumber]
+        mov     al, [ATASectorNumber]
-        out     DX, AL
+        out     dx, al
-        inc     DX      ;номер цилиндра (младший байт)
+        inc     dx      ;номер цилиндра (младший байт)
-        mov     AX, [ATACylinder]
+        mov     ax, [ATACylinder]
-        out     DX, AL
+        out     dx, al
-        inc     DX      ;номер цилиндра (старший байт)
+        inc     dx      ;номер цилиндра (старший байт)
-        mov     AL, AH
+        mov     al, ah
-        out     DX, AL
+        out     dx, al
-        inc     DX      ;номер головки/номер диска
+        inc     dx      ;номер головки/номер диска
-        mov     AL, [DiskNumber]
+        mov     al, [DiskNumber]
-        shl     AL, 4
+        shl     al, 4
-        cmp     [ATAHead], 0Fh;проверить номер головки
+        cmp     [ATAHead], 0xF ;проверить номер головки
         ja      @@Err5_4
-        or      AL, [ATAHead]
+        or      al, [ATAHead]
-        or      AL, 10100000b
+        or      al, 10100000b
-        mov     AH, [ATAAddressMode]
+        mov     ah, [ATAAddressMode]
-        shl     AH, 6
+        shl     ah, 6
-        or      AL, AH
+        or      al, ah
-        out     DX, AL
+        out     dx, al
 ; Послать команду
-        mov     AL, [ATACommand]
+        mov     al, [ATACommand]
-        inc     DX      ;регистр команд
+        inc     dx      ;регистр команд
-        out     DX, AL
+        out     dx, al
         sti
-; Сбросить признак ошибки
-;        mov     [DevErrorCode],0
+;--------------------------------------
 @@End_10:
         xor     eax, eax
         ret
+;--------------------------------------
 ; Записать код ошибки
 @@Err1_4:
         xor     eax, eax
         inc     eax
-;        mov     [DevErrorCode],1
         ret
+;--------------------------------------
 @@Err2_4:
         mov     eax, 2
-;        mov     [DevErrorCode],2
         ret
+;--------------------------------------
 @@Err3_4:
         mov     eax, 3
-;        mov     [DevErrorCode],3
         ret
+;--------------------------------------
 @@Err4_4:
         mov     eax, 4
-;        mov     [DevErrorCode],4
         ret
+;--------------------------------------
 @@Err5_4:
         mov     eax, 5
-;        mov     [DevErrorCode],5
-; Завершение работы программы
         ret
-;        sti
-;        popad
+;-----------------------------------------------------------------------------
 ;*************************************************
 ;*    ОЖИДАНИЕ ГОТОВНОСТИ УСТРОЙСТВА К РАБОТЕ    *
 ;* Входные параметры передаются через глобальные *
 ;* перменные:                                    *
 ;* ChannelNumber - номер канала;                 *
 ;* DiskNumber - номер диска на канале.           *
 ;*************************************************
 WaitUnitReady:
         pusha
 ; Запомнить время начала операции
-        mov     EAX, [timer_ticks]
+        mov     eax, [timer_ticks]
-        mov     [WURStartTime], EAX
+        mov     [WURStartTime], eax
 ; Очистить буфер пакетной команды
         call    clear_packet_buffer
 ; Сформировать команду TEST UNIT READY
-        mov     [PacketCommand], word 00h
+        mov     [PacketCommand], word 0
 ; ЦИКЛ ОЖИДАНИЯ ГОТОВНОСТИ УСТРОЙСТВА
         mov     ecx, NoTickWaitTime
+;--------------------------------------
+align 4
 @@SendCommand:
         ; Подать команду проверки готовности
         call    SendPacketNoDatCommand
         cmp     [timer_ticks_enable], 0
         jne     @f
         cmp     [DevErrorCode], 0
         je      @@End_11
         dec     ecx
-;        cmp     ecx,0
         jz      .Error
         jmp     @@SendCommand
+;--------------------------------------
+align 4
 @@:
         call    change_task
         ; Проверить код ошибки
         cmp     [DevErrorCode], 0
         je      @@End_11
         ; Проверить время ожидания готовности
-        mov     EAX, [timer_ticks]
+        mov     eax, [timer_ticks]
-        sub     EAX, [WURStartTime]
+        sub     eax, [WURStartTime]
-        cmp     EAX, MaxCDWaitTime
+        cmp     eax, MaxCDWaitTime
         jb      @@SendCommand
+;--------------------------------------
 .Error:
         ; Ошибка тайм-аута
         mov     [DevErrorCode], 1
+;--------------------------------------
 @@End_11:
         popa
         ret
+;-----------------------------------------------------------------------------
 ;*************************************************
 ;*            ЗАПРЕТИТЬ СМЕНУ ДИСКА              *
 ;* Входные параметры передаются через глобальные *
 ;* перменные:                                    *
 ;* ChannelNumber - номер канала;                 *
         add     eax, [cdpos]
         dec     eax
         mov     [eax], byte 1
         popa
         ret
+;-----------------------------------------------------------------------------
 ;*************************************************
 ;*            РАЗРЕШИТЬ СМЕНУ ДИСКА              *
 ;* Входные параметры передаются через глобальные *
 ;* перменные:                                    *
 ;* ChannelNumber - номер канала;                 *
 ; Очистить буфер пакетной команды
         call    clear_packet_buffer
 ; Задать код команды
         mov     [PacketCommand], byte 0x1E
 ; Задать код запрета
-        mov     [PacketCommand+4], byte 00b
+        mov     [PacketCommand+4], byte 0
 ; Подать команду
         call    SendPacketNoDatCommand
         mov     eax, ATAPI_IDE0_lock
         add     eax, [cdpos]
         dec     eax
         mov     [eax], byte 0
         popa
         ret
+;-----------------------------------------------------------------------------
 ;*************************************************
 ;*         ЗАГРУЗИТЬ НОСИТЕЛЬ В ДИСКОВОД         *
 ;* Входные параметры передаются через глобальные *
 ;* перменные:                                    *
 ;* ChannelNumber - номер канала;                 *
         pusha
 ; Очистить буфер пакетной команды
         call    clear_packet_buffer
 ; Сформировать команду START/STOP UNIT
         ; Задать код команды
-        mov     [PacketCommand], word 1Bh
+        mov     [PacketCommand], word 0x1B
         ; Задать операцию загрузки носителя
         mov     [PacketCommand+4], word 00000011b
 ; Подать команду
         call    SendPacketNoDatCommand
         popa
         ret
+;-----------------------------------------------------------------------------
 ;*************************************************
 ;*         ИЗВЛЕЧЬ НОСИТЕЛЬ ИЗ ДИСКОВОДА         *
 ;* Входные параметры передаются через глобальные *
 ;* перменные:                                    *
 ;* ChannelNumber - номер канала;                 *
         pusha
 ; Очистить буфер пакетной команды
         call    clear_packet_buffer
 ; Сформировать команду START/STOP UNIT
         ; Задать код команды
-        mov     [PacketCommand], word 1Bh
+        mov     [PacketCommand], word 0x1B
         ; Задать операцию извлечения носителя
         mov     [PacketCommand+4], word 00000010b
 ; Подать команду
         call    SendPacketNoDatCommand
         popa
         ret
+;-----------------------------------------------------------------------------
 ;*************************************************
 ;* Проверить событие нажатия кнопки извлечения   *
 ;*                     диска                     *
 ;* Входные параметры передаются через глобальные *
 ;* переменные:                                   *
 proc check_ATAPI_device_event_has_work?
         mov     eax, [timer_ticks]
         sub     eax, [timer_ATAPI_check]
         cmp     eax, 100
         jb      .no
-.yes:
         xor     eax, eax
         inc     eax
         ret
+;--------------------------------------
 .no:
         xor     eax, eax
         ret
 endp
+;-----------------------------------------------------------------------------
 align 4
 check_ATAPI_device_event:
         pusha
         mov     eax, [timer_ticks]
         sub     eax, [timer_ATAPI_check]
         cmp     eax, 100
         jb      .end_1
+        pushfd
         mov     al, [DRIVE_DATA+1]
         and     al, 11b
         cmp     al, 10b
         jz      .ide3
+;--------------------------------------
 .ide2_1:
         mov     al, [DRIVE_DATA+1]
         and     al, 1100b
         cmp     al, 1000b
         jz      .ide2
+;--------------------------------------
 .ide1_1:
         mov     al, [DRIVE_DATA+1]
         and     al, 110000b
         cmp     al, 100000b
         jz      .ide1
+;--------------------------------------
 .ide0_1:
         mov     al, [DRIVE_DATA+1]
         and     al, 11000000b
         cmp     al, 10000000b
         jz      .ide0
+;--------------------------------------
+.ide7_1:
+        mov     al, [DRIVE_DATA+6]
+        and     al, 11b
+        cmp     al, 10b
+        jz      .ide7
+;--------------------------------------
+.ide6_1:
+        mov     al, [DRIVE_DATA+6]
+        and     al, 1100b
+        cmp     al, 1000b
+        jz      .ide6
+;--------------------------------------
+.ide5_1:
+        mov     al, [DRIVE_DATA+6]
+        and     al, 110000b
+        cmp     al, 100000b
+        jz      .ide5
+;--------------------------------------
+.ide4_1:
+        mov     al, [DRIVE_DATA+6]
+        and     al, 11000000b
+        cmp     al, 10000000b
+        jz      .ide4
+;--------------------------------------
+.ide11_1:
+        mov     al, [DRIVE_DATA+11]
+        and     al, 11b
+        cmp     al, 10b
+        jz      .ide11
+;--------------------------------------
+.ide10_1:
+        mov     al, [DRIVE_DATA+11]
+        and     al, 1100b
+        cmp     al, 1000b
+        jz      .ide10
+;--------------------------------------
+.ide9_1:
+        mov     al, [DRIVE_DATA+11]
+        and     al, 110000b
+        cmp     al, 100000b
+        jz      .ide9
+;--------------------------------------
+.ide8_1:
+        mov     al, [DRIVE_DATA+11]
+        and     al, 11000000b
+        cmp     al, 10000000b
+        jz      .ide8
+;--------------------------------------
 .end:
-        sti
+        popfd
         mov     eax, [timer_ticks]
         mov     [timer_ATAPI_check], eax
+;--------------------------------------
 .end_1:
         popa
         ret
+;-----------------------------------------------------------------------------
 .ide3:
         cli
         cmp     [ATAPI_IDE3_lock], 1
         jne     .ide2_1
-        cmp     [IDE_Channel_2], 0
-        jne     .ide1_1
         cmp     [cd_status], 0
         jne     .end
-        mov     [IDE_Channel_2], 1
         mov     ecx, ide_channel2_mutex
         call    mutex_lock
         call    reserve_ok2
         mov     [ChannelNumber], 2
         mov     [DiskNumber], 1
         mov     [cdpos], 4
         call    GetEvent_StatusNotification
         cmp     [CDDataBuf+4], byte 1
-        je      .eject_ide3
-        call    syscall_cdaudio.free
-        jmp     .ide2_1
+        jne     @f
-.eject_ide3:
         call    .eject
+;--------------------------------------
+@@:
         call    syscall_cdaudio.free
         jmp     .ide2_1
+;-----------------------------------------------------------------------------
 .ide2:
         cli
         cmp     [ATAPI_IDE2_lock], 1
         jne     .ide1_1
-        cmp     [IDE_Channel_2], 0
-        jne     .ide1_1
         cmp     [cd_status], 0
         jne     .end
-        mov     [IDE_Channel_2], 1
         mov     ecx, ide_channel2_mutex
         call    mutex_lock
         call    reserve_ok2
         mov     [ChannelNumber], 2
         mov     [DiskNumber], 0
         mov     [cdpos], 3
         call    GetEvent_StatusNotification
         cmp     [CDDataBuf+4], byte 1
-        je      .eject_ide2
-        call    syscall_cdaudio.free
-        jmp     .ide1_1
+        jne     @f
-.eject_ide2:
         call    .eject
+;--------------------------------------
+@@:
         call    syscall_cdaudio.free
         jmp     .ide1_1
+;-----------------------------------------------------------------------------
 .ide1:
         cli
         cmp     [ATAPI_IDE1_lock], 1
         jne     .ide0_1
-        cmp     [IDE_Channel_1], 0
-        jne     .end
         cmp     [cd_status], 0
         jne     .end
-        mov     [IDE_Channel_1], 1
         mov     ecx, ide_channel1_mutex
         call    mutex_lock
         call    reserve_ok2
         mov     [ChannelNumber], 1
         mov     [DiskNumber], 1
         mov     [cdpos], 2
         call    GetEvent_StatusNotification
         cmp     [CDDataBuf+4], byte 1
-        je      .eject_ide1
-        call    syscall_cdaudio.free
-        jmp     .ide0_1
+        jne     @f
-.eject_ide1:
         call    .eject
+;--------------------------------------
+@@:
         call    syscall_cdaudio.free
         jmp     .ide0_1
+;-----------------------------------------------------------------------------
 .ide0:
         cli
         cmp     [ATAPI_IDE0_lock], 1
-        jne     .end
-        cmp     [IDE_Channel_1], 0
-        jne     .end
+        jne     .ide7_1
         cmp     [cd_status], 0
         jne     .end
-        mov     [IDE_Channel_1], 1
         mov     ecx, ide_channel1_mutex
         call    mutex_lock
         call    reserve_ok2
         mov     [ChannelNumber], 1
         mov     [DiskNumber], 0
         mov     [cdpos], 1
         call    GetEvent_StatusNotification
         cmp     [CDDataBuf+4], byte 1
+        jne     @f
-        je      .eject_ide0
+        call    .eject
+;--------------------------------------
+@@:
+        call    syscall_cdaudio.free
+        jmp     .ide7_1
+;-----------------------------------------------------------------------------
+.ide7:
+        cli
+        cmp     [ATAPI_IDE7_lock], 1
+        jne     .ide6_1
+        cmp     [cd_status], 0
+        jne     .end
+        mov     ecx, ide_channel4_mutex
+        call    mutex_lock
+        call    reserve_ok2
+        mov     [ChannelNumber], 2
+        mov     [DiskNumber], 1
+        mov     [cdpos], 8
+        call    GetEvent_StatusNotification
+        cmp     [CDDataBuf+4], byte 1
+        jne     @f
+        call    .eject
+;--------------------------------------
+@@:
         call    syscall_cdaudio.free
-        jmp     .end
+        jmp     .ide6_1
+;-----------------------------------------------------------------------------
-.eject_ide0:
+.ide6:
+        cli
+        cmp     [ATAPI_IDE6_lock], 1
+        jne     .ide5_1
+        cmp     [cd_status], 0
+        jne     .end
+        mov     ecx, ide_channel4_mutex
+        call    mutex_lock
+        call    reserve_ok2
+        mov     [ChannelNumber], 2
+        mov     [DiskNumber], 0
+        mov     [cdpos], 7
+        call    GetEvent_StatusNotification
+        cmp     [CDDataBuf+4], byte 1
+        jne     @f
         call    .eject
+;--------------------------------------
+@@:
         call    syscall_cdaudio.free
+        jmp     .ide5_1
+;-----------------------------------------------------------------------------
+.ide5:
+        cli
+        cmp     [ATAPI_IDE5_lock], 1
+        jne     .ide4_1
+        cmp     [cd_status], 0
-        jmp     .end
+        jne     .end
+        mov     ecx, ide_channel3_mutex
+        call    mutex_lock
+        call    reserve_ok2
+        mov     [ChannelNumber], 1
+        mov     [DiskNumber], 1
+        mov     [cdpos], 6
+        call    GetEvent_StatusNotification
+        cmp     [CDDataBuf+4], byte 1
+        jne     @f
+        call    .eject
+;--------------------------------------
+@@:
+        call    syscall_cdaudio.free
+        jmp     .ide4_1
+;-----------------------------------------------------------------------------
+.ide4:
+        cli
+        cmp     [ATAPI_IDE4_lock], 1
+        jne     .ide11_1
+        cmp     [cd_status], 0
+        jne     .end
+        mov     ecx, ide_channel3_mutex
+        call    mutex_lock
+        call    reserve_ok2
+        mov     [ChannelNumber], 1
+        mov     [DiskNumber], 0
+        mov     [cdpos], 5
+        call    GetEvent_StatusNotification
+        cmp     [CDDataBuf+4], byte 1
+        jne     @f
+        call    .eject
+;--------------------------------------
+@@:
+        call    syscall_cdaudio.free
+        jmp     .ide11_1
+;-----------------------------------------------------------------------------
+.ide11:
+        cli
+        cmp     [ATAPI_IDE11_lock], 1
+        jne     .ide10_1
+        cmp     [cd_status], 0
+        jne     .end
+        mov     ecx, ide_channel6_mutex
+        call    mutex_lock
+        call    reserve_ok2
+        mov     [ChannelNumber], 2
+        mov     [DiskNumber], 1
+        mov     [cdpos], 12
+        call    GetEvent_StatusNotification
+        cmp     [CDDataBuf+4], byte 1
+        jne     @f
+        call    .eject
+;--------------------------------------
+@@:
+        call    syscall_cdaudio.free
+        jmp     .ide10_1
+;-----------------------------------------------------------------------------
+.ide10:
+        cli
+        cmp     [ATAPI_IDE10_lock], 1
+        jne     .ide9_1
+        cmp     [cd_status], 0
+        jne     .end
+        mov     ecx, ide_channel6_mutex
+        call    mutex_lock
+        call    reserve_ok2
+        mov     [ChannelNumber], 2
+        mov     [DiskNumber], 0
+        mov     [cdpos], 11
+        call    GetEvent_StatusNotification
+        cmp     [CDDataBuf+4], byte 1
+        jne     @f
+        call    .eject
+;--------------------------------------
+@@:
+        call    syscall_cdaudio.free
+        jmp     .ide9_1
+;-----------------------------------------------------------------------------
+.ide9:
+        cli
+        cmp     [ATAPI_IDE9_lock], 1
+        jne     .ide8_1
+        cmp     [cd_status], 0
+        jne     .end
+        mov     ecx, ide_channel5_mutex
+        call    mutex_lock
+        call    reserve_ok2
+        mov     [ChannelNumber], 1
+        mov     [DiskNumber], 1
+        mov     [cdpos], 10
+        call    GetEvent_StatusNotification
+        cmp     [CDDataBuf+4], byte 1
+        jne     @f
+        call    .eject
+;--------------------------------------
+@@:
+        call    syscall_cdaudio.free
+        jmp     .ide8_1
+;-----------------------------------------------------------------------------
+.ide8:
+        cli
+        cmp     [ATAPI_IDE8_lock], 1
+        jne     .end
+        cmp     [cd_status], 0
+        jne     .end
+        mov     ecx, ide_channel5_mutex
+        call    mutex_lock
+        call    reserve_ok2
+        mov     [ChannelNumber], 1
+        mov     [DiskNumber], 0
+        mov     [cdpos], 9
+        call    GetEvent_StatusNotification
+        cmp     [CDDataBuf+4], byte 1
+        jne     @f
+        call    .eject
+;--------------------------------------
+@@:
+        call    syscall_cdaudio.free
+        jmp     .end
 ;-----------------------------------------------------------------------------
 .eject:
         call    clear_CD_cache
         call    allow_medium_removal
         mov     [ignore_CD_eject_wait], 1
         call    EjectMedium
         mov     [ignore_CD_eject_wait], 0
+        ret
-        ret
+;-----------------------------------------------------------------------------
 iglobal
 timer_ATAPI_check dd 0
 ATAPI_IDE0_lock db 0
 ATAPI_IDE1_lock db 0
 ATAPI_IDE2_lock db 0
+ATAPI_IDE3_lock db 0
+ATAPI_IDE4_lock db 0
+ATAPI_IDE5_lock db 0
+ATAPI_IDE6_lock db 0
+ATAPI_IDE7_lock db 0
+ATAPI_IDE8_lock db 0
+ATAPI_IDE9_lock db 0
+ATAPI_IDE10_lock db 0
-ATAPI_IDE3_lock db 0
+ATAPI_IDE11_lock db 0
 ignore_CD_eject_wait db 0
+endg
-endg
+;-----------------------------------------------------------------------------
 ;*************************************************
 ;* Получить сообщение о событии или состоянии    *
 ;*                  устройства                   *
 ;* Входные параметры передаются через глобальные *
         mov     [PacketCommand+8], byte 0h
 ; Подать команду
         call    SendPacketDatCommand
         popa
         ret
+;-----------------------------------------------------------------------------
 ;*************************************************
 ; прочитать информацию из TOC
 ;* Входные параметры передаются через глобальные *
 ;* переменные:                                   *
 ;* ChannelNumber - номер канала;                 *
         mov     [PacketCommand+8], byte 0h
 ; Подать команду
         call    SendPacketDatCommand
         popa
         ret
+;-----------------------------------------------------------------------------
 ;*************************************************
 ;* ОПРЕДЕЛИТЬ ОБЩЕЕ КОЛИЧЕСТВО СЕКТОРОВ НА ДИСКЕ *
 ;* Входные параметры передаются через глобальные *
 ;* переменные:                                   *
 ;* ChannelNumber - номер канала;                 *
 ;       mov     [PacketCommand],word 25h
 ;; Подать команду
 ;       call    SendPacketDatCommand
 ;       popa
 ;       ret
+;-----------------------------------------------------------------------------
 clear_packet_buffer:
 ; Очистить буфер пакетной команды
         and     [PacketCommand], dword 0
         and     [PacketCommand+4], dword 0
         and     [PacketCommand+8], dword 0
         ret
+;-----------------------------------------------------------------------------

Subversion Repositories Kolibri OS

(root)/kernel/branches/Kolibri-acpi/blkdev/cd_drv.inc – Rev 3908 → 5201