Subversion Repositories Kolibri OS

Rev

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

Rev Author Line No. Line
2288 clevermous 1 
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
2 
;;                                                              ;;
5363 yogev_ezra 3 
;; Copyright (C) KolibriOS team 2004-2015. All rights reserved. ;;
2288 clevermous 4 
;; Distributed under terms of the GNU General Public License    ;;
5 
;;                                                              ;;
6 
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
7 
 
8 
$Revision: 6842 $
9 
 
5852 pathoswith 10 
; HDD and CD search
2288 clevermous 11 
 
4700 mario79 12 
        cmp     [ecx+IDE_DATA.ProgrammingInterface], 0
3785 mario79 13 
        je      EndFindHDD
2288 clevermous 14 
FindHDD:
4700 mario79 15 
        xor     ebx, ebx
16 
        inc     ebx
5852 pathoswith 17 
        mov     [DeviceNumber], 0
18 
        cmp     ecx, IDE_controller_1
19 
        jz      .find
20 
        add     bl, 5
21 
        add     [DeviceNumber], sizeof.HD_DATA*4
4700 mario79 22 
        cmp     ecx, IDE_controller_2
5852 pathoswith 23 
        jz      .find
4700 mario79 24 
        add     bl, 5
5852 pathoswith 25 
        add     [DeviceNumber], sizeof.HD_DATA*4
4700 mario79 26 
.find:
2288 clevermous 27 
        mov     [ChannelNumber], 1
28 
        mov     [DiskNumber], 0
5852 pathoswith 29 
        call    FindHDD_1
30 
        inc     [DiskNumber]
4700 mario79 31 
        call    FindHDD_2
2288 clevermous 32 
        inc     [ChannelNumber]
5852 pathoswith 33 
        dec     [DiskNumber]
34 
        call    FindHDD_2
35 
        inc     [DiskNumber]
4700 mario79 36 
        call    FindHDD_2
2288 clevermous 37 
        jmp     EndFindHDD
4700 mario79 38 
;-----------------------------------------------------------------------------
39 
FindHDD_2:
5852 pathoswith 40 
        add     [DeviceNumber], sizeof.HD_DATA
4700 mario79 41 
        shl     byte [ebx+DRIVE_DATA], 2
2288 clevermous 42 
FindHDD_1:
6464 pathoswith 43 
        DEBUGF  1, "K : Channel %d ",[ChannelNumber]:1
3706 mario79 44 
        DEBUGF  1, "Disk %d\n",[DiskNumber]:1
6842 pathoswith 45 
        push    ecx ebx
2288 clevermous 46 
        call    ReadHDD_ID
5030 clevermous 47 
        cmp     [DevErrorCode], 7
48 
        je      .end
2288 clevermous 49 
        cmp     [DevErrorCode], 0
4700 mario79 50 
        jne     .FindCD
2288 clevermous 51 
        cmp     [Sector512+6], word 16
4700 mario79 52 
        ja      .FindCD
2288 clevermous 53 
        cmp     [Sector512+12], word 255
4700 mario79 54 
        ja      .FindCD
6842 pathoswith 55 
        pop     ebx
5852 pathoswith 56 
        movzx   eax, [DeviceNumber]
6842 pathoswith 57 
        mov     ecx, [Sector512+120]
58 
        mov     dword[eax+hd0_data.sectors], ecx
59 
        and     dword[eax+hd0_data.sectors+4], 0
5852 pathoswith 60 
        bt      word [Sector512+166], 10
6842 pathoswith 61 
        jnc     .Print_Device_Name
62 
        mov     [eax+hd0_data.hd48], 1
63 
        mov     ecx, [Sector512+200]
64 
        mov     dword[eax+hd0_data.sectors], ecx
65 
        mov     ecx, [Sector512+204]
66 
        mov     dword[eax+hd0_data.sectors+4], ecx
4700 mario79 67 
        jmp     .Print_Device_Name
68 
;--------------------------------------
69 
.FindCD:
2288 clevermous 70 
        call    DeviceReset
71 
        cmp     [DevErrorCode], 0
4700 mario79 72 
        jne     .end
