Subversion Repositories Kolibri OS

Rev

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

Rev Author Line No. Line
431 serge 1 
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
2 
;;                                                              ;;
3 
;; Copyright (C) KolibriOS team 2004-2007. All rights reserved. ;;
4 
;; Distributed under terms of the GNU General Public License    ;;
5 
;;                                                              ;;
6 
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
7 
 
593 mikedld 8 
$Revision: 593 $
9 
 
10 
 
1 ha 11 
;******************************************************
12 
; поиск приводов HDD и CD
13 
; автор исходного текста Кулаков Владимир Геннадьевич.
14 
; адаптация и доработка Mario79
15 
;******************************************************
16 
 
17 
;****************************************************
18 
;*                 ПОИСК HDD и CD                   *
19 
;****************************************************
20 
FindHDD:
21 
        mov     [ChannelNumber],1
22 
        mov     [DiskNumber],0
23 
        call    FindHDD_3
346 diamond 24 
;        mov     ax,[Sector512+176]
389 serge 25 
;        mov     [DRIVE_DATA+6],ax
346 diamond 26 
;        mov     ax,[Sector512+126]
389 serge 27 
;        mov     [DRIVE_DATA+8],ax
346 diamond 28 
;        mov     ax,[Sector512+128]
389 serge 29 
;        mov     [DRIVE_DATA+8],ax
1 ha 30 
        mov     [DiskNumber],1
31 
        call    FindHDD_3
346 diamond 32 
;        mov     al,[Sector512+176]
389 serge 33 
;        mov     [DRIVE_DATA+7],al
1 ha 34 
        inc     [ChannelNumber]
35 
        mov     [DiskNumber],0
36 
        call    FindHDD_3
346 diamond 37 
;        mov     al,[Sector512+176]
389 serge 38 
;        mov     [DRIVE_DATA+8],al
1 ha 39 
        mov     [DiskNumber],1
40 
        call    FindHDD_1
346 diamond 41 
;        mov     al,[Sector512+176]
389 serge 42 
;        mov     [DRIVE_DATA+9],al
43 
 
1 ha 44 
        jmp     EndFindHDD
45 
 
46 
FindHDD_1:
47 
        call    ReadHDD_ID
48 
        cmp     [DevErrorCode],0
49 
        jne     FindHDD_2
346 diamond 50 
        cmp     [Sector512+6],word 16
51 
        ja      FindHDD_2
52 
        cmp     [Sector512+12],word 255
53 
        ja      FindHDD_2
389 serge 54 
        inc     byte [DRIVE_DATA+1]
346 diamond 55 
        jmp     FindHDD_2_2
1 ha 56 
   FindHDD_2:
346 diamond 57 
        call    DeviceReset
58 
        cmp     [DevErrorCode],0
59 
        jne     FindHDD_2_2
1 ha 60 
        call    ReadCD_ID
61 
        cmp     [DevErrorCode],0
62 
        jne      FindHDD_2_2
389 serge 63 
        inc     byte [DRIVE_DATA+1]
64 
        inc     byte [DRIVE_DATA+1]
1 ha 65 
   FindHDD_2_2:
66 
        ret
67 
 
68 
FindHDD_3:
69 
        call    FindHDD_1
389 serge 70 
        shl     byte [DRIVE_DATA+1],2
1 ha 71 
        ret
72 
 
73 
 
74 
; Адрес считываемого сектора в режиме LBA
75 
SectorAddress   DD ?
76 
 
77 
;*************************************************
78 
;*     ЧТЕНИЕ ИДЕНТИФИКАТОРА ЖЕСТКОГО ДИСКА      *
79 
;* Входные параметры передаются через глобальные *
80 
;* переменные:                                   *
81 
;* ChannelNumber - номер канала (1 или 2);       *
82 
;* DiskNumber - номер диска на канале (0 или 1). *
83 
;* Идентификационный блок данных считывается     *
84 
;* в массив Sector512.                           *
85 
;*************************************************
86 
ReadHDD_ID:
87 
; Задать режим CHS
88 
        mov     [ATAAddressMode],0
89 
; Послать команду идентификации устройства
90 
        mov     [ATAFeatures],0
91 
        mov     [ATAHead],0
92 
        mov     [ATACommand],0ECh
93 
        call    SendCommandToHDD
94 
        cmp     [DevErrorCode],0 ;проверить код ошибки
