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