2288 clevermous 73 
        call    ReadCD_ID
74 
        cmp     [DevErrorCode], 0
4700 mario79 75 
        jne     .end
6842 pathoswith 76 
        pop     ebx
77 
        inc     byte [ebx+DRIVE_DATA]
4700 mario79 78 
;--------------------------------------
6464 pathoswith 79 
.Print_Device_Name:
6842 pathoswith 80 
        inc     byte [ebx+DRIVE_DATA]
81 
        pop     ecx
3711 clevermous 82 
        pushad
6464 pathoswith 83 
        movzx   ebx, [ChannelNumber]
4772 mario79 84 
        dec     ebx
85 
        shl     ebx, 1
86 
        add     bl, [DiskNumber]
87 
        shl     ebx, 1
88 
        call    calculate_IDE_device_values_storage
89 
;--------------------------------------
90 
.copy_dev_name:
3711 clevermous 91 
        mov     esi, Sector512+27*2
92 
        mov     edi, dev_name
93 
        mov     ecx, 20
94 
        cld
4772 mario79 95 
;--------------------------------------
3702 mario79 96 
@@:
3711 clevermous 97 
        lodsw
98 
        xchg    ah, al
99 
        stosw
100 
        loop    @b
3702 mario79 101 
        DEBUGF 1, "K : Dev: %s \n", dev_name
3881 mario79 102 
        xor     eax, eax
103 
        mov     ax, [Sector512+64*2]
4772 mario79 104 
        DEBUGF  1, "K : PIO possible modes %x\n", al
4624 mario79 105 
        mov     ax, [Sector512+51*2]
106 
        mov     al, ah
107 
        call    convert_Sector512_value
4772 mario79 108 
        DEBUGF  1, "K : PIO set mode %x\n", ah
3881 mario79 109 
        mov     ax, [Sector512+63*2]
4624 mario79 110 
        DEBUGF  1, "K : Multiword DMA possible modes %x\n", al
111 
        mov     al, ah
112 
        call    convert_Sector512_value
113 
        DEBUGF  1, "K : Multiword DMA set mode %x\n", ah
3881 mario79 114 
        mov     ax, [Sector512+88*2]
4624 mario79 115 
        DEBUGF  1, "K : Ultra DMA possible modes %x\n", al
4772 mario79 116 
        mov     [ebx+IDE_DEVICE.UDMA_possible_modes], al
4624 mario79 117 
        mov     al, ah
118 
        call    convert_Sector512_value
119 
        DEBUGF  1, "K : Ultra DMA set mode %x\n", ah
4772 mario79 120 
        mov     [ebx+IDE_DEVICE.UDMA_set_mode], ah
4700 mario79 121 
        popad
2288 clevermous 122 
        ret
6842 pathoswith 123 
 
4700 mario79 124 
.end:
125 
        DEBUGF  1, "K : Device not found\n"
6842 pathoswith 126 
        pop     ebx ecx
2288 clevermous 127 
        ret
4624 mario79 128 
;-----------------------------------------------------------------------------
4772 mario79 129 
calculate_IDE_device_values_storage:
130 
        cmp     ecx, IDE_controller_1
131 
        jne     @f
132 
 
133 
        add     ebx, IDE_device_1
134 
        jmp     .exit
135 
;--------------------------------------
136 
@@:
137 
        cmp     ecx, IDE_controller_2
138 
        jne     @f
139 
 
140 
        add     ebx, IDE_device_2
141 
        jmp     .exit
142 
;--------------------------------------
143 
@@:
144 
        add     ebx, IDE_device_3
145 
;--------------------------------------
146 
.exit:
147 
        ret
148 
;-----------------------------------------------------------------------------
4624 mario79 149 
convert_Sector512_value:
150 
        mov     ecx, 8
151 
        xor     ah, ah
4772 mario79 152 
;--------------------------------------
4624 mario79 153 
@@:
154 
        test    al, 1b
155 
        jnz     .end
2288 clevermous 156 
 
4624 mario79 157 
        shr     al, 1
158 
        inc     ah
159 
        loop    @b
160 
 
161 
        xor     ah, ah
