WebSVN – Kolibri OS – Diff – /kernel/branches/Kolibri-acpi/detect/dev_hdcd.inc

 ;; Copyright (C) KolibriOS team 2004-2011. All rights reserved. ;;
 ;; Distributed under terms of the GNU General Public License    ;;
 ;;                                                              ;;
 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
-$Revision: 3908 $
+$Revision: 5201 $
 ;******************************************************
 ;****************************************************
 ;*                 ПОИСК HDD и CD                   *
 ;****************************************************
-        cmp     [IDEContrProgrammingInterface], 0
+        cmp     [ecx+IDE_DATA.ProgrammingInterface], 0
         je      EndFindHDD
+FindHDD:
+        push    ecx
+        xor     ebx, ebx
+        inc     ebx
+        cmp     ecx, IDE_controller_2
+        jne     @f
+        add     bl, 5
+        jmp     .find
+@@:
+        cmp     ecx, IDE_controller_3
+        jne     .find
+        add     bl, 10
+;--------------------------------------
 .find:
 FindHDD:
         mov     [ChannelNumber], 1
-        mov     [DiskNumber], 0
-        call    FindHDD_3
-;        mov     ax,[Sector512+176]
-;        mov     [DRIVE_DATA+6],ax
-;        mov     ax,[Sector512+126]
-;        mov     [DRIVE_DATA+8],ax
+        mov     [DiskNumber], 0
-;        mov     ax,[Sector512+128]
+        call    FindHDD_2
-;        mov     [DRIVE_DATA+8],ax
-        mov     [DiskNumber], 1
-        call    FindHDD_3
+        mov     [DiskNumber], 1
-;        mov     al,[Sector512+176]
+        call    FindHDD_2
-;        mov     [DRIVE_DATA+7],al
+        inc     [ChannelNumber]
-        inc     [ChannelNumber]
-        mov     [DiskNumber], 0
-        call    FindHDD_3
+        mov     [DiskNumber], 0
-;        mov     al,[Sector512+176]
+        call    FindHDD_2
 ;        mov     [DRIVE_DATA+8],al
-        mov     [DiskNumber], 1
-        call    FindHDD_1
+        mov     [DiskNumber], 1
-;        mov     al,[Sector512+176]
+        call    FindHDD_1
-;        mov     [DRIVE_DATA+9],al
+        pop     ecx
+        jmp     EndFindHDD
+;-----------------------------------------------------------------------------
+FindHDD_2:
+        call    FindHDD_1
         shl     byte [ebx+DRIVE_DATA], 2
-        jmp     EndFindHDD
+        ret
 ;-----------------------------------------------------------------------------
+FindHDD_1:
-FindHDD_1:
+        DEBUGF  1, "K : Channel %d ",[ChannelNumber]:2
+        DEBUGF  1, "Disk %d\n",[DiskNumber]:1
+        push    ebx ecx
+        call    ReadHDD_ID
-        DEBUGF  1, "K : Channel %d ",[ChannelNumber]:2
+        pop     ecx ebx
-        DEBUGF  1, "Disk %d\n",[DiskNumber]:1
+        cmp     [DevErrorCode], 7
+        je      .end
-        call    ReadHDD_ID
+        cmp     [DevErrorCode], 0
-        cmp     [DevErrorCode], 0
+        jne     .FindCD
-        jne     FindHDD_2
+        cmp     [Sector512+6], word 16
-        cmp     [Sector512+6], word 16
+        ja      .FindCD
-        ja      FindHDD_2
+        cmp     [Sector512+12], word 255
-        cmp     [Sector512+12], word 255
+        ja      .FindCD
-        ja      FindHDD_2
+        inc     byte [ebx+DRIVE_DATA]
+        jmp     .Print_Device_Name
-        inc     byte [DRIVE_DATA+1]
+;--------------------------------------
+.FindCD:
-        jmp     Print_Device_Name
+        push    ebx ecx
-   FindHDD_2:
+        call    DeviceReset
+        pop     ecx ebx
+        cmp     [DevErrorCode], 0
-        call    DeviceReset
+        jne     .end
-        cmp     [DevErrorCode], 0
+        push    ebx ecx
-        jne     FindHDD_2_2
+        call    ReadCD_ID
+        pop     ecx ebx
-        call    ReadCD_ID
+        cmp     [DevErrorCode], 0
-        cmp     [DevErrorCode], 0
+        jne     .end
-        jne     FindHDD_2_2
-        inc     byte [DRIVE_DATA+1]
+        add     [ebx+DRIVE_DATA], byte 2
-        inc     byte [DRIVE_DATA+1]
+;--------------------------------------
+.Print_Device_Name:
+        pushad
+        pushfd
+        xor     ebx, ebx
+        mov     bx, [ChannelNumber]
+        dec     ebx
+        shl     ebx, 1
+        add     bl, [DiskNumber]
+        shl     ebx, 1
-Print_Device_Name:
+        call    calculate_IDE_device_values_storage
-        pushad
+;--------------------------------------
-        pushfd
+.copy_dev_name:
         mov     esi, Sector512+27*2