95 
        jne     @@End  ;закончить, сохранив код ошибки
96 
        mov     DX,[ATABasePortAddr]
389 serge 97 
        add     DX,7     ;адрес регистра состояни
1 ha 98 
        mov  ecx,0xffff
99 
@@WaitCompleet:
100 
        ; Проверить время выполнения команды
101 
        dec  ecx
102 
        cmp  ecx,0
103 
        je     @@Error1   ;ошибка тайм-аута
104 
        ; Проверить готовность
105 
        in      AL,DX
106 
        test    AL,80h   ;состояние сигнала BSY
107 
        jnz     @@WaitCompleet
108 
        test    AL,1     ;состояние сигнала ERR
109 
        jnz     @@Error6
110 
        test    AL,08h   ;состояние сигнала DRQ
111 
        jz      @@WaitCompleet
112 
; Принять блок данных от контроллера
113 
;        mov     AX,DS
114 
;        mov     ES,AX
115 
        mov     EDI,Sector512  ;offset Sector512
116 
        mov     DX,[ATABasePortAddr] ;регистр данных
117 
        mov     CX,256   ;число считываемых слов
118 
        rep     insw     ;принять блок данных
119 
        jmp @@End
120 
; Записать код ошибки
121 
@@Error1:
122 
        mov     [DevErrorCode],1
123 
        jmp @@End
124 
@@Error6:
125 
        mov     [DevErrorCode],6
126 
@@End:  ret
127 
 
128 
 
129 
 
130 
; Стандартные базовые адреса каналов 1 и 2
131 
StandardATABases DW 1F0h, 170h
132 
; Номер канала
133 
ChannelNumber   DW ?
134 
; Номер диска
135 
DiskNumber      DB ?
136 
; Базовый адрес группы портов контроллера ATA
137 
ATABasePortAddr DW ?
138 
; Параметры ATA-команды
139 
ATAFeatures     DB ? ;особенности
140 
ATASectorCount  DB ? ;количество обрабатываемых секторов
141 
ATASectorNumber DB ? ;номер начального сектора
142 
ATACylinder     DW ? ;номер начального цилиндра
143 
ATAHead         DB ? ;номер начальной головки
144 
ATAAddressMode  DB ? ;режим адресации (0 - CHS, 1 - LBA)
145 
ATACommand      DB ? ;код команды, подлежащей выполнению
146 
; Код ошибки (0 - нет ошибок, 1 - превышен допустимый
147 
; интервал ожидания, 2 - неверный код режима адресации,
148 
; 3 - неверный номер канала, 4 - неверный номер диска,
149 
; 5 - неверный номер головки, 6 - ошибка при выполнении
150 
; команды)
151 
DevErrorCode DB ?
152 
 
153 
;****************************************************
154 
;*          ПОСЛАТЬ КОМАНДУ ЗАДАННОМУ ДИСКУ         *
155 
;* Входные параметры передаются через глобальные    *
156 
;* переменные:                                      *
157 
;* ChannelNumber - номер канала (1 или 2);          *
158 
;* DiskNumber - номер диска (0 или 1);              *
159 
;* ATAFeatures - "особенности";                     *
160 
;* ATASectorCount - количество секторов;            *
161 
;* ATASectorNumber - номер начального сектора;      *
162 
;* ATACylinder - номер начального цилиндра;         *
163 
;* ATAHead - номер начальной головки;               *
164 
;* ATAAddressMode - режим адресации (0-CHS, 1-LBA); *
165 
;* ATACommand - код команды.                        *
166 
;* После успешного выполнения функции:              *
167 
;* в ATABasePortAddr - базовый адрес HDD;           *
168 
;* в DevErrorCode - ноль.                           *
169 
;* При возникновении ошибки в DevErrorCode будет    *
170 
;* возвращен код ошибки.                            *
171 
;****************************************************
172 
SendCommandToHDD:
173 
; Проверить значение кода режима
174 
        cmp     [ATAAddressMode],1
175 
        ja      @@Err2
176 
; Проверить корректность номера канала
177 
        mov     BX,[ChannelNumber]
178 
        cmp     BX,1
179 
        jb      @@Err3
180 
        cmp     BX,2
181 
        ja      @@Err3
182 
; Установить базовый адрес
183 
        dec     BX
184 
        shl     BX,1