4772 mario79 162 
;--------------------------------------
4624 mario79 163 
.end:
164 
        ret
165 
;-----------------------------------------------------------------------------
3539 clevermous 166 
; Адрес считываемого сектора в режиме LBA
2288 clevermous 167 
uglobal
4700 mario79 168 
SectorAddress   dd ?
3702 mario79 169 
dev_name:
3711 clevermous 170 
        rb 41
2288 clevermous 171 
endg
4700 mario79 172 
;-----------------------------------------------------------------------------
2288 clevermous 173 
;*************************************************
3539 clevermous 174 
;*     ЧТЕНИЕ ИДЕНТИФИКАТОРА ЖЕСТКОГО ДИСКА      *
175 
;* Входные параметры передаются через глобальные *
176 
;* переменные:                                   *
177 
;* ChannelNumber - номер канала (1 или 2);       *
178 
;* DiskNumber - номер диска на канале (0 или 1). *
179 
;* Идентификационный блок данных считывается     *
180 
;* в массив Sector512.                           *
2288 clevermous 181 
;*************************************************
182 
ReadHDD_ID:
3539 clevermous 183 
; Задать режим CHS
2288 clevermous 184 
        mov     [ATAAddressMode], 0
3539 clevermous 185 
; Послать команду идентификации устройства
2288 clevermous 186 
        mov     [ATAFeatures], 0
187 
        mov     [ATAHead], 0
4700 mario79 188 
        mov     [ATACommand], 0xEC
2288 clevermous 189 
        call    SendCommandToHDD
4700 mario79 190 
        cmp     [DevErrorCode], 0 ;проверить код ошибки
3539 clevermous 191 
        jne     @@End  ;закончить, сохранив код ошибки
4700 mario79 192 
 
193 
        mov     dx, [ATABasePortAddr]
194 
        add     dx, 7    ;адрес регистра состояни
2288 clevermous 195 
        mov     ecx, 0xffff
196 
@@WaitCompleet:
3539 clevermous 197 
        ; Проверить время выполнения команды
2288 clevermous 198 
        dec     ecx
3539 clevermous 199 
        jz      @@Error1  ;ошибка тайм-аута
200 
        ; Проверить готовность
4700 mario79 201 
        in      al, dx
202 
        test    al, 80h  ;состояние сигнала BSY
2288 clevermous 203 
        jnz     @@WaitCompleet
4700 mario79 204 
 
205 
        test    al, 1    ;состояние сигнала ERR
2288 clevermous 206 
        jnz     @@Error6
4700 mario79 207 
 
208 
        test    al, 08h  ;состояние сигнала DRQ
2288 clevermous 209 
        jz      @@WaitCompleet
3539 clevermous 210 
; Принять блок данных от контроллера
4700 mario79 211 
        mov     edi, Sector512
212 
        mov     dx, [ATABasePortAddr];регистр данных
213 
        mov     cx, 256  ;число считываемых слов
3539 clevermous 214 
        rep insw         ;принять блок данных
2288 clevermous 215 
        ret
3539 clevermous 216 
; Записать код ошибки
2288 clevermous 217 
@@Error1:
218 
        mov     [DevErrorCode], 1
219 
        ret
220 
@@Error6:
221 
        mov     [DevErrorCode], 6
222 
@@End:
223 
        ret