+        mov     edi, dev_name
-        mov     edi, dev_name
+        mov     ecx, 20
-        mov     ecx, 20
+        cld
-        cld
+;--------------------------------------
 @@:
         lodsw
-        xchg    ah, al
-        stosw
+        xchg    ah, al
-        loop    @b
+        stosw
-        popfd
+        loop    @b
         popad
+        DEBUGF 1, "K : Dev: %s \n", dev_name
+        xor     eax, eax
+        mov     ax, [Sector512+64*2]
+        DEBUGF  1, "K : PIO possible modes %x\n", al
-        DEBUGF 1, "K : Dev: %s \n", dev_name
+        mov     ax, [Sector512+51*2]
         mov     al, ah
+        call    convert_Sector512_value
+        DEBUGF  1, "K : PIO set mode %x\n", ah
+        mov     ax, [Sector512+63*2]
-        xor     eax, eax
+        DEBUGF  1, "K : Multiword DMA possible modes %x\n", al
-        mov     ax, [Sector512+64*2]
+        mov     al, ah
-        DEBUGF  1, "K : PIO mode %x\n", eax
+        call    convert_Sector512_value
-        mov     ax, [Sector512+63*2]
-        DEBUGF  1, "K : Multiword DMA mode %x\n", eax
+        DEBUGF  1, "K : Multiword DMA set mode %x\n", ah
         mov     ax, [Sector512+88*2]
-        DEBUGF  1, "K : Ultra DMA mode %x\n", eax
+        DEBUGF  1, "K : Ultra DMA possible modes %x\n", al
+        mov     [ebx+IDE_DEVICE.UDMA_possible_modes], al
-   FindHDD_2_2:
+        mov     al, ah
+        call    convert_Sector512_value
+        DEBUGF  1, "K : Ultra DMA set mode %x\n", ah
         ret
+        mov     [ebx+IDE_DEVICE.UDMA_set_mode], ah
+        popfd
+        popad
+        ret
+;--------------------------------------
+.end:
+        DEBUGF  1, "K : Device not found\n"
+        ret
+;-----------------------------------------------------------------------------
+calculate_IDE_device_values_storage:
+        cmp     ecx, IDE_controller_1
+        jne     @f
+        add     ebx, IDE_device_1
+        jmp     .exit
+;--------------------------------------
+@@:
+        cmp     ecx, IDE_controller_2
+        jne     @f
+        add     ebx, IDE_device_2
+        jmp     .exit
+;--------------------------------------
+@@:
+        add     ebx, IDE_device_3
+;--------------------------------------
+.exit:
+        ret
+;-----------------------------------------------------------------------------
+convert_Sector512_value:
+        mov     ecx, 8
+        xor     ah, ah
+;--------------------------------------
+@@:
+        test    al, 1b
+        jnz     .end
+        shr     al, 1
+        inc     ah
+        loop    @b
-FindHDD_3:
+        xor     ah, ah
-        call    FindHDD_1
+;--------------------------------------
-        shl     byte [DRIVE_DATA+1], 2
+.end:
         ret
 ;-----------------------------------------------------------------------------