185 
        movzx   ebx,bx
186 
        mov     AX,[ebx+StandardATABases]
187 
        mov     [ATABasePortAddr],AX
188 
; Ожидание готовности HDD к приему команды
189 
        ; Выбрать нужный диск
190 
        mov     DX,[ATABasePortAddr]
191 
        add     DX,6    ;адрес регистра головок
192 
        mov     AL,[DiskNumber]
193 
        cmp     AL,1    ;проверить номера диска
194 
        ja      @@Err4
195 
        shl     AL,4
196 
        or      AL,10100000b
197 
        out     DX,AL
198 
        ; Ожидать, пока диск не будет готов
199 
        inc     DX
200 
        mov  ecx,0xfff
201 
;        mov     eax,[timer_ticks]
202 
;        mov     [TickCounter_1],eax
203 
@@WaitHDReady:
389 serge 204 
        ; Проверить время ожидани
1 ha 205 
        dec  ecx
206 
        cmp  ecx,0
207 
        je     @@Err1
208 
;        mov     eax,[timer_ticks]
209 
;        sub     eax,[TickCounter_1]
389 serge 210 
;        cmp     eax,300    ;ожидать 300 тиков
1 ha 211 
;        ja      @@Err1   ;ошибка тайм-аута
389 serge 212 
        ; Прочитать регистр состояни
1 ha 213 
        in      AL,DX
214 
        ; Проверить состояние сигнала BSY
215 
        test    AL,80h
216 
        jnz     @@WaitHDReady
217 
        ; Проверить состояние сигнала DRQ
218 
        test    AL,08h
219 
        jnz     @@WaitHDReady
220 
; Загрузить команду в регистры контроллера
221 
        cli
222 
        mov     DX,[ATABasePortAddr]
223 
        inc     DX      ;регистр "особенностей"
224 
        mov     AL,[ATAFeatures]
225 
        out     DX,AL
226 
        inc     DX      ;счетчик секторов
227 
        mov     AL,[ATASectorCount]
228 
        out     DX,AL
229 
        inc     DX      ;регистр номера сектора
230 
        mov     AL,[ATASectorNumber]
231 
        out     DX,AL
232 
        inc     DX      ;номер цилиндра (младший байт)
233 
        mov     AX,[ATACylinder]
234 
        out     DX,AL
235 
        inc     DX      ;номер цилиндра (старший байт)
236 
        mov     AL,AH
237 
        out     DX,AL
238 
        inc     DX      ;номер головки/номер диска
239 
        mov     AL,[DiskNumber]
240 
        shl     AL,4
241 
        cmp     [ATAHead],0Fh ;проверить номер головки
242 
        ja      @@Err5
243 
        or      AL,[ATAHead]
244 
        or      AL,10100000b
245 
        mov     AH,[ATAAddressMode]
246 
        shl     AH,6
247 
        or      AL,AH
248 
        out     DX,AL
249 
; Послать команду
250 
        mov     AL,[ATACommand]
251 
        inc     DX      ;регистр команд
252 
        out     DX,AL
253 
        sti
254 
; Сбросить признак ошибки
255 
        mov     [DevErrorCode],0
256 
        jmp @@End_2
257 
; Записать код ошибки
258 
@@Err1: mov     [DevErrorCode],1
259 
        jmp @@End_2
260 
@@Err2: mov     [DevErrorCode],2
261 
        jmp @@End_2
262 
@@Err3: mov     [DevErrorCode],3
263 
        jmp @@End_2
264 
@@Err4: mov     [DevErrorCode],4
265 
        jmp @@End_2
266 
@@Err5: mov     [DevErrorCode],5
267 
; Завершение работы программы
389 serge 268 
@@End_2:
1 ha 269 
        ret
270 
 
271 
;*************************************************
272 
;*     ЧТЕНИЕ ИДЕНТИФИКАТОРА УСТРОЙСТВА ATAPI    *
273 
;* Входные параметры передаются через глобальные *
274 
;* перменные:                                    *
275 
;* ChannelNumber - номер канала;                 *
276 
;* DiskNumber - номер диска на канале.           *
277 
;* Идентификационный блок данных считывается     *
278 
;* в массив Sector512.                           *
279 
;*************************************************
280 
ReadCD_ID:
281 
; Задать режим CHS
282 
        mov     [ATAAddressMode],0