4700 mario79 224 
;-----------------------------------------------------------------------------
225 
uglobal
3539 clevermous 226 
; Стандартные базовые адреса каналов 1 и 2
4700 mario79 227 
StandardATABases dw ?, ? ; 1F0h, 170h
3539 clevermous 228 
; Номер канала
6464 pathoswith 229 
ChannelNumber   db ?
3539 clevermous 230 
; Номер диска
4700 mario79 231 
DiskNumber      db ?
5852 pathoswith 232 
DeviceNumber    db ?
3539 clevermous 233 
; Базовый адрес группы портов контроллера ATA
4700 mario79 234 
ATABasePortAddr dw ?
3539 clevermous 235 
; Параметры ATA-команды
4700 mario79 236 
ATAFeatures     db ? ;особенности
237 
ATASectorCount  db ? ;количество обрабатываемых секторов
238 
ATASectorNumber db ? ;номер начального сектора
239 
ATACylinder     dw ? ;номер начального цилиндра
240 
ATAHead         db ? ;номер начальной головки
241 
ATAAddressMode  db ? ;режим адресации (0 - CHS, 1 - LBA)
242 
ATACommand      db ? ;код команды, подлежащей выполнению
3539 clevermous 243 
; Код ошибки (0 - нет ошибок, 1 - превышен допустимый
244 
; интервал ожидания, 2 - неверный код режима адресации,
245 
; 3 - неверный номер канала, 4 - неверный номер диска,
246 
; 5 - неверный номер головки, 6 - ошибка при выполнении
5030 clevermous 247 
; команды, 7 - таймаут при выборе канала)
2288 clevermous 248 
DevErrorCode dd ?
249 
endg
4700 mario79 250 
;-----------------------------------------------------------------------------
2288 clevermous 251 
;****************************************************
3539 clevermous 252 
;*          ПОСЛАТЬ КОМАНДУ ЗАДАННОМУ ДИСКУ         *
253 
;* Входные параметры передаются через глобальные    *
254 
;* переменные:                                      *
255 
;* ChannelNumber - номер канала (1 или 2);          *
256 
;* DiskNumber - номер диска (0 или 1);              *
257 
;* ATAFeatures - "особенности";                     *
258 
;* ATASectorCount - количество секторов;            *
259 
;* ATASectorNumber - номер начального сектора;      *
260 
;* ATACylinder - номер начального цилиндра;         *
261 
;* ATAHead - номер начальной головки;               *
262 
;* ATAAddressMode - режим адресации (0-CHS, 1-LBA); *
263 
;* ATACommand - код команды.                        *
264 
;* После успешного выполнения функции:              *
265 
;* в ATABasePortAddr - базовый адрес HDD;           *
266 
;* в DevErrorCode - ноль.                           *
267 
;* При возникновении ошибки в DevErrorCode будет    *
268 
;* возвращен код ошибки.                            *
2288 clevermous 269 
;****************************************************
270 
SendCommandToHDD:
3539 clevermous 271 
; Проверить значение кода режима
2288 clevermous 272 
        cmp     [ATAAddressMode], 1
273 
        ja      @@Err2
3539 clevermous 274 
; Проверить корректность номера канала
6464 pathoswith 275 
        movzx   ebx, [ChannelNumber]
276 
        dec     ebx
277 
        cmp     ebx, 1
2288 clevermous 278 
        ja      @@Err3
3539 clevermous 279 
; Установить базовый адрес
6464 pathoswith 280 
        shl     ebx, 1
4700 mario79 281 
        mov     ax, [ebx+StandardATABases]
282 
        mov     [ATABasePortAddr], ax
3539 clevermous 283 
; Ожидание готовности HDD к приему команды
284 
        ; Выбрать нужный диск
4700 mario79 285 
        mov     dx, [ATABasePortAddr]
286 
        add     dx, 6   ;адрес регистра головок
287 
        mov     al, [DiskNumber]
288 
        cmp     al, 1   ;проверить номера диска
2288 clevermous 289 
        ja      @@Err4
4700 mario79 290 
 
291 
        shl     al, 4
292 
        or      al, 10100000b
293 
        out     dx, al
3539 clevermous 294 
        ; Ожидать, пока диск не будет готов
4700 mario79 295 
        inc     dx
2288 clevermous 296 
        mov     ecx, 0xfff
297 
@@WaitHDReady:
3539 clevermous 298 
        ; Проверить время ожидани
2288 clevermous 299 
        dec     ecx
300 
        jz      @@Err1
3539 clevermous 301 
        ; Прочитать регистр состояни
4700 mario79 302 
        in      al, dx
3539 clevermous 303 
        ; Проверить состояние сигнала BSY
4700 mario79 304 
        test    al, 80h
2288 clevermous 305 
        jnz     @@WaitHDReady
3539 clevermous 306 
        ; Проверить состояние сигнала DRQ
4700 mario79 307 
        test    al, 08h
2288 clevermous 308 
        jnz     @@WaitHDReady