+; Адрес считываемого сектора в режиме LBA
-; Адрес считываемого сектора в режиме LBA
+uglobal
-uglobal
+SectorAddress   dd ?
-SectorAddress   DD ?
+dev_name:
-dev_name:
+        rb 41
-        rb 41
+endg
 ; Задать режим CHS
         mov     [ATAAddressMode], 0
 ; Послать команду идентификации устройства
         mov     [ATAFeatures], 0
         mov     [ATAHead], 0
-        mov     [ATACommand], 0ECh
+        mov     [ATACommand], 0xEC
         call    SendCommandToHDD
-        cmp     [DevErrorCode], 0;проверить код ошибки
+        cmp     [DevErrorCode], 0 ;проверить код ошибки
         jne     @@End  ;закончить, сохранив код ошибки
-        mov     DX, [ATABasePortAddr]
+        mov     dx, [ATABasePortAddr]
-        add     DX, 7    ;адрес регистра состояни
+        add     dx, 7    ;адрес регистра состояни
         mov     ecx, 0xffff
 @@WaitCompleet:
         ; Проверить время выполнения команды
         dec     ecx
-;        cmp  ecx,0
         jz      @@Error1  ;ошибка тайм-аута
         ; Проверить готовность
-        in      AL, DX
+        in      al, dx
-        test    AL, 80h  ;состояние сигнала BSY
+        test    al, 80h  ;состояние сигнала BSY
         jnz     @@WaitCompleet
-        test    AL, 1    ;состояние сигнала ERR
+        test    al, 1    ;состояние сигнала ERR
         jnz     @@Error6
-        test    AL, 08h  ;состояние сигнала DRQ
+        test    al, 08h  ;состояние сигнала DRQ
         jz      @@WaitCompleet
 ; Принять блок данных от контроллера
-;        mov     AX,DS
+        mov     edi, Sector512
-;        mov     ES,AX
-        mov     EDI, Sector512 ;offset Sector512
-        mov     DX, [ATABasePortAddr];регистр данных
+        mov     dx, [ATABasePortAddr];регистр данных
-        mov     CX, 256  ;число считываемых слов
+        mov     cx, 256  ;число считываемых слов
         rep insw         ;принять блок данных
         ret
 ; Записать код ошибки
 @@Error1:
         mov     [DevErrorCode], 1
         ret
 @@Error6:
         mov     [DevErrorCode], 6
 @@End:
         ret
-iglobal
-; Стандартные базовые адреса каналов 1 и 2
+;-----------------------------------------------------------------------------
-StandardATABases DW 1F0h, 170h
-endg
 uglobal
+; Стандартные базовые адреса каналов 1 и 2
+StandardATABases dw ?, ? ; 1F0h, 170h
 ; Номер канала
-ChannelNumber   DW ?
+ChannelNumber   dw ?
 ; Номер диска
-DiskNumber      DB ?
+DiskNumber      db ?
 ; Базовый адрес группы портов контроллера ATA
-ATABasePortAddr DW ?
+ATABasePortAddr dw ?
 ; Параметры ATA-команды
-ATAFeatures     DB ? ;особенности
+ATAFeatures     db ? ;особенности
-ATASectorCount  DB ? ;количество обрабатываемых секторов
+ATASectorCount  db ? ;количество обрабатываемых секторов
-ATASectorNumber DB ? ;номер начального сектора
+ATASectorNumber db ? ;номер начального сектора
-ATACylinder     DW ? ;номер начального цилиндра
+ATACylinder     dw ? ;номер начального цилиндра
-ATAHead         DB ? ;номер начальной головки
+ATAHead         db ? ;номер начальной головки
-ATAAddressMode  DB ? ;режим адресации (0 - CHS, 1 - LBA)
+ATAAddressMode  db ? ;режим адресации (0 - CHS, 1 - LBA)
-ATACommand      DB ? ;код команды, подлежащей выполнению
+ATACommand      db ? ;код команды, подлежащей выполнению
 ; Код ошибки (0 - нет ошибок, 1 - превышен допустимый
 ; интервал ожидания, 2 - неверный код режима адресации,
 ; 3 - неверный номер канала, 4 - неверный номер диска,
 ; 5 - неверный номер головки, 6 - ошибка при выполнении
-; команды)
+; команды, 7 - таймаут при выборе канала)
 DevErrorCode dd ?
 endg