283 
; Послать команду идентификации устройства
284 
        mov     [ATAFeatures],0
285 
        mov     [ATASectorCount],0
286 
        mov     [ATASectorNumber],0
287 
        mov     [ATACylinder],0
288 
        mov     [ATAHead],0
289 
        mov     [ATACommand],0A1h
290 
        call    SendCommandToHDD
291 
        cmp     [DevErrorCode],0 ;проверить код ошибки
292 
        jne     @@End_1  ;закончить, сохранив код ошибки
293 
; Ожидать готовность данных HDD
294 
        mov     DX,[ATABasePortAddr]
295 
        add     DX,7   ;порт 1х7h
296 
        mov  ecx,0xffff
297 
@@WaitCompleet_1:
389 serge 298 
        ; Проверить врем
1 ha 299 
        dec  ecx
300 
        cmp  ecx,0
301 
        je     @@Error1_1  ;ошибка тайм-аута
302 
        ; Проверить готовность
303 
        in      AL,DX
304 
        test    AL,80h   ;состояние сигнала BSY
305 
        jnz     @@WaitCompleet_1
306 
        test    AL,1     ;состояние сигнала ERR
307 
        jnz     @@Error6_1
308 
        test    AL,08h   ;состояние сигнала DRQ
309 
        jz      @@WaitCompleet_1
310 
; Принять блок данных от контроллера
311 
;        mov     AX,DS
312 
;        mov     ES,AX
313 
        mov     EDI,Sector512  ;offset Sector512
314 
        mov     DX,[ATABasePortAddr] ;порт 1x0h
315 
        mov     CX,256 ;число считываемых слов
316 
        rep     insw
317 
        jmp @@End_1
318 
; Записать код ошибки
319 
@@Error1_1:
320 
        mov     [DevErrorCode],1
321 
        jmp @@End_1
322 
@@Error6_1:
323 
        mov     [DevErrorCode],6
324 
@@End_1:
325 
        ret
326 
 
327 
;*************************************************
328 
;*                СБРОС УСТРОЙСТВА               *
329 
;* Входные параметры передаются через глобальные *
330 
;* переменные:                                   *
331 
;* ChannelNumber - номер канала (1 или 2);       *
332 
;* DiskNumber - номер диска (0 или 1).           *
333 
;*************************************************
334 
DeviceReset:
335 
; Проверить корректность номера канала
336 
        mov     BX,[ChannelNumber]
337 
        cmp     BX,1
338 
        jb      @@Err3_2
339 
        cmp     BX,2
340 
        ja      @@Err3_2
341 
; Установить базовый адрес
342 
        dec     BX
343 
        shl     BX,1
344 
        movzx   ebx,bx
345 
        mov     DX,[ebx+StandardATABases]
346 
        mov     [ATABasePortAddr],DX
347 
; Выбрать нужный диск
348 
        add     DX,6    ;адрес регистра головок
349 
        mov     AL,[DiskNumber]
350 
        cmp     AL,1    ;проверить номера диска
351 
        ja      @@Err4_2
352 
        shl     AL,4
353 
        or      AL,10100000b
354 
        out     DX,AL
355 
; Послать команду "Сброс"
356 
        mov     AL,08h
357 
        inc     DX      ;регистр команд
358 
        out     DX,AL
143 diamond 359 
        mov     ecx,0x80000
1 ha 360 
@@WaitHDReady_1:
389 serge 361 
        ; Проверить время ожидани
1 ha 362 
        dec     ecx
363 
        cmp     ecx,0
364 
        je      @@Err1_2 ;ошибка тайм-аута
389 serge 365 
        ; Прочитать регистр состояни
1 ha 366 
        in      AL,DX
367 
        ; Проверить состояние сигнала BSY
368 
        test    AL,80h
369 
        jnz     @@WaitHDReady_1
370 
; Сбросить признак ошибки
371 
        mov     [DevErrorCode],0
372 
        jmp @@End_3
373 
; Обработка ошибок
374 
@@Err1_2: mov     [DevErrorCode],1
375 
        jmp @@End_3
376 
@@Err3_2: mov     [DevErrorCode],3
377 
        jmp @@End_3
378 
@@Err4_2: mov     [DevErrorCode],4
379 
; Записать код ошибки
380 
@@End_3:
381 
        ret
382 
 
383 
EndFindHDD:
384