forked from KolibriOS/kolibrios
1186 lines
34 KiB
PHP
1186 lines
34 KiB
PHP
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
|
;; ;;
|
|
;; Copyright (C) KolibriOS team 2004-2013. All rights reserved. ;;
|
|
;; Distributed under terms of the GNU General Public License ;;
|
|
;; ;;
|
|
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
|
|
|
|
$Revision$
|
|
|
|
|
|
; Low-level driver for HDD access
|
|
; DMA support by Mario79
|
|
; LBA48 support by Mario79
|
|
;-----------------------------------------------------------------------------
|
|
struct HD_DATA
|
|
hdbase dd ?
|
|
hdid dd ?
|
|
hdpos dd ?
|
|
ends
|
|
|
|
iglobal
|
|
align 4
|
|
ide_callbacks:
|
|
dd ide_callbacks.end - ide_callbacks ; strucsize
|
|
dd 0 ; no close function
|
|
dd 0 ; no closemedia function
|
|
dd ide_querymedia
|
|
dd ide_read
|
|
dd ide_write
|
|
dd 0 ; no flush function
|
|
dd 0 ; use default cache size
|
|
.end:
|
|
|
|
hd0_data HD_DATA ?, 0, 1
|
|
hd1_data HD_DATA ?, 0x10, 2
|
|
hd2_data HD_DATA ?, 0, 3
|
|
hd3_data HD_DATA ?, 0x10, 4
|
|
|
|
hd_address_table:
|
|
dd 0x1f0, 0x00, 0x1f0, 0x10
|
|
dd 0x170, 0x00, 0x170, 0x10
|
|
endg
|
|
|
|
uglobal
|
|
ide_mutex MUTEX
|
|
ide_channel1_mutex MUTEX
|
|
ide_channel2_mutex MUTEX
|
|
endg
|
|
|
|
proc ide_read stdcall uses edi, \
|
|
hd_data, buffer, startsector:qword, numsectors
|
|
; hd_data = pointer to hd*_data
|
|
; buffer = pointer to buffer for data
|
|
; startsector = 64-bit start sector
|
|
; numsectors = pointer to number of sectors on input,
|
|
; must be filled with number of sectors really read
|
|
locals
|
|
sectors_todo dd ?
|
|
channel_lock dd ?
|
|
endl
|
|
; 1. Initialize number of sectors: get number of requested sectors
|
|
; and say that no sectors were read yet.
|
|
mov ecx, [numsectors]
|
|
mov eax, [ecx]
|
|
mov dword [ecx], 0
|
|
mov [sectors_todo], eax
|
|
; 2. Acquire the global lock.
|
|
mov ecx, ide_mutex
|
|
call mutex_lock
|
|
mov ecx, ide_channel2_mutex
|
|
mov eax, [hd_data]
|
|
push ecx
|
|
mov ecx, [hd_address_table]
|
|
cmp [eax+HD_DATA.hdbase], ecx ; 0x1F0
|
|
pop ecx
|
|
jne .IDE_Channel_2
|
|
mov ecx, ide_channel1_mutex
|
|
.IDE_Channel_2:
|
|
mov [channel_lock], ecx
|
|
call mutex_lock
|
|
; 3. Convert parameters to the form suitable for worker procedures.
|
|
; Underlying procedures do not know about 64-bit sectors.
|
|
; Worker procedures use global variables and edi for [buffer].
|
|
cmp dword [startsector+4], 0
|
|
jnz .fail
|
|
and [hd_error], 0
|
|
mov ecx, [hd_data]
|
|
mov eax, [ecx+HD_DATA.hdbase]
|
|
mov [hdbase], eax
|
|
mov eax, [ecx+HD_DATA.hdid]
|
|
mov [hdid], eax
|
|
mov eax, [ecx+HD_DATA.hdpos]
|
|
mov [hdpos], eax
|
|
mov eax, dword [startsector]
|
|
mov edi, [buffer]
|
|
; 4. Worker procedures take one sectors per time, so loop over all sectors to read.
|
|
.sectors_loop:
|
|
; DMA read is permitted if [allow_dma_access]=1 or 2
|
|
cmp [allow_dma_access], 2
|
|
ja .nodma
|
|
cmp [dma_hdd], 1
|
|
jnz .nodma
|
|
;--------------------------------------
|
|
push eax
|
|
mov eax, [hd_address_table]
|
|
cmp [hdbase], eax ; 0x1F0
|
|
pop eax
|
|
jnz @f
|
|
|
|
test [DRIVE_DATA+1], byte 10100000b
|
|
jnz .nodma
|
|
|
|
jmp .dma
|
|
@@:
|
|
test [DRIVE_DATA+1], byte 1010b
|
|
jnz .nodma
|
|
.dma:
|
|
;--------------------------------------
|
|
call hd_read_dma
|
|
jmp @f
|
|
.nodma:
|
|
call hd_read_pio
|
|
@@:
|
|
cmp [hd_error], 0
|
|
jnz .fail
|
|
mov ecx, [numsectors]
|
|
inc dword [ecx] ; one more sector is read
|
|
dec [sectors_todo]
|
|
jz .done
|
|
inc eax
|
|
jnz .sectors_loop
|
|
; 5. Loop is done, either due to error or because everything is done.
|
|
; Release the global lock and return the corresponding status.
|
|
.fail:
|
|
mov ecx, [channel_lock]
|
|
call mutex_unlock
|
|
mov ecx, ide_mutex
|
|
call mutex_unlock
|
|
or eax, -1
|
|
ret
|
|
.done:
|
|
mov ecx, [channel_lock]
|
|
call mutex_unlock
|
|
mov ecx, ide_mutex
|
|
call mutex_unlock
|
|
xor eax, eax
|
|
ret
|
|
endp
|
|
|
|
proc ide_write stdcall uses esi edi, \
|
|
hd_data, buffer, startsector:qword, numsectors
|
|
; hd_data = pointer to hd*_data
|
|
; buffer = pointer to buffer with data
|
|
; startsector = 64-bit start sector
|
|
; numsectors = pointer to number of sectors on input,
|
|
; must be filled with number of sectors really written
|
|
locals
|
|
sectors_todo dd ?
|
|
channel_lock dd ?
|
|
endl
|
|
; 1. Initialize number of sectors: get number of requested sectors
|
|
; and say that no sectors were read yet.
|
|
mov ecx, [numsectors]
|
|
mov eax, [ecx]
|
|
mov dword [ecx], 0
|
|
mov [sectors_todo], eax
|
|
; 2. Acquire the global lock.
|
|
mov ecx, ide_mutex
|
|
call mutex_lock
|
|
mov ecx, ide_channel2_mutex
|
|
mov eax, [hd_data]
|
|
push ecx
|
|
mov ecx, [hd_address_table]
|
|
cmp [eax+HD_DATA.hdbase], ecx ; 0x1F0
|
|
pop ecx
|
|
jne .IDE_Channel_2
|
|
mov ecx, ide_channel1_mutex
|
|
.IDE_Channel_2:
|
|
mov [channel_lock], ecx
|
|
call mutex_lock
|
|
; 3. Convert parameters to the form suitable for worker procedures.
|
|
; Underlying procedures do not know about 64-bit sectors.
|
|
; Worker procedures use global variables and esi for [buffer].
|
|
cmp dword [startsector+4], 0
|
|
jnz .fail
|
|
and [hd_error], 0
|
|
mov ecx, [hd_data]
|
|
mov eax, [ecx+HD_DATA.hdbase]
|
|
mov [hdbase], eax
|
|
mov eax, [ecx+HD_DATA.hdid]
|
|
mov [hdid], eax
|
|
mov eax, [ecx+HD_DATA.hdpos]
|
|
mov [hdpos], eax
|
|
mov esi, [buffer]
|
|
lea edi, [startsector]
|
|
mov [cache_chain_ptr], edi
|
|
; 4. Worker procedures take max 16 sectors per time,
|
|
; loop until all sectors will be processed.
|
|
.sectors_loop:
|
|
mov ecx, 16
|
|
cmp ecx, [sectors_todo]
|
|
jbe @f
|
|
mov ecx, [sectors_todo]
|
|
@@:
|
|
mov [cache_chain_size], cl
|
|
; DMA write is permitted only if [allow_dma_access]=1
|
|
cmp [allow_dma_access], 2
|
|
jae .nodma
|
|
cmp [dma_hdd], 1
|
|
jnz .nodma
|
|
;--------------------------------------
|
|
push eax
|
|
mov eax, [hd_address_table]
|
|
cmp [hdbase], eax ; 0x1F0
|
|
pop eax
|
|
jnz @f
|
|
|
|
test [DRIVE_DATA+1], byte 10100000b
|
|
jnz .nodma
|
|
|
|
jmp .dma
|
|
@@:
|
|
test [DRIVE_DATA+1], byte 1010b
|
|
jnz .nodma
|
|
.dma:
|
|
;--------------------------------------
|
|
call cache_write_dma
|
|
jmp .common
|
|
.nodma:
|
|
mov [cache_chain_size], 1
|
|
call cache_write_pio
|
|
.common:
|
|
cmp [hd_error], 0
|
|
jnz .fail
|
|
movzx ecx, [cache_chain_size]
|
|
mov eax, [numsectors]
|
|
add [eax], ecx
|
|
sub [sectors_todo], ecx
|
|
jz .done
|
|
add [edi], ecx
|
|
jc .fail
|
|
shl ecx, 9
|
|
add esi, ecx
|
|
jmp .sectors_loop
|
|
; 5. Loop is done, either due to error or because everything is done.
|
|
; Release the global lock and return the corresponding status.
|
|
.fail:
|
|
mov ecx, [channel_lock]
|
|
call mutex_unlock
|
|
mov ecx, ide_mutex
|
|
call mutex_unlock
|
|
or eax, -1
|
|
ret
|
|
.done:
|
|
mov ecx, [channel_lock]
|
|
call mutex_unlock
|
|
mov ecx, ide_mutex
|
|
call mutex_unlock
|
|
xor eax, eax
|
|
ret
|
|
endp
|
|
|
|
; This is a stub.
|
|
proc ide_querymedia stdcall, hd_data, mediainfo
|
|
mov eax, [mediainfo]
|
|
mov [eax+DISKMEDIAINFO.Flags], 0
|
|
mov [eax+DISKMEDIAINFO.SectorSize], 512
|
|
or dword [eax+DISKMEDIAINFO.Capacity], 0xFFFFFFFF
|
|
or dword [eax+DISKMEDIAINFO.Capacity+4], 0xFFFFFFFF
|
|
xor eax, eax
|
|
ret
|
|
endp
|
|
|
|
;-----------------------------------------------------------------------------
|
|
align 4
|
|
; input: eax = sector, edi -> buffer
|
|
; output: edi = edi + 512
|
|
hd_read_pio:
|
|
push eax edx
|
|
|
|
; Select the desired drive
|
|
mov edx, [hdbase]
|
|
add edx, 6 ;адрес регистра головок
|
|
mov al, byte [hdid]
|
|
add al, 128+64+32
|
|
out dx, al; номер головки/номер диска
|
|
|
|
call wait_for_hd_idle
|
|
cmp [hd_error], 0
|
|
jne hd_read_error
|
|
|
|
; ATA with 28 or 48 bit for sector number?
|
|
mov eax, [esp+4]
|
|
cmp eax, 0x10000000
|
|
jae .lba48
|
|
;--------------------------------------
|
|
.lba28:
|
|
pushfd
|
|
cli
|
|
xor eax, eax
|
|
mov edx, [hdbase]
|
|
inc edx
|
|
out dx, al ; ATA Features регистр "особенностей"
|
|
inc edx
|
|
inc eax
|
|
out dx, al ; ATA Sector Counter счётчик секторов
|
|
inc edx
|
|
mov eax, [esp+4+4]
|
|
out dx, al ; LBA Low LBA (7:0)
|
|
shr eax, 8
|
|
inc edx
|
|
out dx, al ; LBA Mid LBA (15:8)
|
|
shr eax, 8
|
|
inc edx
|
|
out dx, al ; LBA High LBA (23:16)
|
|
shr eax, 8
|
|
inc edx
|
|
and al, 1+2+4+8 ; LBA (27:24)
|
|
add al, byte [hdid]
|
|
add al, 128+64+32
|
|
out dx, al ; номер головки/номер диска
|
|
inc edx
|
|
mov al, 20h ; READ SECTOR(S)
|
|
out dx, al ; ATACommand регистр команд
|
|
popfd
|
|
jmp .continue
|
|
;--------------------------------------
|
|
.lba48:
|
|
pushfd
|
|
cli
|
|
xor eax, eax
|
|
mov edx, [hdbase]
|
|
inc edx
|
|
out dx, al ; Features Previous Reserved
|
|
out dx, al ; Features Current Reserved
|
|
inc edx
|
|
out dx, al ; Sector Count Previous Sector count (15:8)
|
|
inc eax
|
|
out dx, al ; Sector Count Current Sector count (7:0)
|
|
inc edx
|
|
mov eax, [esp+4+4]
|
|
rol eax, 8
|
|
out dx, al ; LBA Low Previous LBA (31:24)
|
|
xor eax, eax ; because only 32 bit cache
|
|
inc edx
|
|
out dx, al ; LBA Mid Previous LBA (39:32)
|
|
inc edx
|
|
out dx, al ; LBA High Previous LBA (47:40)
|
|
sub edx, 2
|
|
mov eax, [esp+4+4]
|
|
out dx, al ; LBA Low Current LBA (7:0)
|
|
shr eax, 8
|
|
inc edx
|
|
out dx, al ; LBA Mid Current LBA (15:8)
|
|
shr eax, 8
|
|
inc edx
|
|
out dx, al ; LBA High Current LBA (23:16)
|
|
inc edx
|
|
mov al, byte [hdid]
|
|
add al, 128+64+32
|
|
out dx, al ; номер головки/номер диска
|
|
inc edx
|
|
mov al, 24h ; READ SECTOR(S) EXT
|
|
out dx, al ; ATACommand регистр команд
|
|
popfd
|
|
;--------------------------------------
|
|
.continue:
|
|
call wait_for_sector_buffer
|
|
|
|
cmp [hd_error], 0
|
|
jne hd_read_error
|
|
|
|
pushfd
|
|
cli
|
|
|
|
mov ecx, 256
|
|
mov edx, [hdbase]
|
|
cld
|
|
rep insw
|
|
popfd
|
|
|
|
pop edx eax
|
|
ret
|
|
;-----------------------------------------------------------------------------
|
|
align 4
|
|
; edi -> sector, esi -> data
|
|
cache_write_pio:
|
|
; Select the desired drive
|
|
mov edx, [hdbase]
|
|
add edx, 6 ;адрес регистра головок
|
|
mov al, byte [hdid]
|
|
add al, 128+64+32
|
|
out dx, al ; номер головки/номер диска
|
|
|
|
call wait_for_hd_idle
|
|
cmp [hd_error], 0
|
|
jne hd_write_error
|
|
|
|
; ATA with 28 or 48 bit for sector number?
|
|
mov eax, [edi]
|
|
cmp eax, 0x10000000
|
|
jae .lba48
|
|
;--------------------------------------
|
|
.lba28:
|
|
pushfd
|
|
cli
|
|
xor eax, eax
|
|
mov edx, [hdbase]
|
|
inc edx
|
|
out dx, al ; ATA Features регистр "особенностей"
|
|
inc edx
|
|
inc eax
|
|
out dx, al ; ATA Sector Counter счётчик секторов
|
|
inc edx
|
|
mov eax, [edi] ; eax = sector to write
|
|
out dx, al ; LBA Low LBA (7:0)
|
|
shr eax, 8
|
|
inc edx
|
|
out dx, al ; LBA Mid LBA (15:8)
|
|
shr eax, 8
|
|
inc edx
|
|
out dx, al ; LBA High LBA (23:16)
|
|
shr eax, 8
|
|
inc edx
|
|
and al, 1+2+4+8 ; LBA (27:24)
|
|
add al, byte [hdid]
|
|
add al, 128+64+32
|
|
out dx, al ; номер головки/номер диска
|
|
inc edx
|
|
mov al, 30h ; WRITE SECTOR(S)
|
|
out dx, al ; ATACommand регистр команд
|
|
jmp .continue
|
|
;--------------------------------------
|
|
.lba48:
|
|
pushfd
|
|
cli
|
|
xor eax, eax
|
|
mov edx, [hdbase]
|
|
inc edx
|
|
out dx, al ; Features Previous Reserved
|
|
out dx, al ; Features Current Reserved
|
|
inc edx
|
|
out dx, al ; Sector Count Previous Sector count (15:8)
|
|
inc eax
|
|
out dx, al ; Sector Count Current Sector count (7:0)
|
|
inc edx
|
|
mov eax, [edi]
|
|
rol eax, 8
|
|
out dx, al ; LBA Low Previous LBA (31:24)
|
|
xor eax, eax ; because only 32 bit cache
|
|
inc edx
|
|
out dx, al ; LBA Mid Previous LBA (39:32)
|
|
inc edx
|
|
out dx, al ; LBA High Previous LBA (47:40)
|
|
sub edx, 2
|
|
mov eax, [edi]
|
|
out dx, al ; LBA Low Current LBA (7:0)
|
|
shr eax, 8
|
|
inc edx
|
|
out dx, al ; LBA Mid Current LBA (15:8)
|
|
shr eax, 8
|
|
inc edx
|
|
out dx, al ; LBA High Current LBA (23:16)
|
|
inc edx
|
|
mov al, byte [hdid]
|
|
add al, 128+64+32
|
|
out dx, al ; номер головки/номер диска
|
|
inc edx
|
|
mov al, 34h ; WRITE SECTOR(S) EXT
|
|
out dx, al ; ATACommand регистр команд
|
|
;--------------------------------------
|
|
.continue:
|
|
popfd
|
|
call wait_for_sector_buffer
|
|
|
|
cmp [hd_error], 0
|
|
jne hd_write_error
|
|
|
|
push ecx esi
|
|
|
|
pushfd
|
|
cli
|
|
mov ecx, 256
|
|
mov edx, [hdbase]
|
|
cld
|
|
rep outsw
|
|
popfd
|
|
|
|
pop esi ecx
|
|
ret
|
|
;-----------------------------------------------------------------------------
|
|
align 4
|
|
save_hd_wait_timeout:
|
|
push eax
|
|
mov eax, [timer_ticks]
|
|
add eax, 300 ; 3 sec timeout
|
|
mov [hd_wait_timeout], eax
|
|
pop eax
|
|
ret
|
|
;-----------------------------------------------------------------------------
|
|
align 4
|
|
check_hd_wait_timeout:
|
|
push eax
|
|
mov eax, [hd_wait_timeout]
|
|
cmp [timer_ticks], eax
|
|
jg hd_timeout_error
|
|
|
|
pop eax
|
|
mov [hd_error], 0
|
|
ret
|
|
;-----------------------------------------------------------------------------
|
|
hd_timeout_error:
|
|
if lang eq sp
|
|
DEBUGF 1,"K : FS - HD tiempo de espera agotado\n"
|
|
else
|
|
DEBUGF 1,"K : FS - HD timeout\n"
|
|
end if
|
|
mov [hd_error], 1
|
|
pop eax
|
|
ret
|
|
;-----------------------------------------------------------------------------
|
|
hd_read_error:
|
|
if lang eq sp
|
|
DEBUGF 1,"K : FS - HD error de lectura\n"
|
|
else
|
|
DEBUGF 1,"K : FS - HD read error\n"
|
|
end if
|
|
pop edx eax
|
|
ret
|
|
;-----------------------------------------------------------------------------
|
|
hd_write_error_dma:
|
|
pop esi
|
|
hd_write_error:
|
|
if lang eq sp
|
|
DEBUGF 1,"K : FS - HD error de escritura\n"
|
|
else
|
|
DEBUGF 1,"K : FS - HD write error\n"
|
|
end if
|
|
ret
|
|
;-----------------------------------------------------------------------------
|
|
align 4
|
|
wait_for_hd_idle:
|
|
push eax edx
|
|
|
|
call save_hd_wait_timeout
|
|
|
|
mov edx, [hdbase]
|
|
add edx, 0x7
|
|
;--------------------------------------
|
|
align 4
|
|
wfhil1:
|
|
call check_hd_wait_timeout
|
|
cmp [hd_error], 0
|
|
jne @f
|
|
|
|
in al, dx
|
|
test al, 128
|
|
jnz wfhil1
|
|
|
|
@@:
|
|
pop edx eax
|
|
ret
|
|
;-----------------------------------------------------------------------------
|
|
align 4
|
|
wait_for_sector_buffer:
|
|
push eax edx
|
|
|
|
mov edx, [hdbase]
|
|
add edx, 0x7
|
|
|
|
call save_hd_wait_timeout
|
|
;--------------------------------------
|
|
align 4
|
|
hdwait_sbuf: ; wait for sector buffer to be ready
|
|
call check_hd_wait_timeout
|
|
cmp [hd_error], 0
|
|
jne @f
|
|
|
|
in al, dx
|
|
test al, 8
|
|
jz hdwait_sbuf
|
|
|
|
mov [hd_error], 0
|
|
|
|
cmp [hd_setup], 1 ; do not mark error for setup request
|
|
je buf_wait_ok
|
|
|
|
test al, 1 ; previous command ended up with an error
|
|
jz buf_wait_ok
|
|
@@:
|
|
mov [hd_error], 1
|
|
|
|
buf_wait_ok:
|
|
pop edx eax
|
|
ret
|
|
;-----------------------------------------------------------------------------
|
|
irq14_num equ byte 14
|
|
irq15_num equ byte 15
|
|
;-----------------------------------------------------------------------------
|
|
align 4
|
|
wait_for_sector_dma_ide0:
|
|
push eax
|
|
push edx
|
|
call save_hd_wait_timeout
|
|
;--------------------------------------
|
|
align 4
|
|
.wait:
|
|
call change_task
|
|
cmp [IDE_common_irq_param], 0
|
|
jz .done
|
|
|
|
call check_hd_wait_timeout
|
|
cmp [hd_error], 0
|
|
jz .wait
|
|
; clear Bus Master IDE Command register
|
|
pushfd
|
|
cli
|
|
mov [IDE_common_irq_param], 0
|
|
mov dx, [IDEContrRegsBaseAddr]
|
|
mov al, 0
|
|
out dx, al
|
|
popfd
|
|
;--------------------------------------
|
|
align 4
|
|
.done:
|
|
pop edx
|
|
pop eax
|
|
ret
|
|
;-----------------------------------------------------------------------------
|
|
align 4
|
|
wait_for_sector_dma_ide1:
|
|
push eax
|
|
push edx
|
|
call save_hd_wait_timeout
|
|
;--------------------------------------
|
|
align 4
|
|
.wait:
|
|
call change_task
|
|
cmp [IDE_common_irq_param], 0
|
|
jz .done
|
|
|
|
call check_hd_wait_timeout
|
|
cmp [hd_error], 0
|
|
jz .wait
|
|
; clear Bus Master IDE Command register
|
|
pushfd
|
|
cli
|
|
mov [IDE_common_irq_param], 0
|
|
mov dx, [IDEContrRegsBaseAddr]
|
|
add dx, 8
|
|
mov al, 0
|
|
out dx, al
|
|
popfd
|
|
;--------------------------------------
|
|
align 4
|
|
.done:
|
|
pop edx
|
|
pop eax
|
|
ret
|
|
;-----------------------------------------------------------------------------
|
|
iglobal
|
|
align 4
|
|
; note that IDE descriptor table must be 4-byte aligned and do not cross 4K boundary
|
|
IDE_descriptor_table:
|
|
dd IDE_DMA
|
|
dw 0x2000
|
|
dw 0x8000
|
|
|
|
dma_cur_sector dd not 40h
|
|
dma_hdpos dd 0
|
|
IDE_common_irq_param db 0
|
|
endg
|
|
;-----------------------------------------------------------------------------
|
|
uglobal
|
|
; all uglobals are zeroed at boot
|
|
dma_process dd 0
|
|
dma_slot_ptr dd 0
|
|
cache_chain_pos dd 0
|
|
cache_chain_ptr dd 0
|
|
cache_chain_size db 0
|
|
cache_chain_started db 0
|
|
dma_task_switched db 0
|
|
dma_hdd db 0
|
|
allow_dma_access db 0
|
|
endg
|
|
;-----------------------------------------------------------------------------
|
|
align 4
|
|
IDE_irq_14_handler:
|
|
cmp [IDE_common_irq_param], irq14_num
|
|
jne .exit
|
|
|
|
pushfd
|
|
cli
|
|
pushad
|
|
mov [IDE_common_irq_param], 0
|
|
mov dx, [IDEContrRegsBaseAddr]
|
|
; test whether it is our interrupt?
|
|
add edx, 2
|
|
in al, dx
|
|
test al, 100b
|
|
jz @f
|
|
; clear Bus Master IDE Status register
|
|
; clear Interrupt bit
|
|
out dx, al
|
|
; clear Bus Master IDE Command register
|
|
sub edx, 2
|
|
xor eax, eax
|
|
out dx, al
|
|
; read status register and remove the interrupt request
|
|
mov edx, [hdbase]
|
|
add edx, 0x7
|
|
in al, dx
|
|
popad
|
|
popfd
|
|
mov al, 1
|
|
ret
|
|
;--------------------------------------
|
|
align 4
|
|
@@:
|
|
popad
|
|
popfd
|
|
;--------------------------------------
|
|
align 4
|
|
.exit:
|
|
mov al, 0
|
|
ret
|
|
;-----------------------------------------------------------------------------
|
|
align 4
|
|
IDE_irq_15_handler:
|
|
cmp [IDE_common_irq_param], irq15_num
|
|
jne .exit
|
|
|
|
pushfd
|
|
cli
|
|
pushad
|
|
mov [IDE_common_irq_param], 0
|
|
mov dx, [IDEContrRegsBaseAddr]
|
|
add dx, 8
|
|
; test whether it is our interrupt?
|
|
add edx, 2
|
|
in al, dx
|
|
test al, 100b
|
|
jz @f
|
|
; clear Bus Master IDE Status register
|
|
; clear Interrupt bit
|
|
out dx, al
|
|
; clear Bus Master IDE Command register
|
|
sub edx, 2
|
|
mov al, 0
|
|
out dx, al
|
|
; read status register and remove the interrupt request
|
|
mov edx, [hdbase]
|
|
add edx, 0x7
|
|
in al, dx
|
|
popad
|
|
popfd
|
|
mov al, 1
|
|
ret
|
|
;--------------------------------------
|
|
align 4
|
|
@@:
|
|
popad
|
|
popfd
|
|
;--------------------------------------
|
|
align 4
|
|
.exit:
|
|
mov al, 0
|
|
ret
|
|
;-----------------------------------------------------------------------------
|
|
align 4
|
|
IDE_common_irq_handler:
|
|
cmp [IDE_common_irq_param], 0
|
|
je .exit
|
|
|
|
pushfd
|
|
cli
|
|
pushad
|
|
xor ebx, ebx
|
|
mov dx, [IDEContrRegsBaseAddr]
|
|
mov eax, IDE_common_irq_param
|
|
cmp [eax], irq14_num
|
|
mov [eax], bl
|
|
je @f
|
|
|
|
add dx, 8
|
|
;--------------------------------------
|
|
align 4
|
|
@@:
|
|
; test whether it is our interrupt?
|
|
add edx, 2
|
|
in al, dx
|
|
test al, 100b
|
|
jz @f
|
|
; clear Bus Master IDE Status register
|
|
; clear Interrupt bit
|
|
out dx, al
|
|
; clear Bus Master IDE Command register
|
|
sub edx, 2
|
|
xor eax, eax
|
|
out dx, al
|
|
; read status register and remove the interrupt request
|
|
mov edx, [hdbase]
|
|
add edx, 0x7
|
|
in al, dx
|
|
popad
|
|
popfd
|
|
mov al, 1
|
|
ret
|
|
;--------------------------------------
|
|
align 4
|
|
@@:
|
|
popad
|
|
popfd
|
|
;--------------------------------------
|
|
align 4
|
|
.exit:
|
|
mov al, 0
|
|
ret
|
|
;-----------------------------------------------------------------------------
|
|
align 4
|
|
hd_read_dma:
|
|
push eax
|
|
push edx
|
|
mov edx, [dma_hdpos]
|
|
cmp edx, [hdpos]
|
|
jne .notread
|
|
mov edx, [dma_cur_sector]
|
|
cmp eax, edx
|
|
jb .notread
|
|
add edx, 15
|
|
cmp [esp+4], edx
|
|
ja .notread
|
|
mov eax, [esp+4]
|
|
sub eax, [dma_cur_sector]
|
|
shl eax, 9
|
|
add eax, (OS_BASE+IDE_DMA)
|
|
push ecx esi
|
|
mov esi, eax
|
|
|
|
mov ecx, 512/4
|
|
cld
|
|
rep movsd
|
|
pop esi ecx
|
|
pop edx
|
|
pop eax
|
|
ret
|
|
.notread:
|
|
; set data for PRD Table
|
|
mov eax, IDE_descriptor_table
|
|
mov dword [eax], IDE_DMA
|
|
mov word [eax+4], 0x2000
|
|
sub eax, OS_BASE
|
|
; select controller Primary or Secondary
|
|
mov dx, [IDEContrRegsBaseAddr]
|
|
push eax
|
|
mov eax, [hd_address_table]
|
|
cmp [hdbase], eax ; 0x1F0
|
|
pop eax
|
|
jz @f
|
|
add edx, 8
|
|
@@:
|
|
push edx
|
|
; Bus Master IDE PRD Table Address
|
|
add edx, 4
|
|
; save IDE_descriptor_table
|
|
out dx, eax
|
|
pop edx
|
|
; clear Bus Master IDE Command register
|
|
mov al, 0
|
|
out dx, al
|
|
; clear Bus Master IDE Status register
|
|
; clear Error bit and Interrupt bit
|
|
add edx, 2
|
|
mov al, 6 ; 110b
|
|
out dx, al
|
|
; Select the desired drive
|
|
mov edx, [hdbase]
|
|
add edx, 6 ; адрес регистра головок
|
|
mov al, byte [hdid]
|
|
add al, 128+64+32
|
|
out dx, al ; номер головки/номер диска
|
|
|
|
call wait_for_hd_idle
|
|
cmp [hd_error], 0
|
|
jnz hd_read_error
|
|
|
|
; ATA with 28 or 48 bit for sector number?
|
|
mov eax, [esp+4]
|
|
; -10h because the PreCache hits the boundary between lba28 and lba48
|
|
; 10h = 16 - size of PreCache
|
|
cmp eax, 0x10000000-10h
|
|
jae .lba48
|
|
;--------------------------------------
|
|
.lba28:
|
|
pushfd
|
|
cli
|
|
xor eax, eax
|
|
mov edx, [hdbase]
|
|
inc edx
|
|
out dx, al ; ATA Features регистр "особенностей"
|
|
inc edx
|
|
mov eax, 10h ; Sector Counter = 16 ; PreCache
|
|
out dx, al ; ATA Sector Counter счётчик секторов
|
|
inc edx
|
|
mov eax, [esp+4+4]
|
|
out dx, al ; LBA Low LBA (7:0)
|
|
shr eax, 8
|
|
inc edx
|
|
out dx, al ; LBA Mid LBA (15:8)
|
|
shr eax, 8
|
|
inc edx
|
|
out dx, al ; LBA High LBA (23:16)
|
|
shr eax, 8
|
|
inc edx
|
|
and al, 0xF ; LBA (27:24)
|
|
add al, byte [hdid]
|
|
add al, 11100000b
|
|
out dx, al ; номер головки/номер диска
|
|
inc edx
|
|
mov al, 0xC8 ; READ DMA
|
|
out dx, al ; ATACommand регистр команд
|
|
jmp .continue
|
|
;--------------------------------------
|
|
.lba48:
|
|
pushfd
|
|
cli
|
|
xor eax, eax
|
|
mov edx, [hdbase]
|
|
inc edx
|
|
out dx, al ; Features Previous Reserved
|
|
out dx, al ; Features Current Reserved
|
|
inc edx
|
|
out dx, al ; Sector Count Previous Sector count (15:8)
|
|
mov eax, 10h ; Sector Counter = 16 PreCache
|
|
out dx, al ; Sector Count Current Sector count (7:0)
|
|
inc edx
|
|
mov eax, [esp+4+4]
|
|
rol eax, 8
|
|
out dx, al ; LBA Low Previous LBA (31:24)
|
|
xor eax, eax ; because only 32 bit cache
|
|
inc edx
|
|
out dx, al ; LBA Mid Previous LBA (39:32)
|
|
inc edx
|
|
out dx, al ; LBA High Previous LBA (47:40)
|
|
sub edx, 2
|
|
mov eax, [esp+4+4]
|
|
out dx, al ; LBA Low Current LBA (7:0)
|
|
shr eax, 8
|
|
inc edx
|
|
out dx, al ; LBA Mid Current LBA (15:8)
|
|
shr eax, 8
|
|
inc edx
|
|
out dx, al ; LBA High Current LBA (23:16)
|
|
inc edx
|
|
mov al, byte [hdid]
|
|
add al, 128+64+32
|
|
out dx, al ; номер головки/номер диска
|
|
inc edx
|
|
mov al, 25h ; READ DMA EXT
|
|
out dx, al ; ATACommand регистр команд
|
|
;--------------------------------------
|
|
.continue:
|
|
; select controller Primary or Secondary
|
|
mov dx, [IDEContrRegsBaseAddr]
|
|
mov eax, [hd_address_table]
|
|
cmp [hdbase], eax ; 0x1F0
|
|
jz @f
|
|
add dx, 8
|
|
@@:
|
|
; set write to memory and Start Bus Master
|
|
mov al, 9
|
|
out dx, al
|
|
|
|
mov eax, [CURRENT_TASK]
|
|
mov [dma_process], eax
|
|
|
|
mov eax, [TASK_BASE]
|
|
mov [dma_slot_ptr], eax
|
|
|
|
mov eax, [hd_address_table]
|
|
cmp [hdbase], eax ; 0x1F0
|
|
jnz .ide1
|
|
|
|
mov [IDE_common_irq_param], irq14_num
|
|
jmp @f
|
|
.ide1:
|
|
mov [IDE_common_irq_param], irq15_num
|
|
@@:
|
|
popfd
|
|
; wait for interrupt
|
|
mov eax, [hd_address_table]
|
|
cmp [hdbase], eax ; 0x1F0
|
|
jnz .wait_ide1
|
|
call wait_for_sector_dma_ide0
|
|
jmp @f
|
|
.wait_ide1:
|
|
call wait_for_sector_dma_ide1
|
|
@@:
|
|
cmp [hd_error], 0
|
|
jnz hd_read_error
|
|
mov eax, [hdpos]
|
|
mov [dma_hdpos], eax
|
|
pop edx
|
|
pop eax
|
|
mov [dma_cur_sector], eax
|
|
jmp hd_read_dma
|
|
;-----------------------------------------------------------------------------
|
|
cache_write_dma:
|
|
mov eax, [cache_chain_ptr] ; for what?
|
|
push esi
|
|
; set data for PRD Table
|
|
mov eax, IDE_descriptor_table
|
|
mov edx, eax
|
|
pusha
|
|
mov edi, (OS_BASE+IDE_DMA)
|
|
mov dword [edx], IDE_DMA
|
|
movzx ecx, [cache_chain_size]
|
|
shl ecx, 9
|
|
mov word [edx+4], cx
|
|
shr ecx, 2
|
|
cld
|
|
rep movsd
|
|
popa
|
|
sub eax, OS_BASE
|
|
; select controller Primary or Secondary
|
|
mov dx, [IDEContrRegsBaseAddr]
|
|
push eax
|
|
mov eax, [hd_address_table]
|
|
cmp [hdbase], eax ; 0x1F0
|
|
pop eax
|
|
jz @f
|
|
add edx, 8
|
|
@@:
|
|
push edx
|
|
; Bus Master IDE PRD Table Address
|
|
add edx, 4
|
|
; save IDE_descriptor_table
|
|
out dx, eax
|
|
pop edx
|
|
; clear Bus Master IDE Command register
|
|
mov al, 0
|
|
out dx, al
|
|
; clear Bus Master IDE Status register
|
|
; clear Error bit and Interrupt bit
|
|
add edx, 2
|
|
mov al, 6
|
|
out dx, al
|
|
; Select the desired drive
|
|
mov edx, [hdbase]
|
|
add edx, 6 ; адрес регистра головок
|
|
mov al, byte [hdid]
|
|
add al, 128+64+32
|
|
out dx, al ; номер головки/номер диска
|
|
|
|
call wait_for_hd_idle
|
|
cmp [hd_error], 0
|
|
jnz hd_write_error_dma
|
|
|
|
; ATA with 28 or 48 bit for sector number?
|
|
mov esi, [cache_chain_ptr]
|
|
mov eax, [esi]
|
|
; -40h because the PreCache hits the boundary between lba28 and lba48
|
|
; 40h = 64 - the maximum number of sectors to be written for one command
|
|
cmp eax, 0x10000000-40h
|
|
jae .lba48
|
|
;--------------------------------------
|
|
.lba28:
|
|
pushfd
|
|
cli
|
|
xor eax, eax
|
|
mov edx, [hdbase]
|
|
inc edx
|
|
out dx, al ; ATA Features регистр "особенностей"
|
|
inc edx
|
|
mov al, [cache_chain_size] ; Sector Counter
|
|
out dx, al ; ATA Sector Counter счётчик секторов
|
|
inc edx
|
|
mov eax, [esi]
|
|
out dx, al ; LBA Low LBA (7:0)
|
|
shr eax, 8
|
|
inc edx
|
|
out dx, al ; LBA Mid LBA (15:8)
|
|
shr eax, 8
|
|
inc edx
|
|
out dx, al ; LBA High LBA (23:16)
|
|
shr eax, 8
|
|
inc edx
|
|
and al, 0xF ; LBA (27:24)
|
|
add al, byte [hdid]
|
|
add al, 11100000b
|
|
out dx, al ; номер головки/номер диска
|
|
inc edx
|
|
mov al, 0xCA ; WRITE DMA
|
|
out dx, al ; ATACommand регистр команд
|
|
jmp .continue
|
|
;--------------------------------------
|
|
.lba48:
|
|
pushfd
|
|
cli
|
|
xor eax, eax
|
|
mov edx, [hdbase]
|
|
inc edx
|
|
out dx, al ; Features Previous Reserved
|
|
out dx, al ; Features Current Reserved
|
|
inc edx
|
|
out dx, al ; Sector Count Previous Sector count (15:8)
|
|
mov al, [cache_chain_size] ; Sector Counter
|
|
out dx, al ; Sector Count Current Sector count (7:0)
|
|
inc edx
|
|
mov eax, [esi]
|
|
rol eax, 8
|
|
out dx, al ; LBA Low Previous LBA (31:24)
|
|
xor eax, eax ; because only 32 bit cache
|
|
inc edx
|
|
out dx, al ; LBA Mid Previous LBA (39:32)
|
|
inc edx
|
|
out dx, al ; LBA High Previous LBA (47:40)
|
|
sub edx, 2
|
|
mov eax, [esi]
|
|
out dx, al ; LBA Low Current LBA (7:0)
|
|
shr eax, 8
|
|
inc edx
|
|
out dx, al ; LBA Mid Current LBA (15:8)
|
|
shr eax, 8
|
|
inc edx
|
|
out dx, al ; LBA High Current LBA (23:16)
|
|
inc edx
|
|
mov al, byte [hdid]
|
|
add al, 128+64+32
|
|
out dx, al ; номер головки/номер диска
|
|
inc edx
|
|
mov al, 35h ; WRITE DMA EXT
|
|
out dx, al ; ATACommand регистр команд
|
|
;--------------------------------------
|
|
.continue:
|
|
; select controller Primary or Secondary
|
|
mov dx, [IDEContrRegsBaseAddr]
|
|
mov eax, [hd_address_table]
|
|
cmp [hdbase], eax ; 0x1F0
|
|
jz @f
|
|
add dx, 8
|
|
@@:
|
|
; set write to device and Start Bus Master
|
|
mov al, 1
|
|
out dx, al
|
|
mov eax, [CURRENT_TASK]
|
|
mov [dma_process], eax
|
|
mov eax, [TASK_BASE]
|
|
mov [dma_slot_ptr], eax
|
|
mov eax, [hd_address_table]
|
|
cmp [hdbase], eax ; 0x1F0
|
|
jnz .ide1
|
|
|
|
mov [IDE_common_irq_param], irq14_num
|
|
jmp @f
|
|
.ide1:
|
|
mov [IDE_common_irq_param], irq15_num
|
|
@@:
|
|
popfd
|
|
; wait for interrupt
|
|
mov [dma_cur_sector], not 0x40
|
|
mov eax, [hd_address_table]
|
|
cmp [hdbase], eax ; 0x1F0
|
|
jnz .wait_ide1
|
|
call wait_for_sector_dma_ide0
|
|
jmp @f
|
|
.wait_ide1:
|
|
call wait_for_sector_dma_ide1
|
|
@@:
|
|
cmp [hd_error], 0
|
|
jnz hd_write_error_dma
|
|
pop esi
|
|
ret
|
|
;-----------------------------------------------------------------------------
|
|
uglobal
|
|
align 4
|
|
IDE_Interrupt dw ?
|
|
IDEContrRegsBaseAddr dw ?
|
|
IDEContrProgrammingInterface dw ?
|
|
IDE_BAR0_val dw ?
|
|
IDE_BAR1_val dw ?
|
|
IDE_BAR2_val dw ?
|
|
IDE_BAR3_val dw ?
|
|
endg
|
|
;-----------------------------------------------------------------------------
|