+;-----------------------------------------------------------------------------
 ;****************************************************
 ;*          ПОСЛАТЬ КОМАНДУ ЗАДАННОМУ ДИСКУ         *
 ;* Входные параметры передаются через глобальные    *
 ;* переменные:                                      *
 ;* ChannelNumber - номер канала (1 или 2);          *
 SendCommandToHDD:
 ; Проверить значение кода режима
         cmp     [ATAAddressMode], 1
         ja      @@Err2
 ; Проверить корректность номера канала
-        mov     BX, [ChannelNumber]
+        mov     bx, [ChannelNumber]
-        cmp     BX, 1
+        cmp     bx, 1
         jb      @@Err3
-        cmp     BX, 2
+        cmp     bx, 2
         ja      @@Err3
 ; Установить базовый адрес
-        dec     BX
+        dec     bx
-        shl     BX, 1
+        shl     bx, 1
         movzx   ebx, bx
-        mov     AX, [ebx+StandardATABases]
+        mov     ax, [ebx+StandardATABases]
-        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
-        shl     AL, 4
+        shl     al, 4
-        or      AL, 10100000b
+        or      al, 10100000b
-        out     DX, AL
+        out     dx, al
         ; Ожидать, пока диск не будет готов
-        inc     DX
+        inc     dx
         mov     ecx, 0xfff
-;        mov     eax,[timer_ticks]
-;        mov     [TickCounter_1],eax
 @@WaitHDReady:
         ; Проверить время ожидани
         dec     ecx
-;        cmp  ecx,0
         jz      @@Err1
-;        mov     eax,[timer_ticks]
-;        sub     eax,[TickCounter_1]
-;        cmp     eax,300    ;ожидать 300 тиков
-;        ja      @@Err1   ;ошибка тайм-аута
         ; Прочитать регистр состояни
-        in      AL, DX
+        in      al, dx
         ; Проверить состояние сигнала BSY
-        test    AL, 80h
+        test    al, 80h
         jnz     @@WaitHDReady
         ; Проверить состояние сигнала DRQ
-        test    AL, 08h
+        test    al, 08h
         jnz     @@WaitHDReady
 ; Загрузить команду в регистры контроллера
         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
-        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
         ret
 ; Записать код ошибки
 @@Err1:
-        mov     [DevErrorCode], 1
+        mov     [DevErrorCode], 7
         ret
 @@Err2:
         mov     [DevErrorCode], 2
         ret
 @@Err3:
         ret
 @@Err5:
         mov     [DevErrorCode], 5
 ; Завершение работы программы
         ret
+;-----------------------------------------------------------------------------
 ;*************************************************
 ;*     ЧТЕНИЕ ИДЕНТИФИКАТОРА УСТРОЙСТВА ATAPI    *
 ;* Входные параметры передаются через глобальные *
 ;* перменные:                                    *
 ;* ChannelNumber - номер канала;                 *
         mov     [ATAFeatures], 0
         mov     [ATASectorCount], 0
         mov     [ATASectorNumber], 0
         mov     [ATACylinder], 0
         mov     [ATAHead], 0
-        mov     [ATACommand], 0A1h
+        mov     [ATACommand], 0xA1
         call    SendCommandToHDD
         cmp     [DevErrorCode], 0;проверить код ошибки
         jne     @@End_1  ;закончить, сохранив код ошибки
 ; Ожидать готовность данных HDD
-        mov     DX, [ATABasePortAddr]
+        mov     dx, [ATABasePortAddr]
-        add     DX, 7  ;порт 1х7h
+        add     dx, 7  ;порт 1х7h
         mov     ecx, 0xffff
 @@WaitCompleet_1:
         ; Проверить врем
         dec     ecx