3539 clevermous 309 
; Загрузить команду в регистры контроллера
2288 clevermous 310 
        cli
4700 mario79 311 
        mov     dx, [ATABasePortAddr]
312 
        inc     dx      ;регистр "особенностей"
313 
        mov     al, [ATAFeatures]
314 
        out     dx, AL
315 
        inc     dx      ;счетчик секторов
316 
        mov     al, [ATASectorCount]
317 
        out     dx, AL
318 
        inc     dx      ;регистр номера сектора
319 
        mov     al, [ATASectorNumber]
320 
        out     dx, AL
321 
        inc     dx      ;номер цилиндра (младший байт)
322 
        mov     ax, [ATACylinder]
323 
        out     dx, AL
324 
        inc     dx      ;номер цилиндра (старший байт)
325 
        mov     al, AH
326 
        out     dx, AL
327 
        inc     dx      ;номер головки/номер диска
328 
        mov     al, [DiskNumber]
329 
        shl     al, 4
330 
        cmp     [ATAHead], 0xF ;проверить номер головки
2288 clevermous 331 
        ja      @@Err5
4700 mario79 332 
 
333 
        or      al, [ATAHead]
334 
        or      al, 10100000b
335 
        mov     ah, [ATAAddressMode]
336 
        shl     ah, 6
337 
        or      al, ah
338 
        out     dx, al
3539 clevermous 339 
; Послать команду
4700 mario79 340 
        mov     al, [ATACommand]
341 
        inc     dx      ;регистр команд
342 
        out     dx, al
2288 clevermous 343 
        sti
3539 clevermous 344 
; Сбросить признак ошибки
2288 clevermous 345 
        mov     [DevErrorCode], 0
346 
        ret
3539 clevermous 347 
; Записать код ошибки
2288 clevermous 348 
@@Err1:
5030 clevermous 349 
        mov     [DevErrorCode], 7
2288 clevermous 350 
        ret
351 
@@Err2:
352 
        mov     [DevErrorCode], 2
353 
        ret
354 
@@Err3:
355 
        mov     [DevErrorCode], 3
356 
        ret
357 
@@Err4:
358 
        mov     [DevErrorCode], 4
359 
        ret
360 
@@Err5:
361 
        mov     [DevErrorCode], 5
3539 clevermous 362 
; Завершение работы программы
2288 clevermous 363 
        ret
4700 mario79 364 
;-----------------------------------------------------------------------------
2288 clevermous 365 
;*************************************************
3539 clevermous 366 
;*     ЧТЕНИЕ ИДЕНТИФИКАТОРА УСТРОЙСТВА ATAPI    *
367 
;* Входные параметры передаются через глобальные *
368 
;* перменные:                                    *
369 
;* ChannelNumber - номер канала;                 *
370 
;* DiskNumber - номер диска на канале.           *
371 
;* Идентификационный блок данных считывается     *
372 
;* в массив Sector512.                           *
2288 clevermous 373 
;*************************************************
374 
ReadCD_ID:
3539 clevermous 375 
; Задать режим CHS
2288 clevermous 376 
        mov     [ATAAddressMode], 0
3539 clevermous 377 
; Послать команду идентификации устройства
2288 clevermous 378 
        mov     [ATAFeatures], 0
379 
        mov     [ATASectorCount], 0
380 
        mov     [ATASectorNumber], 0
381 
        mov     [ATACylinder], 0
382 
        mov     [ATAHead], 0
4700 mario79 383 
        mov     [ATACommand], 0xA1
2288 clevermous 384 
        call    SendCommandToHDD
3539 clevermous 385 
        cmp     [DevErrorCode], 0;проверить код ошибки
386 
        jne     @@End_1  ;закончить, сохранив код ошибки
387 
; Ожидать готовность данных HDD
4700 mario79 388 
        mov     dx, [ATABasePortAddr]
389 
        add     dx, 7  ;порт 1х7h
2288 clevermous 390 
        mov     ecx, 0xffff
391 
@@WaitCompleet_1:
3539 clevermous 392 
        ; Проверить врем
2288 clevermous 393 
        dec     ecx
