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