-;        cmp    ecx,0
         jz      @@Error1_1 ;ошибка тайм-аута
         ; Проверить готовность
-        in      AL, DX
+        in      al, dx
-        test    AL, 80h  ;состояние сигнала BSY
+        test    al, 80h  ;состояние сигнала BSY
         jnz     @@WaitCompleet_1
-        test    AL, 1    ;состояние сигнала ERR
+        test    al, 1    ;состояние сигнала ERR
         jnz     @@Error6_1
-        test    AL, 08h  ;состояние сигнала DRQ
+        test    al, 08h  ;состояние сигнала DRQ
         jz      @@WaitCompleet_1
 ; Принять блок данных от контроллера
-;        mov     AX,DS
-;        mov     ES,AX
-        mov     EDI, Sector512 ;offset Sector512
+        mov     edi, Sector512 ;offset Sector512
-        mov     DX, [ATABasePortAddr];порт 1x0h
+        mov     dx, [ATABasePortAddr];порт 1x0h
-        mov     CX, 256;число считываемых слов
+        mov     cx, 256;число считываемых слов
         rep insw
         ret
 ; Записать код ошибки
 @@Error1_1:
         mov     [DevErrorCode], 1
         ret
 @@Error6_1:
         mov     [DevErrorCode], 6
 @@End_1:
         ret
+;-----------------------------------------------------------------------------
 ;*************************************************
 ;*                СБРОС УСТРОЙСТВА               *
 ;* Входные параметры передаются через глобальные *
 ;* переменные:                                   *
 ;* ChannelNumber - номер канала (1 или 2);       *
 ;* DiskNumber - номер диска (0 или 1).           *
 ;*************************************************
 DeviceReset:
 ; Проверить корректность номера канала
-        mov     BX, [ChannelNumber]
+        mov     bx, [ChannelNumber]
-        cmp     BX, 1
+        cmp     bx, 1
         jb      @@Err3_2
-        cmp     BX, 2
+        cmp     bx, 2
         ja      @@Err3_2
 ; Установить базовый адрес
-        dec     BX
+        dec     bx
-        shl     BX, 1
+        shl     bx, 1
         movzx   ebx, bx
-        mov     DX, [ebx+StandardATABases]
+        mov     dx, [ebx+StandardATABases]
-        mov     [ATABasePortAddr], DX
+        mov     [ATABasePortAddr], dx
 ; Выбрать нужный диск
-        add     DX, 6   ;адрес регистра головок
+        add     dx, 6   ;адрес регистра головок
-        mov     AL, [DiskNumber]
+        mov     al, [DiskNumber]
-        cmp     AL, 1   ;проверить номера диска
+        cmp     al, 1   ;проверить номера диска
         ja      @@Err4_2
-        shl     AL, 4
+        shl     al, 4
-        or      AL, 10100000b
+        or      al, 10100000b
-        out     DX, AL
+        out     dx, al
 ; Послать команду "Сброс"
-        mov     AL, 08h
+        mov     al, 0x8
-        inc     DX      ;регистр команд
+        inc     dx      ;регистр команд
-        out     DX, AL
+        out     dx, al
         mov     ecx, 0x80000
 @@WaitHDReady_1:
         ; Проверить время ожидани
         dec     ecx
-;        cmp     ecx,0
         je      @@Err1_2 ;ошибка тайм-аута
         ; Прочитать регистр состояни
-        in      AL, DX
+        in      al, dx
         ; Проверить состояние сигнала BSY
-        test    AL, 80h
+        test    al, 80h
         jnz     @@WaitHDReady_1
 ; Сбросить признак ошибки
         mov     [DevErrorCode], 0
         ret
 ; Обработка ошибок
         ret
 @@Err4_2:
         mov     [DevErrorCode], 4
 ; Записать код ошибки
         ret
+;-----------------------------------------------------------------------------
 EndFindHDD:

Subversion Repositories Kolibri OS

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