Rev 4839 | Rev 5569 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
2288 | clevermous | 1 | ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;; |
2 | ;; ;; |
||
5363 | yogev_ezra | 3 | ;; Copyright (C) KolibriOS team 2004-2015. All rights reserved. ;; |
2288 | clevermous | 4 | ;; Distributed under terms of the GNU General Public License ;; |
5 | ;; ;; |
||
6 | ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;; |
||
7 | |||
8 | $Revision: 5363 $ |
||
9 | |||
10 | |||
11 | ; Low-level driver for HDD access |
||
12 | ; DMA support by Mario79 |
||
3712 | mario79 | 13 | ; LBA48 support by Mario79 |
14 | ;----------------------------------------------------------------------------- |
||
3742 | clevermous | 15 | struct HD_DATA |
16 | hdbase dd ? |
||
17 | hdid dd ? |
||
18 | hdpos dd ? |
||
19 | ends |
||
4700 | mario79 | 20 | ;----------------------------------------------------------------------------- |
3742 | clevermous | 21 | iglobal |
2288 | clevermous | 22 | align 4 |
3742 | clevermous | 23 | ide_callbacks: |
24 | dd ide_callbacks.end - ide_callbacks ; strucsize |
||
25 | dd 0 ; no close function |
||
26 | dd 0 ; no closemedia function |
||
27 | dd ide_querymedia |
||
28 | dd ide_read |
||
29 | dd ide_write |
||
30 | dd 0 ; no flush function |
||
31 | dd 0 ; use default cache size |
||
32 | .end: |
||
2288 | clevermous | 33 | |
3742 | clevermous | 34 | hd0_data HD_DATA ?, 0, 1 |
35 | hd1_data HD_DATA ?, 0x10, 2 |
||
36 | hd2_data HD_DATA ?, 0, 3 |
||
37 | hd3_data HD_DATA ?, 0x10, 4 |
||
4700 | mario79 | 38 | hd4_data HD_DATA ?, 0, 5 |
39 | hd5_data HD_DATA ?, 0x10, 6 |
||
40 | hd6_data HD_DATA ?, 0, 7 |
||
41 | hd7_data HD_DATA ?, 0x10, 8 |
||
42 | hd8_data HD_DATA ?, 0, 9 |
||
43 | hd9_data HD_DATA ?, 0x10, 10 |
||
44 | hd10_data HD_DATA ?, 0, 11 |
||
45 | hd11_data HD_DATA ?, 0x10, 12 |
||
4273 | clevermous | 46 | |
4700 | mario79 | 47 | ide_mutex_table: |
48 | dd ide_channel1_mutex |
||
49 | dd ide_channel2_mutex |
||
50 | dd ide_channel3_mutex |
||
51 | dd ide_channel4_mutex |
||
52 | dd ide_channel5_mutex |
||
53 | dd ide_channel6_mutex |
||
3742 | clevermous | 54 | endg |
4700 | mario79 | 55 | ;----------------------------------------------------------------------------- |
3742 | clevermous | 56 | uglobal |
57 | ide_mutex MUTEX |
||
58 | ide_channel1_mutex MUTEX |
||
59 | ide_channel2_mutex MUTEX |
||
4700 | mario79 | 60 | ide_channel3_mutex MUTEX |
61 | ide_channel4_mutex MUTEX |
||
62 | ide_channel5_mutex MUTEX |
||
63 | ide_channel6_mutex MUTEX |
||
3742 | clevermous | 64 | endg |
4700 | mario79 | 65 | ;----------------------------------------------------------------------------- |
3742 | clevermous | 66 | proc ide_read stdcall uses edi, \ |
67 | hd_data, buffer, startsector:qword, numsectors |
||
68 | ; hd_data = pointer to hd*_data |
||
69 | ; buffer = pointer to buffer for data |
||
70 | ; startsector = 64-bit start sector |
||
71 | ; numsectors = pointer to number of sectors on input, |
||
72 | ; must be filled with number of sectors really read |
||
73 | locals |
||
74 | sectors_todo dd ? |
||
75 | channel_lock dd ? |
||
76 | endl |
||
77 | ; 1. Initialize number of sectors: get number of requested sectors |
||
78 | ; and say that no sectors were read yet. |
||
79 | mov ecx, [numsectors] |
||
80 | mov eax, [ecx] |
||
81 | mov dword [ecx], 0 |
||
82 | mov [sectors_todo], eax |
||
83 | ; 2. Acquire the global lock. |
||
84 | mov ecx, ide_mutex |
||
85 | call mutex_lock |
||
4700 | mario79 | 86 | |
87 | mov ecx, [hd_data] |
||
88 | mov ecx, [ecx+HD_DATA.hdpos] |
||
89 | dec ecx |
||
90 | shr ecx, 1 |
||
91 | shl ecx, 2 |
||
92 | mov ecx, [ecx + ide_mutex_table] |
||
3742 | clevermous | 93 | mov [channel_lock], ecx |
94 | call mutex_lock |
||
95 | ; 3. Convert parameters to the form suitable for worker procedures. |
||
96 | ; Underlying procedures do not know about 64-bit sectors. |
||
97 | ; Worker procedures use global variables and edi for [buffer]. |
||
98 | cmp dword [startsector+4], 0 |
||
99 | jnz .fail |
||
4700 | mario79 | 100 | |
3742 | clevermous | 101 | and [hd_error], 0 |
102 | mov ecx, [hd_data] |
||
103 | mov eax, [ecx+HD_DATA.hdbase] |
||
104 | mov [hdbase], eax |
||
105 | mov eax, [ecx+HD_DATA.hdid] |
||
106 | mov [hdid], eax |
||
107 | mov eax, [ecx+HD_DATA.hdpos] |
||
108 | mov [hdpos], eax |
||
109 | mov eax, dword [startsector] |
||
110 | mov edi, [buffer] |
||
111 | ; 4. Worker procedures take one sectors per time, so loop over all sectors to read. |
||
112 | .sectors_loop: |
||
2288 | clevermous | 113 | ; DMA read is permitted if [allow_dma_access]=1 or 2 |
114 | cmp [allow_dma_access], 2 |
||
115 | ja .nodma |
||
4291 | mario79 | 116 | |
4720 | mario79 | 117 | push eax ecx |
118 | mov ecx, [hdpos] |
||
119 | dec ecx |
||
120 | shr ecx, 2 |
||
121 | imul ecx, sizeof.IDE_DATA |
||
122 | add ecx, IDE_controller_1 |
||
123 | mov [IDE_controller_pointer], ecx |
||
124 | |||
125 | mov eax, [hdpos] |
||
126 | dec eax |
||
127 | and eax, 11b |
||
128 | shr eax, 1 |
||
129 | add eax, ecx |
||
130 | cmp [eax+IDE_DATA.dma_hdd_channel_1], 1 |
||
131 | pop ecx eax |
||
4291 | mario79 | 132 | jnz .nodma |
133 | |||
2288 | clevermous | 134 | call hd_read_dma |
135 | jmp @f |
||
4700 | mario79 | 136 | ;-------------------------------------- |
2288 | clevermous | 137 | .nodma: |
138 | call hd_read_pio |
||
4700 | mario79 | 139 | ;-------------------------------------- |
2288 | clevermous | 140 | @@: |
141 | cmp [hd_error], 0 |
||
3742 | clevermous | 142 | jnz .fail |
4700 | mario79 | 143 | |
3742 | clevermous | 144 | mov ecx, [numsectors] |
145 | inc dword [ecx] ; one more sector is read |
||
146 | dec [sectors_todo] |
||
147 | jz .done |
||
4700 | mario79 | 148 | |
3742 | clevermous | 149 | inc eax |
150 | jnz .sectors_loop |
||
4700 | mario79 | 151 | ;-------------------------------------- |
3742 | clevermous | 152 | ; 5. Loop is done, either due to error or because everything is done. |
153 | ; Release the global lock and return the corresponding status. |
||
154 | .fail: |
||
155 | mov ecx, [channel_lock] |
||
156 | call mutex_unlock |
||
4700 | mario79 | 157 | |
3742 | clevermous | 158 | mov ecx, ide_mutex |
159 | call mutex_unlock |
||
4700 | mario79 | 160 | |
3742 | clevermous | 161 | or eax, -1 |
162 | ret |
||
4700 | mario79 | 163 | ;-------------------------------------- |
3742 | clevermous | 164 | .done: |
165 | mov ecx, [channel_lock] |
||
166 | call mutex_unlock |
||
4700 | mario79 | 167 | |
3742 | clevermous | 168 | mov ecx, ide_mutex |
169 | call mutex_unlock |
||
4700 | mario79 | 170 | |
3742 | clevermous | 171 | xor eax, eax |
172 | ret |
||
173 | endp |
||
4700 | mario79 | 174 | ;----------------------------------------------------------------------------- |
3742 | clevermous | 175 | proc ide_write stdcall uses esi edi, \ |
176 | hd_data, buffer, startsector:qword, numsectors |
||
177 | ; hd_data = pointer to hd*_data |
||
178 | ; buffer = pointer to buffer with data |
||
179 | ; startsector = 64-bit start sector |
||
180 | ; numsectors = pointer to number of sectors on input, |
||
181 | ; must be filled with number of sectors really written |
||
182 | locals |
||
183 | sectors_todo dd ? |
||
184 | channel_lock dd ? |
||
185 | endl |
||
186 | ; 1. Initialize number of sectors: get number of requested sectors |
||
187 | ; and say that no sectors were read yet. |
||
188 | mov ecx, [numsectors] |
||
189 | mov eax, [ecx] |
||
190 | mov dword [ecx], 0 |
||
191 | mov [sectors_todo], eax |
||
192 | ; 2. Acquire the global lock. |
||
193 | mov ecx, ide_mutex |
||
194 | call mutex_lock |
||
4700 | mario79 | 195 | |
196 | mov ecx, [hd_data] |
||
197 | mov ecx, [ecx+HD_DATA.hdpos] |
||
198 | dec ecx |
||
199 | shr ecx, 1 |
||
200 | shl ecx, 2 |
||
201 | mov ecx, [ecx + ide_mutex_table] |
||
3742 | clevermous | 202 | mov [channel_lock], ecx |
203 | call mutex_lock |
||
204 | ; 3. Convert parameters to the form suitable for worker procedures. |
||
205 | ; Underlying procedures do not know about 64-bit sectors. |
||
206 | ; Worker procedures use global variables and esi for [buffer]. |
||
207 | cmp dword [startsector+4], 0 |
||
208 | jnz .fail |
||
4700 | mario79 | 209 | |
3742 | clevermous | 210 | and [hd_error], 0 |
211 | mov ecx, [hd_data] |
||
212 | mov eax, [ecx+HD_DATA.hdbase] |
||
213 | mov [hdbase], eax |
||
214 | mov eax, [ecx+HD_DATA.hdid] |
||
215 | mov [hdid], eax |
||
216 | mov eax, [ecx+HD_DATA.hdpos] |
||
217 | mov [hdpos], eax |
||
218 | mov esi, [buffer] |
||
219 | lea edi, [startsector] |
||
220 | mov [cache_chain_ptr], edi |
||
221 | ; 4. Worker procedures take max 16 sectors per time, |
||
222 | ; loop until all sectors will be processed. |
||
223 | .sectors_loop: |
||
224 | mov ecx, 16 |
||
225 | cmp ecx, [sectors_todo] |
||
226 | jbe @f |
||
4700 | mario79 | 227 | |
3742 | clevermous | 228 | mov ecx, [sectors_todo] |
4700 | mario79 | 229 | ;-------------------------------------- |
3742 | clevermous | 230 | @@: |
231 | mov [cache_chain_size], cl |
||
232 | ; DMA write is permitted only if [allow_dma_access]=1 |
||
233 | cmp [allow_dma_access], 2 |
||
234 | jae .nodma |
||
4291 | mario79 | 235 | |
4720 | mario79 | 236 | push eax ecx |
237 | mov ecx, [hdpos] |
||
238 | dec ecx |
||
239 | shr ecx, 2 |
||
240 | imul ecx, sizeof.IDE_DATA |
||
241 | add ecx, IDE_controller_1 |
||
242 | mov [IDE_controller_pointer], ecx |
||
243 | |||
244 | mov eax, [hdpos] |
||
245 | dec eax |
||
246 | and eax, 11b |
||
247 | shr eax, 1 |
||
248 | add eax, ecx |
||
249 | cmp [eax+IDE_DATA.dma_hdd_channel_1], 1 |
||
250 | pop ecx eax |
||
4291 | mario79 | 251 | jnz .nodma |
252 | |||
3742 | clevermous | 253 | call cache_write_dma |
254 | jmp .common |
||
4700 | mario79 | 255 | ;-------------------------------------- |
3742 | clevermous | 256 | .nodma: |
257 | mov [cache_chain_size], 1 |
||
258 | call cache_write_pio |
||
4700 | mario79 | 259 | ;-------------------------------------- |
3742 | clevermous | 260 | .common: |
261 | cmp [hd_error], 0 |
||
262 | jnz .fail |
||
4700 | mario79 | 263 | |
3742 | clevermous | 264 | movzx ecx, [cache_chain_size] |
265 | mov eax, [numsectors] |
||
266 | add [eax], ecx |
||
267 | sub [sectors_todo], ecx |
||
268 | jz .done |
||
4700 | mario79 | 269 | |
3742 | clevermous | 270 | add [edi], ecx |
271 | jc .fail |
||
4700 | mario79 | 272 | |
3742 | clevermous | 273 | shl ecx, 9 |
274 | add esi, ecx |
||
275 | jmp .sectors_loop |
||
4700 | mario79 | 276 | ;-------------------------------------- |
3742 | clevermous | 277 | ; 5. Loop is done, either due to error or because everything is done. |
278 | ; Release the global lock and return the corresponding status. |
||
279 | .fail: |
||
280 | mov ecx, [channel_lock] |
||
281 | call mutex_unlock |
||
4700 | mario79 | 282 | |
3742 | clevermous | 283 | mov ecx, ide_mutex |
284 | call mutex_unlock |
||
4700 | mario79 | 285 | |
3742 | clevermous | 286 | or eax, -1 |
287 | ret |
||
4700 | mario79 | 288 | ;-------------------------------------- |
3742 | clevermous | 289 | .done: |
290 | mov ecx, [channel_lock] |
||
291 | call mutex_unlock |
||
4700 | mario79 | 292 | |
3742 | clevermous | 293 | mov ecx, ide_mutex |
294 | call mutex_unlock |
||
4700 | mario79 | 295 | |
3742 | clevermous | 296 | xor eax, eax |
297 | ret |
||
298 | endp |
||
4700 | mario79 | 299 | ;----------------------------------------------------------------------------- |
3742 | clevermous | 300 | ; This is a stub. |
301 | proc ide_querymedia stdcall, hd_data, mediainfo |
||
302 | mov eax, [mediainfo] |
||
303 | mov [eax+DISKMEDIAINFO.Flags], 0 |
||
304 | mov [eax+DISKMEDIAINFO.SectorSize], 512 |
||
305 | or dword [eax+DISKMEDIAINFO.Capacity], 0xFFFFFFFF |
||
306 | or dword [eax+DISKMEDIAINFO.Capacity+4], 0xFFFFFFFF |
||
307 | xor eax, eax |
||
308 | ret |
||
309 | endp |
||
3712 | mario79 | 310 | ;----------------------------------------------------------------------------- |
2288 | clevermous | 311 | align 4 |
3742 | clevermous | 312 | ; input: eax = sector, edi -> buffer |
313 | ; output: edi = edi + 512 |
||
2288 | clevermous | 314 | hd_read_pio: |
315 | push eax edx |
||
3712 | mario79 | 316 | ; Select the desired drive |
3702 | mario79 | 317 | mov edx, [hdbase] |
318 | add edx, 6 ;адрес регистра головок |
||
319 | mov al, byte [hdid] |
||
320 | add al, 128+64+32 |
||
321 | out dx, al; номер головки/номер диска |
||
3711 | clevermous | 322 | |
2288 | clevermous | 323 | call wait_for_hd_idle |
4700 | mario79 | 324 | |
2288 | clevermous | 325 | cmp [hd_error], 0 |
326 | jne hd_read_error |
||
3702 | mario79 | 327 | ; ATA with 28 or 48 bit for sector number? |
328 | mov eax, [esp+4] |
||
329 | cmp eax, 0x10000000 |
||
3711 | clevermous | 330 | jae .lba48 |
3712 | mario79 | 331 | ;-------------------------------------- |
3702 | mario79 | 332 | .lba28: |
3706 | mario79 | 333 | pushfd |
2288 | clevermous | 334 | cli |
335 | xor eax, eax |
||
336 | mov edx, [hdbase] |
||
337 | inc edx |
||
3706 | mario79 | 338 | out dx, al ; ATA Features регистр "особенностей" |
2288 | clevermous | 339 | inc edx |
340 | inc eax |
||
3706 | mario79 | 341 | out dx, al ; ATA Sector Counter счётчик секторов |
2288 | clevermous | 342 | inc edx |
3706 | mario79 | 343 | mov eax, [esp+4+4] |
344 | out dx, al ; LBA Low LBA (7:0) |
||
2288 | clevermous | 345 | shr eax, 8 |
346 | inc edx |
||
3706 | mario79 | 347 | out dx, al ; LBA Mid LBA (15:8) |
2288 | clevermous | 348 | shr eax, 8 |
349 | inc edx |
||
3706 | mario79 | 350 | out dx, al ; LBA High LBA (23:16) |
2288 | clevermous | 351 | shr eax, 8 |
352 | inc edx |
||
3706 | mario79 | 353 | and al, 1+2+4+8 ; LBA (27:24) |
2288 | clevermous | 354 | add al, byte [hdid] |
355 | add al, 128+64+32 |
||
3706 | mario79 | 356 | out dx, al ; номер головки/номер диска |
2288 | clevermous | 357 | inc edx |
3711 | clevermous | 358 | mov al, 20h ; READ SECTOR(S) |
3706 | mario79 | 359 | out dx, al ; ATACommand регистр команд |
360 | popfd |
||
3711 | clevermous | 361 | jmp .continue |
3712 | mario79 | 362 | ;-------------------------------------- |
3702 | mario79 | 363 | .lba48: |
3706 | mario79 | 364 | pushfd |
3702 | mario79 | 365 | cli |
366 | xor eax, eax |
||
367 | mov edx, [hdbase] |
||
368 | inc edx |
||
369 | out dx, al ; Features Previous Reserved |
||
370 | out dx, al ; Features Current Reserved |
||
371 | inc edx |
||
372 | out dx, al ; Sector Count Previous Sector count (15:8) |
||
373 | inc eax |
||
374 | out dx, al ; Sector Count Current Sector count (7:0) |
||
375 | inc edx |
||
3706 | mario79 | 376 | mov eax, [esp+4+4] |
3711 | clevermous | 377 | rol eax, 8 |
3702 | mario79 | 378 | out dx, al ; LBA Low Previous LBA (31:24) |
3712 | mario79 | 379 | xor eax, eax ; because only 32 bit cache |
3702 | mario79 | 380 | inc edx |
381 | out dx, al ; LBA Mid Previous LBA (39:32) |
||
382 | inc edx |
||
383 | out dx, al ; LBA High Previous LBA (47:40) |
||
3711 | clevermous | 384 | sub edx, 2 |
3706 | mario79 | 385 | mov eax, [esp+4+4] |
3702 | mario79 | 386 | out dx, al ; LBA Low Current LBA (7:0) |
387 | shr eax, 8 |
||
388 | inc edx |
||
389 | out dx, al ; LBA Mid Current LBA (15:8) |
||
390 | shr eax, 8 |
||
391 | inc edx |
||
392 | out dx, al ; LBA High Current LBA (23:16) |
||
393 | inc edx |
||
394 | mov al, byte [hdid] |
||
395 | add al, 128+64+32 |
||
3712 | mario79 | 396 | out dx, al ; номер головки/номер диска |
3702 | mario79 | 397 | inc edx |
3711 | clevermous | 398 | mov al, 24h ; READ SECTOR(S) EXT |
3712 | mario79 | 399 | out dx, al ; ATACommand регистр команд |
3706 | mario79 | 400 | popfd |
3712 | mario79 | 401 | ;-------------------------------------- |
3702 | mario79 | 402 | .continue: |
2288 | clevermous | 403 | call wait_for_sector_buffer |
404 | |||
405 | cmp [hd_error], 0 |
||
406 | jne hd_read_error |
||
407 | |||
3712 | mario79 | 408 | pushfd |
2288 | clevermous | 409 | cli |
410 | mov ecx, 256 |
||
411 | mov edx, [hdbase] |
||
412 | cld |
||
413 | rep insw |
||
3712 | mario79 | 414 | popfd |
2288 | clevermous | 415 | |
416 | pop edx eax |
||
417 | ret |
||
3712 | mario79 | 418 | ;----------------------------------------------------------------------------- |
2288 | clevermous | 419 | align 4 |
3742 | clevermous | 420 | ; edi -> sector, esi -> data |
2288 | clevermous | 421 | cache_write_pio: |
3712 | mario79 | 422 | ; Select the desired drive |
3702 | mario79 | 423 | mov edx, [hdbase] |
424 | add edx, 6 ;адрес регистра головок |
||
425 | mov al, byte [hdid] |
||
426 | add al, 128+64+32 |
||
3712 | mario79 | 427 | out dx, al ; номер головки/номер диска |
3702 | mario79 | 428 | |
2288 | clevermous | 429 | call wait_for_hd_idle |
4700 | mario79 | 430 | |
2288 | clevermous | 431 | cmp [hd_error], 0 |
432 | jne hd_write_error |
||
433 | |||
3706 | mario79 | 434 | ; ATA with 28 or 48 bit for sector number? |
3742 | clevermous | 435 | mov eax, [edi] |
3706 | mario79 | 436 | cmp eax, 0x10000000 |
437 | jae .lba48 |
||
3712 | mario79 | 438 | ;-------------------------------------- |
3706 | mario79 | 439 | .lba28: |
440 | pushfd |
||
2288 | clevermous | 441 | cli |
442 | xor eax, eax |
||
443 | mov edx, [hdbase] |
||
444 | inc edx |
||
3706 | mario79 | 445 | out dx, al ; ATA Features регистр "особенностей" |
2288 | clevermous | 446 | inc edx |
447 | inc eax |
||
3706 | mario79 | 448 | out dx, al ; ATA Sector Counter счётчик секторов |
2288 | clevermous | 449 | inc edx |
3742 | clevermous | 450 | mov eax, [edi] ; eax = sector to write |
3706 | mario79 | 451 | out dx, al ; LBA Low LBA (7:0) |
2288 | clevermous | 452 | shr eax, 8 |
453 | inc edx |
||
3706 | mario79 | 454 | out dx, al ; LBA Mid LBA (15:8) |
2288 | clevermous | 455 | shr eax, 8 |
456 | inc edx |
||
3706 | mario79 | 457 | out dx, al ; LBA High LBA (23:16) |
2288 | clevermous | 458 | shr eax, 8 |
459 | inc edx |
||
3706 | mario79 | 460 | and al, 1+2+4+8 ; LBA (27:24) |
2288 | clevermous | 461 | add al, byte [hdid] |
462 | add al, 128+64+32 |
||
3706 | mario79 | 463 | out dx, al ; номер головки/номер диска |
2288 | clevermous | 464 | inc edx |
3706 | mario79 | 465 | mov al, 30h ; WRITE SECTOR(S) |
466 | out dx, al ; ATACommand регистр команд |
||
3711 | clevermous | 467 | jmp .continue |
3712 | mario79 | 468 | ;-------------------------------------- |
3706 | mario79 | 469 | .lba48: |
470 | pushfd |
||
471 | cli |
||
472 | xor eax, eax |
||
473 | mov edx, [hdbase] |
||
474 | inc edx |
||
475 | out dx, al ; Features Previous Reserved |
||
476 | out dx, al ; Features Current Reserved |
||
477 | inc edx |
||
478 | out dx, al ; Sector Count Previous Sector count (15:8) |
||
479 | inc eax |
||
480 | out dx, al ; Sector Count Current Sector count (7:0) |
||
481 | inc edx |
||
3742 | clevermous | 482 | mov eax, [edi] |
3711 | clevermous | 483 | rol eax, 8 |
3706 | mario79 | 484 | out dx, al ; LBA Low Previous LBA (31:24) |
3712 | mario79 | 485 | xor eax, eax ; because only 32 bit cache |
3706 | mario79 | 486 | inc edx |
487 | out dx, al ; LBA Mid Previous LBA (39:32) |
||
488 | inc edx |
||
489 | out dx, al ; LBA High Previous LBA (47:40) |
||
3711 | clevermous | 490 | sub edx, 2 |
3742 | clevermous | 491 | mov eax, [edi] |
3706 | mario79 | 492 | out dx, al ; LBA Low Current LBA (7:0) |
493 | shr eax, 8 |
||
494 | inc edx |
||
495 | out dx, al ; LBA Mid Current LBA (15:8) |
||
496 | shr eax, 8 |
||
497 | inc edx |
||
498 | out dx, al ; LBA High Current LBA (23:16) |
||
499 | inc edx |
||
500 | mov al, byte [hdid] |
||
501 | add al, 128+64+32 |
||
3712 | mario79 | 502 | out dx, al ; номер головки/номер диска |
3706 | mario79 | 503 | inc edx |
3711 | clevermous | 504 | mov al, 34h ; WRITE SECTOR(S) EXT |
3712 | mario79 | 505 | out dx, al ; ATACommand регистр команд |
506 | ;-------------------------------------- |
||
3706 | mario79 | 507 | .continue: |
3881 | mario79 | 508 | popfd |
2288 | clevermous | 509 | call wait_for_sector_buffer |
510 | |||
511 | cmp [hd_error], 0 |
||
512 | jne hd_write_error |
||
513 | |||
514 | push ecx esi |
||
515 | |||
3712 | mario79 | 516 | pushfd |
2288 | clevermous | 517 | cli |
518 | mov ecx, 256 |
||
519 | mov edx, [hdbase] |
||
520 | cld |
||
521 | rep outsw |
||
3712 | mario79 | 522 | popfd |
2288 | clevermous | 523 | |
524 | pop esi ecx |
||
525 | ret |
||
3712 | mario79 | 526 | ;----------------------------------------------------------------------------- |
527 | align 4 |
||
2288 | clevermous | 528 | save_hd_wait_timeout: |
529 | push eax |
||
530 | mov eax, [timer_ticks] |
||
531 | add eax, 300 ; 3 sec timeout |
||
532 | mov [hd_wait_timeout], eax |
||
533 | pop eax |
||
534 | ret |
||
3712 | mario79 | 535 | ;----------------------------------------------------------------------------- |
2288 | clevermous | 536 | align 4 |
537 | check_hd_wait_timeout: |
||
538 | push eax |
||
539 | mov eax, [hd_wait_timeout] |
||
540 | cmp [timer_ticks], eax |
||
541 | jg hd_timeout_error |
||
3712 | mario79 | 542 | |
2288 | clevermous | 543 | pop eax |
544 | mov [hd_error], 0 |
||
545 | ret |
||
3712 | mario79 | 546 | ;----------------------------------------------------------------------------- |
2288 | clevermous | 547 | hd_timeout_error: |
3712 | mario79 | 548 | if lang eq sp |
549 | DEBUGF 1,"K : FS - HD tiempo de espera agotado\n" |
||
550 | else |
||
551 | DEBUGF 1,"K : FS - HD timeout\n" |
||
552 | end if |
||
2288 | clevermous | 553 | mov [hd_error], 1 |
554 | pop eax |
||
555 | ret |
||
3712 | mario79 | 556 | ;----------------------------------------------------------------------------- |
2288 | clevermous | 557 | hd_read_error: |
3712 | mario79 | 558 | if lang eq sp |
559 | DEBUGF 1,"K : FS - HD error de lectura\n" |
||
560 | else |
||
561 | DEBUGF 1,"K : FS - HD read error\n" |
||
562 | end if |
||
2288 | clevermous | 563 | pop edx eax |
564 | ret |
||
3712 | mario79 | 565 | ;----------------------------------------------------------------------------- |
566 | hd_write_error_dma: |
||
567 | pop esi |
||
2288 | clevermous | 568 | hd_write_error: |
3309 | esevece | 569 | if lang eq sp |
570 | DEBUGF 1,"K : FS - HD error de escritura\n" |
||
571 | else |
||
572 | DEBUGF 1,"K : FS - HD write error\n" |
||
573 | end if |
||
2288 | clevermous | 574 | ret |
3712 | mario79 | 575 | ;----------------------------------------------------------------------------- |
2288 | clevermous | 576 | align 4 |
577 | wait_for_hd_idle: |
||
578 | push eax edx |
||
579 | |||
580 | call save_hd_wait_timeout |
||
581 | |||
582 | mov edx, [hdbase] |
||
583 | add edx, 0x7 |
||
3712 | mario79 | 584 | ;-------------------------------------- |
585 | align 4 |
||
586 | wfhil1: |
||
2288 | clevermous | 587 | call check_hd_wait_timeout |
4700 | mario79 | 588 | |
2288 | clevermous | 589 | cmp [hd_error], 0 |
590 | jne @f |
||
591 | |||
592 | in al, dx |
||
593 | test al, 128 |
||
594 | jnz wfhil1 |
||
4700 | mario79 | 595 | ;-------------------------------------- |
3712 | mario79 | 596 | @@: |
2288 | clevermous | 597 | pop edx eax |
598 | ret |
||
3712 | mario79 | 599 | ;----------------------------------------------------------------------------- |
2288 | clevermous | 600 | align 4 |
601 | wait_for_sector_buffer: |
||
602 | push eax edx |
||
603 | |||
604 | mov edx, [hdbase] |
||
605 | add edx, 0x7 |
||
606 | |||
607 | call save_hd_wait_timeout |
||
3712 | mario79 | 608 | ;-------------------------------------- |
609 | align 4 |
||
610 | hdwait_sbuf: ; wait for sector buffer to be ready |
||
2288 | clevermous | 611 | call check_hd_wait_timeout |
4700 | mario79 | 612 | |
2288 | clevermous | 613 | cmp [hd_error], 0 |
614 | jne @f |
||
615 | |||
616 | in al, dx |
||
617 | test al, 8 |
||
618 | jz hdwait_sbuf |
||
619 | |||
620 | mov [hd_error], 0 |
||
621 | |||
622 | cmp [hd_setup], 1 ; do not mark error for setup request |
||
623 | je buf_wait_ok |
||
624 | |||
625 | test al, 1 ; previous command ended up with an error |
||
626 | jz buf_wait_ok |
||
4700 | mario79 | 627 | ;-------------------------------------- |
3712 | mario79 | 628 | @@: |
2288 | clevermous | 629 | mov [hd_error], 1 |
4700 | mario79 | 630 | ;-------------------------------------- |
3712 | mario79 | 631 | buf_wait_ok: |
2288 | clevermous | 632 | pop edx eax |
633 | ret |
||
3712 | mario79 | 634 | ;----------------------------------------------------------------------------- |
3762 | mario79 | 635 | irq14_num equ byte 14 |
636 | irq15_num equ byte 15 |
||
637 | ;----------------------------------------------------------------------------- |
||
2288 | clevermous | 638 | align 4 |
639 | wait_for_sector_dma_ide0: |
||
640 | push eax |
||
641 | push edx |
||
642 | call save_hd_wait_timeout |
||
3712 | mario79 | 643 | ;-------------------------------------- |
644 | align 4 |
||
2288 | clevermous | 645 | .wait: |
646 | call change_task |
||
4700 | mario79 | 647 | |
3870 | mario79 | 648 | cmp [IDE_common_irq_param], 0 |
649 | jz .done |
||
3762 | mario79 | 650 | |
2288 | clevermous | 651 | call check_hd_wait_timeout |
4700 | mario79 | 652 | |
2288 | clevermous | 653 | cmp [hd_error], 0 |
654 | jz .wait |
||
4700 | mario79 | 655 | |
3762 | mario79 | 656 | mov [IDE_common_irq_param], 0 |
3881 | mario79 | 657 | ;-------------------------------------- |
2288 | clevermous | 658 | .done: |
659 | pop edx |
||
660 | pop eax |
||
661 | ret |
||
3712 | mario79 | 662 | ;----------------------------------------------------------------------------- |
2288 | clevermous | 663 | align 4 |
664 | wait_for_sector_dma_ide1: |
||
665 | push eax |
||
666 | push edx |
||
667 | call save_hd_wait_timeout |
||
3712 | mario79 | 668 | ;-------------------------------------- |
669 | align 4 |
||
2288 | clevermous | 670 | .wait: |
671 | call change_task |
||
4700 | mario79 | 672 | |
3870 | mario79 | 673 | cmp [IDE_common_irq_param], 0 |
674 | jz .done |
||
3762 | mario79 | 675 | |
2288 | clevermous | 676 | call check_hd_wait_timeout |
4700 | mario79 | 677 | |
2288 | clevermous | 678 | cmp [hd_error], 0 |
679 | jz .wait |
||
4700 | mario79 | 680 | |
3762 | mario79 | 681 | mov [IDE_common_irq_param], 0 |
3881 | mario79 | 682 | ;-------------------------------------- |
2288 | clevermous | 683 | .done: |
684 | pop edx |
||
685 | pop eax |
||
686 | ret |
||
3712 | mario79 | 687 | ;----------------------------------------------------------------------------- |
2288 | clevermous | 688 | iglobal |
689 | align 4 |
||
4700 | mario79 | 690 | ; note that IDE descriptor table must be 4-byte aligned |
691 | ; and do not cross 4K boundary |
||
2288 | clevermous | 692 | IDE_descriptor_table: |
3712 | mario79 | 693 | dd IDE_DMA |
694 | dw 0x2000 |
||
695 | dw 0x8000 |
||
2288 | clevermous | 696 | |
3712 | mario79 | 697 | dma_cur_sector dd not 40h |
698 | dma_hdpos dd 0 |
||
3762 | mario79 | 699 | IDE_common_irq_param db 0 |
2288 | clevermous | 700 | endg |
3712 | mario79 | 701 | ;----------------------------------------------------------------------------- |
2288 | clevermous | 702 | uglobal |
703 | ; all uglobals are zeroed at boot |
||
3712 | mario79 | 704 | cache_chain_ptr dd 0 |
705 | cache_chain_size db 0 |
||
706 | allow_dma_access db 0 |
||
2288 | clevermous | 707 | endg |
3712 | mario79 | 708 | ;----------------------------------------------------------------------------- |
2288 | clevermous | 709 | align 4 |
3870 | mario79 | 710 | IDE_irq_14_handler: |
4838 | mario79 | 711 | ; DEBUGF 1, 'K : IDE_irq_14_handler %x\n', [IDE_common_irq_param]:2 |
3870 | mario79 | 712 | cmp [IDE_common_irq_param], irq14_num |
713 | jne .exit |
||
714 | |||
2288 | clevermous | 715 | pushfd |
716 | cli |
||
717 | pushad |
||
3870 | mario79 | 718 | mov [IDE_common_irq_param], 0 |
4700 | mario79 | 719 | mov ecx, [IDE_controller_pointer] |
720 | mov dx, [ecx+IDE_DATA.RegsBaseAddres] |
||
4291 | mario79 | 721 | ; test whether it is our interrupt? |
722 | add edx, 2 |
||
723 | in al, dx |
||
724 | test al, 100b |
||
725 | jz @f |
||
3881 | mario79 | 726 | ; clear Bus Master IDE Status register |
727 | ; clear Interrupt bit |
||
728 | out dx, al |
||
4291 | mario79 | 729 | ; clear Bus Master IDE Command register |
730 | sub edx, 2 |
||
731 | xor eax, eax |
||
732 | out dx, al |
||
733 | ; read status register and remove the interrupt request |
||
734 | mov edx, [hdbase] |
||
735 | add edx, 0x7 |
||
736 | in al, dx |
||
3870 | mario79 | 737 | popad |
738 | popfd |
||
4291 | mario79 | 739 | mov al, 1 |
740 | ret |
||
3881 | mario79 | 741 | ;-------------------------------------- |
4291 | mario79 | 742 | @@: |
743 | popad |
||
744 | popfd |
||
745 | ;-------------------------------------- |
||
3870 | mario79 | 746 | .exit: |
4291 | mario79 | 747 | mov al, 0 |
3870 | mario79 | 748 | ret |
749 | ;----------------------------------------------------------------------------- |
||
2288 | clevermous | 750 | align 4 |
3870 | mario79 | 751 | IDE_irq_15_handler: |
4838 | mario79 | 752 | ; DEBUGF 1, 'K : IDE_irq_15_handler %x\n', [IDE_common_irq_param]:2 |
3870 | mario79 | 753 | cmp [IDE_common_irq_param], irq15_num |
754 | jne .exit |
||
755 | |||
756 | pushfd |
||
757 | cli |
||
758 | pushad |
||
759 | mov [IDE_common_irq_param], 0 |
||
4700 | mario79 | 760 | mov ecx, [IDE_controller_pointer] |
761 | mov dx, [ecx+IDE_DATA.RegsBaseAddres] |
||
2288 | clevermous | 762 | add dx, 8 |
4291 | mario79 | 763 | ; test whether it is our interrupt? |
764 | add edx, 2 |
||
765 | in al, dx |
||
766 | test al, 100b |
||
767 | jz @f |
||
3881 | mario79 | 768 | ; clear Bus Master IDE Status register |
769 | ; clear Interrupt bit |
||
770 | out dx, al |
||
4291 | mario79 | 771 | ; clear Bus Master IDE Command register |
772 | sub edx, 2 |
||
773 | mov al, 0 |
||
774 | out dx, al |
||
775 | ; read status register and remove the interrupt request |
||
776 | mov edx, [hdbase] |
||
777 | add edx, 0x7 |
||
778 | in al, dx |
||
3870 | mario79 | 779 | popad |
780 | popfd |
||
4291 | mario79 | 781 | mov al, 1 |
782 | ret |
||
3881 | mario79 | 783 | ;-------------------------------------- |
4291 | mario79 | 784 | @@: |
785 | popad |
||
786 | popfd |
||
787 | ;-------------------------------------- |
||
3870 | mario79 | 788 | .exit: |
4291 | mario79 | 789 | mov al, 0 |
3870 | mario79 | 790 | ret |
791 | ;----------------------------------------------------------------------------- |
||
792 | align 4 |
||
793 | IDE_common_irq_handler: |
||
4838 | mario79 | 794 | ; DEBUGF 1, 'K : IDE_common_irq_handler %x\n', [IDE_common_irq_param]:2 |
4839 | mario79 | 795 | pushfd |
796 | cli |
||
3870 | mario79 | 797 | cmp [IDE_common_irq_param], 0 |
798 | je .exit |
||
799 | |||
800 | pushad |
||
801 | xor ebx, ebx |
||
4700 | mario79 | 802 | mov ecx, [IDE_controller_pointer] |
803 | mov dx, [ecx+IDE_DATA.RegsBaseAddres] |
||
3870 | mario79 | 804 | mov eax, IDE_common_irq_param |
805 | cmp [eax], irq14_num |
||
806 | mov [eax], bl |
||
807 | je @f |
||
808 | |||
809 | add dx, 8 |
||
3762 | mario79 | 810 | ;-------------------------------------- |
3870 | mario79 | 811 | @@: |
4291 | mario79 | 812 | ; test whether it is our interrupt? |
813 | add edx, 2 |
||
814 | in al, dx |
||
815 | test al, 100b |
||
816 | jz @f |
||
3881 | mario79 | 817 | ; clear Bus Master IDE Status register |
818 | ; clear Interrupt bit |
||
819 | out dx, al |
||
4291 | mario79 | 820 | ; clear Bus Master IDE Command register |
821 | sub edx, 2 |
||
822 | xor eax, eax |
||
823 | out dx, al |
||
824 | ; read status register and remove the interrupt request |
||
825 | mov edx, [hdbase] |
||
826 | add edx, 0x7 |
||
827 | in al, dx |
||
2288 | clevermous | 828 | popad |
829 | popfd |
||
4291 | mario79 | 830 | mov al, 1 |
831 | ret |
||
3881 | mario79 | 832 | ;-------------------------------------- |
4291 | mario79 | 833 | @@: |
834 | popad |
||
835 | ;-------------------------------------- |
||
3870 | mario79 | 836 | .exit: |
4839 | mario79 | 837 | popfd |
4291 | mario79 | 838 | mov al, 0 |
2288 | clevermous | 839 | ret |
3712 | mario79 | 840 | ;----------------------------------------------------------------------------- |
2288 | clevermous | 841 | align 4 |
842 | hd_read_dma: |
||
843 | push eax |
||
844 | push edx |
||
845 | mov edx, [dma_hdpos] |
||
846 | cmp edx, [hdpos] |
||
847 | jne .notread |
||
4700 | mario79 | 848 | |
2288 | clevermous | 849 | mov edx, [dma_cur_sector] |
850 | cmp eax, edx |
||
851 | jb .notread |
||
4700 | mario79 | 852 | |
2288 | clevermous | 853 | add edx, 15 |
854 | cmp [esp+4], edx |
||
855 | ja .notread |
||
4700 | mario79 | 856 | |
2288 | clevermous | 857 | mov eax, [esp+4] |
858 | sub eax, [dma_cur_sector] |
||
859 | shl eax, 9 |
||
860 | add eax, (OS_BASE+IDE_DMA) |
||
4700 | mario79 | 861 | |
3742 | clevermous | 862 | push ecx esi |
2288 | clevermous | 863 | mov esi, eax |
864 | mov ecx, 512/4 |
||
865 | cld |
||
866 | rep movsd |
||
3742 | clevermous | 867 | pop esi ecx |
4700 | mario79 | 868 | |
2288 | clevermous | 869 | pop edx |
870 | pop eax |
||
871 | ret |
||
4700 | mario79 | 872 | ;-------------------------------------- |
2288 | clevermous | 873 | .notread: |
3870 | mario79 | 874 | ; set data for PRD Table |
2288 | clevermous | 875 | mov eax, IDE_descriptor_table |
876 | mov dword [eax], IDE_DMA |
||
877 | mov word [eax+4], 0x2000 |
||
878 | sub eax, OS_BASE |
||
3870 | mario79 | 879 | ; select controller Primary or Secondary |
4720 | mario79 | 880 | mov ecx, [IDE_controller_pointer] |
4700 | mario79 | 881 | mov dx, [ecx+IDE_DATA.RegsBaseAddres] |
882 | |||
3774 | mario79 | 883 | push eax |
4700 | mario79 | 884 | mov eax, [hdpos] |
885 | dec eax |
||
886 | test eax, 10b |
||
3774 | mario79 | 887 | pop eax |
2288 | clevermous | 888 | jz @f |
4700 | mario79 | 889 | |
2288 | clevermous | 890 | add edx, 8 |
4700 | mario79 | 891 | ;-------------------------------------- |
2288 | clevermous | 892 | @@: |
893 | push edx |
||
3870 | mario79 | 894 | ; Bus Master IDE PRD Table Address |
2288 | clevermous | 895 | add edx, 4 |
3870 | mario79 | 896 | ; save IDE_descriptor_table |
2288 | clevermous | 897 | out dx, eax |
898 | pop edx |
||
3870 | mario79 | 899 | ; clear Bus Master IDE Command register |
2288 | clevermous | 900 | mov al, 0 |
901 | out dx, al |
||
3870 | mario79 | 902 | ; clear Bus Master IDE Status register |
903 | ; clear Error bit and Interrupt bit |
||
2288 | clevermous | 904 | add edx, 2 |
3870 | mario79 | 905 | mov al, 6 ; 110b |
2288 | clevermous | 906 | out dx, al |
3712 | mario79 | 907 | ; Select the desired drive |
908 | mov edx, [hdbase] |
||
909 | add edx, 6 ; адрес регистра головок |
||
910 | mov al, byte [hdid] |
||
911 | add al, 128+64+32 |
||
912 | out dx, al ; номер головки/номер диска |
||
913 | |||
2288 | clevermous | 914 | call wait_for_hd_idle |
4700 | mario79 | 915 | |
2288 | clevermous | 916 | cmp [hd_error], 0 |
917 | jnz hd_read_error |
||
3712 | mario79 | 918 | ; ATA with 28 or 48 bit for sector number? |
919 | mov eax, [esp+4] |
||
920 | ; -10h because the PreCache hits the boundary between lba28 and lba48 |
||
921 | ; 10h = 16 - size of PreCache |
||
922 | cmp eax, 0x10000000-10h |
||
923 | jae .lba48 |
||
924 | ;-------------------------------------- |
||
925 | .lba28: |
||
926 | pushfd |
||
927 | cli |
||
2288 | clevermous | 928 | xor eax, eax |
929 | mov edx, [hdbase] |
||
930 | inc edx |
||
3712 | mario79 | 931 | out dx, al ; ATA Features регистр "особенностей" |
2288 | clevermous | 932 | inc edx |
3712 | mario79 | 933 | mov eax, 10h ; Sector Counter = 16 ; PreCache |
934 | out dx, al ; ATA Sector Counter счётчик секторов |
||
2288 | clevermous | 935 | inc edx |
3712 | mario79 | 936 | mov eax, [esp+4+4] |
937 | out dx, al ; LBA Low LBA (7:0) |
||
2288 | clevermous | 938 | shr eax, 8 |
939 | inc edx |
||
3712 | mario79 | 940 | out dx, al ; LBA Mid LBA (15:8) |
2288 | clevermous | 941 | shr eax, 8 |
942 | inc edx |
||
3712 | mario79 | 943 | out dx, al ; LBA High LBA (23:16) |
2288 | clevermous | 944 | shr eax, 8 |
945 | inc edx |
||
3712 | mario79 | 946 | and al, 0xF ; LBA (27:24) |
2288 | clevermous | 947 | add al, byte [hdid] |
948 | add al, 11100000b |
||
3712 | mario79 | 949 | out dx, al ; номер головки/номер диска |
2288 | clevermous | 950 | inc edx |
3712 | mario79 | 951 | mov al, 0xC8 ; READ DMA |
952 | out dx, al ; ATACommand регистр команд |
||
953 | jmp .continue |
||
954 | ;-------------------------------------- |
||
955 | .lba48: |
||
956 | pushfd |
||
957 | cli |
||
958 | xor eax, eax |
||
959 | mov edx, [hdbase] |
||
960 | inc edx |
||
961 | out dx, al ; Features Previous Reserved |
||
962 | out dx, al ; Features Current Reserved |
||
963 | inc edx |
||
964 | out dx, al ; Sector Count Previous Sector count (15:8) |
||
965 | mov eax, 10h ; Sector Counter = 16 PreCache |
||
966 | out dx, al ; Sector Count Current Sector count (7:0) |
||
967 | inc edx |
||
968 | mov eax, [esp+4+4] |
||
969 | rol eax, 8 |
||
970 | out dx, al ; LBA Low Previous LBA (31:24) |
||
971 | xor eax, eax ; because only 32 bit cache |
||
972 | inc edx |
||
973 | out dx, al ; LBA Mid Previous LBA (39:32) |
||
974 | inc edx |
||
975 | out dx, al ; LBA High Previous LBA (47:40) |
||
976 | sub edx, 2 |
||
977 | mov eax, [esp+4+4] |
||
978 | out dx, al ; LBA Low Current LBA (7:0) |
||
979 | shr eax, 8 |
||
980 | inc edx |
||
981 | out dx, al ; LBA Mid Current LBA (15:8) |
||
982 | shr eax, 8 |
||
983 | inc edx |
||
984 | out dx, al ; LBA High Current LBA (23:16) |
||
985 | inc edx |
||
986 | mov al, byte [hdid] |
||
987 | add al, 128+64+32 |
||
988 | out dx, al ; номер головки/номер диска |
||
989 | inc edx |
||
990 | mov al, 25h ; READ DMA EXT |
||
991 | out dx, al ; ATACommand регистр команд |
||
992 | ;-------------------------------------- |
||
993 | .continue: |
||
3870 | mario79 | 994 | ; select controller Primary or Secondary |
4700 | mario79 | 995 | mov ecx, [IDE_controller_pointer] |
996 | mov dx, [ecx+IDE_DATA.RegsBaseAddres] |
||
997 | |||
998 | mov eax, [hdpos] |
||
999 | dec eax |
||
1000 | test eax, 10b |
||
2288 | clevermous | 1001 | jz @f |
4700 | mario79 | 1002 | |
2288 | clevermous | 1003 | add dx, 8 |
4700 | mario79 | 1004 | ;-------------------------------------- |
2288 | clevermous | 1005 | @@: |
3870 | mario79 | 1006 | ; set write to memory and Start Bus Master |
2288 | clevermous | 1007 | mov al, 9 |
1008 | out dx, al |
||
3870 | mario79 | 1009 | |
4700 | mario79 | 1010 | mov eax, [hdpos] |
1011 | dec eax |
||
1012 | test eax, 10b |
||
2288 | clevermous | 1013 | jnz .ide1 |
3762 | mario79 | 1014 | |
1015 | mov [IDE_common_irq_param], irq14_num |
||
2288 | clevermous | 1016 | jmp @f |
4700 | mario79 | 1017 | ;-------------------------------------- |
2288 | clevermous | 1018 | .ide1: |
3762 | mario79 | 1019 | mov [IDE_common_irq_param], irq15_num |
4700 | mario79 | 1020 | ;-------------------------------------- |
2288 | clevermous | 1021 | @@: |
3712 | mario79 | 1022 | popfd |
3870 | mario79 | 1023 | ; wait for interrupt |
4700 | mario79 | 1024 | mov eax, [hdpos] |
1025 | dec eax |
||
1026 | test eax, 10b |
||
2288 | clevermous | 1027 | jnz .wait_ide1 |
4700 | mario79 | 1028 | |
2288 | clevermous | 1029 | call wait_for_sector_dma_ide0 |
1030 | jmp @f |
||
4700 | mario79 | 1031 | ;-------------------------------------- |
2288 | clevermous | 1032 | .wait_ide1: |
1033 | call wait_for_sector_dma_ide1 |
||
4700 | mario79 | 1034 | ;-------------------------------------- |
2288 | clevermous | 1035 | @@: |
1036 | cmp [hd_error], 0 |
||
1037 | jnz hd_read_error |
||
4700 | mario79 | 1038 | |
2288 | clevermous | 1039 | mov eax, [hdpos] |
1040 | mov [dma_hdpos], eax |
||
1041 | pop edx |
||
1042 | pop eax |
||
4700 | mario79 | 1043 | |
2288 | clevermous | 1044 | mov [dma_cur_sector], eax |
1045 | jmp hd_read_dma |
||
3712 | mario79 | 1046 | ;----------------------------------------------------------------------------- |
3742 | clevermous | 1047 | cache_write_dma: |
3881 | mario79 | 1048 | mov eax, [cache_chain_ptr] ; for what? |
2288 | clevermous | 1049 | push esi |
3881 | mario79 | 1050 | ; set data for PRD Table |
2288 | clevermous | 1051 | mov eax, IDE_descriptor_table |
1052 | mov edx, eax |
||
4700 | mario79 | 1053 | |
2288 | clevermous | 1054 | pusha |
1055 | mov edi, (OS_BASE+IDE_DMA) |
||
1056 | mov dword [edx], IDE_DMA |
||
1057 | movzx ecx, [cache_chain_size] |
||
1058 | shl ecx, 9 |
||
1059 | mov word [edx+4], cx |
||
1060 | shr ecx, 2 |
||
1061 | cld |
||
1062 | rep movsd |
||
1063 | popa |
||
4700 | mario79 | 1064 | |
2288 | clevermous | 1065 | sub eax, OS_BASE |
3881 | mario79 | 1066 | ; select controller Primary or Secondary |
4720 | mario79 | 1067 | mov ecx, [IDE_controller_pointer] |
4700 | mario79 | 1068 | mov dx, [ecx+IDE_DATA.RegsBaseAddres] |
1069 | |||
3774 | mario79 | 1070 | push eax |
4700 | mario79 | 1071 | mov eax, [hdpos] |
1072 | dec eax |
||
1073 | test eax, 10b |
||
3774 | mario79 | 1074 | pop eax |
2288 | clevermous | 1075 | jz @f |
4700 | mario79 | 1076 | |
2288 | clevermous | 1077 | add edx, 8 |
4700 | mario79 | 1078 | ;-------------------------------------- |
2288 | clevermous | 1079 | @@: |
1080 | push edx |
||
3881 | mario79 | 1081 | ; Bus Master IDE PRD Table Address |
2288 | clevermous | 1082 | add edx, 4 |
3881 | mario79 | 1083 | ; save IDE_descriptor_table |
2288 | clevermous | 1084 | out dx, eax |
1085 | pop edx |
||
3881 | mario79 | 1086 | ; clear Bus Master IDE Command register |
2288 | clevermous | 1087 | mov al, 0 |
1088 | out dx, al |
||
3881 | mario79 | 1089 | ; clear Bus Master IDE Status register |
1090 | ; clear Error bit and Interrupt bit |
||
2288 | clevermous | 1091 | add edx, 2 |
1092 | mov al, 6 |
||
1093 | out dx, al |
||
3712 | mario79 | 1094 | ; Select the desired drive |
1095 | mov edx, [hdbase] |
||
1096 | add edx, 6 ; адрес регистра головок |
||
1097 | mov al, byte [hdid] |
||
1098 | add al, 128+64+32 |
||
1099 | out dx, al ; номер головки/номер диска |
||
1100 | |||
2288 | clevermous | 1101 | call wait_for_hd_idle |
4700 | mario79 | 1102 | |
2288 | clevermous | 1103 | cmp [hd_error], 0 |
1104 | jnz hd_write_error_dma |
||
3712 | mario79 | 1105 | ; ATA with 28 or 48 bit for sector number? |
1106 | mov esi, [cache_chain_ptr] |
||
1107 | mov eax, [esi] |
||
1108 | ; -40h because the PreCache hits the boundary between lba28 and lba48 |
||
1109 | ; 40h = 64 - the maximum number of sectors to be written for one command |
||
1110 | cmp eax, 0x10000000-40h |
||
1111 | jae .lba48 |
||
1112 | ;-------------------------------------- |
||
1113 | .lba28: |
||
1114 | pushfd |
||
1115 | cli |
||
2288 | clevermous | 1116 | xor eax, eax |
1117 | mov edx, [hdbase] |
||
1118 | inc edx |
||
3712 | mario79 | 1119 | out dx, al ; ATA Features регистр "особенностей" |
2288 | clevermous | 1120 | inc edx |
3712 | mario79 | 1121 | mov al, [cache_chain_size] ; Sector Counter |
1122 | out dx, al ; ATA Sector Counter счётчик секторов |
||
2288 | clevermous | 1123 | inc edx |
1124 | mov eax, [esi] |
||
3712 | mario79 | 1125 | out dx, al ; LBA Low LBA (7:0) |
2288 | clevermous | 1126 | shr eax, 8 |
1127 | inc edx |
||
3712 | mario79 | 1128 | out dx, al ; LBA Mid LBA (15:8) |
2288 | clevermous | 1129 | shr eax, 8 |
1130 | inc edx |
||
3712 | mario79 | 1131 | out dx, al ; LBA High LBA (23:16) |
2288 | clevermous | 1132 | shr eax, 8 |
1133 | inc edx |
||
3712 | mario79 | 1134 | and al, 0xF ; LBA (27:24) |
2288 | clevermous | 1135 | add al, byte [hdid] |
1136 | add al, 11100000b |
||
3712 | mario79 | 1137 | out dx, al ; номер головки/номер диска |
2288 | clevermous | 1138 | inc edx |
3712 | mario79 | 1139 | mov al, 0xCA ; WRITE DMA |
1140 | out dx, al ; ATACommand регистр команд |
||
1141 | jmp .continue |
||
1142 | ;-------------------------------------- |
||
1143 | .lba48: |
||
1144 | pushfd |
||
1145 | cli |
||
1146 | xor eax, eax |
||
1147 | mov edx, [hdbase] |
||
1148 | inc edx |
||
1149 | out dx, al ; Features Previous Reserved |
||
1150 | out dx, al ; Features Current Reserved |
||
1151 | inc edx |
||
1152 | out dx, al ; Sector Count Previous Sector count (15:8) |
||
1153 | mov al, [cache_chain_size] ; Sector Counter |
||
1154 | out dx, al ; Sector Count Current Sector count (7:0) |
||
1155 | inc edx |
||
1156 | mov eax, [esi] |
||
1157 | rol eax, 8 |
||
1158 | out dx, al ; LBA Low Previous LBA (31:24) |
||
1159 | xor eax, eax ; because only 32 bit cache |
||
1160 | inc edx |
||
1161 | out dx, al ; LBA Mid Previous LBA (39:32) |
||
1162 | inc edx |
||
1163 | out dx, al ; LBA High Previous LBA (47:40) |
||
1164 | sub edx, 2 |
||
1165 | mov eax, [esi] |
||
1166 | out dx, al ; LBA Low Current LBA (7:0) |
||
1167 | shr eax, 8 |
||
1168 | inc edx |
||
1169 | out dx, al ; LBA Mid Current LBA (15:8) |
||
1170 | shr eax, 8 |
||
1171 | inc edx |
||
1172 | out dx, al ; LBA High Current LBA (23:16) |
||
1173 | inc edx |
||
1174 | mov al, byte [hdid] |
||
1175 | add al, 128+64+32 |
||
1176 | out dx, al ; номер головки/номер диска |
||
1177 | inc edx |
||
1178 | mov al, 35h ; WRITE DMA EXT |
||
1179 | out dx, al ; ATACommand регистр команд |
||
1180 | ;-------------------------------------- |
||
1181 | .continue: |
||
3881 | mario79 | 1182 | ; select controller Primary or Secondary |
4700 | mario79 | 1183 | mov ecx, [IDE_controller_pointer] |
1184 | mov dx, [ecx+IDE_DATA.RegsBaseAddres] |
||
1185 | |||
1186 | mov eax, [hdpos] |
||
1187 | dec eax |
||
1188 | test eax, 10b |
||
2288 | clevermous | 1189 | jz @f |
4700 | mario79 | 1190 | |
2288 | clevermous | 1191 | add dx, 8 |
4700 | mario79 | 1192 | ;-------------------------------------- |
2288 | clevermous | 1193 | @@: |
3881 | mario79 | 1194 | ; set write to device and Start Bus Master |
2288 | clevermous | 1195 | mov al, 1 |
1196 | out dx, al |
||
4700 | mario79 | 1197 | |
1198 | mov eax, [hdpos] |
||
1199 | dec eax |
||
1200 | test eax, 10b |
||
2288 | clevermous | 1201 | jnz .ide1 |
3762 | mario79 | 1202 | |
1203 | mov [IDE_common_irq_param], irq14_num |
||
2288 | clevermous | 1204 | jmp @f |
4700 | mario79 | 1205 | ;-------------------------------------- |
2288 | clevermous | 1206 | .ide1: |
3762 | mario79 | 1207 | mov [IDE_common_irq_param], irq15_num |
4700 | mario79 | 1208 | ;-------------------------------------- |
2288 | clevermous | 1209 | @@: |
3712 | mario79 | 1210 | popfd |
3881 | mario79 | 1211 | ; wait for interrupt |
2288 | clevermous | 1212 | mov [dma_cur_sector], not 0x40 |
4700 | mario79 | 1213 | |
1214 | mov eax, [hdpos] |
||
1215 | dec eax |
||
1216 | test eax, 10b |
||
2288 | clevermous | 1217 | jnz .wait_ide1 |
4700 | mario79 | 1218 | |
2288 | clevermous | 1219 | call wait_for_sector_dma_ide0 |
4700 | mario79 | 1220 | |
2288 | clevermous | 1221 | jmp @f |
4700 | mario79 | 1222 | ;-------------------------------------- |
2288 | clevermous | 1223 | .wait_ide1: |
1224 | call wait_for_sector_dma_ide1 |
||
4700 | mario79 | 1225 | ;-------------------------------------- |
2288 | clevermous | 1226 | @@: |
1227 | cmp [hd_error], 0 |
||
1228 | jnz hd_write_error_dma |
||
1229 | pop esi |
||
1230 | ret |
||
3712 | mario79 | 1231 | ;----------------------------------------------------------------------------- |
4578 | clevermous | 1232 | proc clear_pci_ide_interrupts |
1233 | mov esi, pcidev_list |
||
4700 | mario79 | 1234 | ;-------------------------------------- |
1235 | align 4 |
||
4578 | clevermous | 1236 | .loop: |
1237 | mov esi, [esi+PCIDEV.fd] |
||
1238 | cmp esi, pcidev_list |
||
1239 | jz .done |
||
4700 | mario79 | 1240 | |
4720 | mario79 | 1241 | ; cmp [esi+PCIDEV.class], 0x01018F |
1242 | mov eax, [esi+PCIDEV.class] |
||
1243 | shr eax, 4 |
||
1244 | cmp eax, 0x01018 |
||
4578 | clevermous | 1245 | jnz .loop |
4700 | mario79 | 1246 | |
4578 | clevermous | 1247 | mov ah, [esi+PCIDEV.bus] |
1248 | mov al, 2 |
||
1249 | mov bh, [esi+PCIDEV.devfn] |
||
1250 | mov bl, 0x20 |
||
1251 | call pci_read_reg |
||
4700 | mario79 | 1252 | |
4578 | clevermous | 1253 | and eax, 0FFFCh |
1254 | mov edx, eax |
||
1255 | add edx, 2 |
||
1256 | in al, dx |
||
1257 | DEBUGF 1,'K : clear_pci_ide_interrupts: port[%x] = %x ',dx,al |
||
1258 | out dx, al |
||
1259 | in al, dx |
||
1260 | DEBUGF 1,'-> %x; ',al |
||
1261 | add edx, 8 |
||
1262 | in al, dx |
||
1263 | DEBUGF 1,'port[%x] = %x ',dx,al |
||
1264 | out dx, al |
||
1265 | in al, dx |
||
1266 | DEBUGF 1,'-> %x\n',al |
||
1267 | jmp .loop |
||
4700 | mario79 | 1268 | ;-------------------------------------- |
4578 | clevermous | 1269 | .done: |
1270 | ret |
||
1271 | endp |
||
4700 | mario79 | 1272 | ;----------------------------------------------------------------------------- |