3539 clevermous 394 
        jz      @@Error1_1 ;ошибка тайм-аута
395 
        ; Проверить готовность
4700 mario79 396 
        in      al, dx
397 
        test    al, 80h  ;состояние сигнала BSY
2288 clevermous 398 
        jnz     @@WaitCompleet_1
4700 mario79 399 
 
400 
        test    al, 1    ;состояние сигнала ERR
2288 clevermous 401 
        jnz     @@Error6_1
4700 mario79 402 
 
403 
        test    al, 08h  ;состояние сигнала DRQ
2288 clevermous 404 
        jz      @@WaitCompleet_1
3539 clevermous 405 
; Принять блок данных от контроллера
4700 mario79 406 
        mov     edi, Sector512 ;offset Sector512
407 
        mov     dx, [ATABasePortAddr];порт 1x0h
408 
        mov     cx, 256;число считываемых слов
2288 clevermous 409 
        rep insw
410 
        ret
3539 clevermous 411 
; Записать код ошибки
2288 clevermous 412 
@@Error1_1:
413 
        mov     [DevErrorCode], 1
414 
        ret
415 
@@Error6_1:
416 
        mov     [DevErrorCode], 6
417 
@@End_1:
418 
        ret
4700 mario79 419 
;-----------------------------------------------------------------------------
2288 clevermous 420 
;*************************************************
3539 clevermous 421 
;*                СБРОС УСТРОЙСТВА               *
422 
;* Входные параметры передаются через глобальные *
423 
;* переменные:                                   *
424 
;* ChannelNumber - номер канала (1 или 2);       *
425 
;* DiskNumber - номер диска (0 или 1).           *
2288 clevermous 426 
;*************************************************
427 
DeviceReset:
3539 clevermous 428 
; Проверить корректность номера канала
6464 pathoswith 429 
        movzx   ebx, [ChannelNumber]
430 
        dec     ebx
431 
        cmp     ebx, 1
2288 clevermous 432 
        ja      @@Err3_2
3539 clevermous 433 
; Установить базовый адрес
6464 pathoswith 434 
        shl     ebx, 1
4700 mario79 435 
        mov     dx, [ebx+StandardATABases]
436 
        mov     [ATABasePortAddr], dx
3539 clevermous 437 
; Выбрать нужный диск
4700 mario79 438 
        add     dx, 6   ;адрес регистра головок
439 
        mov     al, [DiskNumber]
440 
        cmp     al, 1   ;проверить номера диска
2288 clevermous 441 
        ja      @@Err4_2
4700 mario79 442 
 
443 
        shl     al, 4
444 
        or      al, 10100000b
445 
        out     dx, al
3539 clevermous 446 
; Послать команду "Сброс"
4700 mario79 447 
        mov     al, 0x8
448 
        inc     dx      ;регистр команд
449 
        out     dx, al
2288 clevermous 450 
        mov     ecx, 0x80000
451 
@@WaitHDReady_1:
3539 clevermous 452 
        ; Проверить время ожидани
2288 clevermous 453 
        dec     ecx
3539 clevermous 454 
        je      @@Err1_2 ;ошибка тайм-аута
455 
        ; Прочитать регистр состояни
4700 mario79 456 
        in      al, dx
3539 clevermous 457 
        ; Проверить состояние сигнала BSY
4700 mario79 458 
        test    al, 80h
2288 clevermous 459 
        jnz     @@WaitHDReady_1
3539 clevermous 460 
; Сбросить признак ошибки
2288 clevermous 461 
        mov     [DevErrorCode], 0
462 
        ret
3539 clevermous 463 
; Обработка ошибок
2288 clevermous 464 
@@Err1_2:
465 
        mov     [DevErrorCode], 1
466 
        ret
467 
@@Err3_2:
468 
        mov     [DevErrorCode], 3
469 
        ret
470 
@@Err4_2:
471 
        mov     [DevErrorCode], 4
3539 clevermous 472 
; Записать код ошибки
2288 clevermous 473 
        ret
4700 mario79 474 
;-----------------------------------------------------------------------------
2288 clevermous 475 
EndFindHDD: