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