227 lines
3.5 KiB
ArmAsm
227 lines
3.5 KiB
ArmAsm
#include "drivers/atapi/ata.h"
|
|
|
|
.code32
|
|
|
|
.global ident_device
|
|
ident_device:
|
|
push %ebp
|
|
mov %esp, %ebp
|
|
|
|
push %ebx
|
|
push %esi
|
|
push %edi
|
|
push $0
|
|
|
|
mov 8(%ebp), %ebx # ebx = bus base address
|
|
mov 12(%ebp), %ecx # ecx = drive select mask
|
|
|
|
# drive select
|
|
mov %ebx, %edx
|
|
add $IO_DRIVE_SELECT_REG, %edx
|
|
mov %cl, %al
|
|
outb %al, (%dx)
|
|
|
|
mov %ebx, %edx
|
|
add $IO_STATUS_REG, %edx
|
|
.rept 15
|
|
inb (%dx), %al
|
|
.endr
|
|
|
|
xor %eax, %eax
|
|
# clear sector count and LBA
|
|
mov %ebx, %edx
|
|
add $IO_SECTOR_COUNT_REG, %edx
|
|
outb %al, (%dx)
|
|
|
|
mov %ebx, %edx
|
|
add $IO_LBA_LO_REG, %edx
|
|
outb %al, (%dx)
|
|
|
|
mov %ebx, %edx
|
|
add $IO_LBA_MID_REG, %edx
|
|
outb %al, (%dx)
|
|
|
|
mov %ebx, %edx
|
|
add $IO_LBA_HI_REG, %edx
|
|
outb %al, (%dx)
|
|
|
|
# send ident
|
|
mov %ebx, %edx
|
|
add $IO_CMD_REG, %edx
|
|
mov $0xEC, %al
|
|
outb %al, (%dx)
|
|
|
|
mov %ebx, %edx
|
|
add $IO_STATUS_REG, %edx
|
|
inb (%dx), %al
|
|
inb (%dx), %al
|
|
inb (%dx), %al
|
|
inb (%dx), %al
|
|
|
|
cmp $0xFF, %al
|
|
je not_found
|
|
test %al, %al
|
|
jz not_found
|
|
|
|
poll_status:
|
|
inb (%dx), %al
|
|
test $STATUS_REG_BSY, %al
|
|
jnz poll_status
|
|
|
|
# first check if this is an ATA device
|
|
check_ata:
|
|
mov %ebx, %edx
|
|
add $IO_LBA_MID_REG, %edx
|
|
inb (%dx), %al
|
|
test %al, %al
|
|
jnz check_atapi
|
|
|
|
mov %ebx, %edx
|
|
add $IO_LBA_HI_REG, %edx
|
|
inb (%dx), %al
|
|
test %al, %al
|
|
jnz check_atapi
|
|
is_ata:
|
|
mov $0x01, (%esp)
|
|
jmp poll_drq
|
|
|
|
check_atapi:
|
|
# check if atapi device
|
|
mov %ebx, %edx
|
|
add $IO_LBA_MID_REG, %edx
|
|
inb (%dx), %al
|
|
cmp $0x14, %al
|
|
jne not_found
|
|
|
|
mov %ebx, %edx
|
|
add $IO_LBA_HI_REG, %edx
|
|
inb (%dx), %al
|
|
cmp $0xEB, %al
|
|
jne not_found
|
|
is_atapi:
|
|
mov $0x02, (%esp)
|
|
mov %ebx, %edx
|
|
add $IO_CMD_REG, %edx
|
|
mov $(ATAPI_CMD_IDENTIFY_PACKET), %al
|
|
outb %al, (%dx)
|
|
|
|
mov %ebx, %edx
|
|
add $IO_STATUS_REG, %edx
|
|
inb (%dx), %al
|
|
inb (%dx), %al
|
|
inb (%dx), %al
|
|
inb (%dx), %al
|
|
1:
|
|
inb (%dx), %al
|
|
test $STATUS_REG_BSY, %al
|
|
jnz 1b
|
|
|
|
|
|
poll_drq:
|
|
mov %ebx, %edx
|
|
add $IO_STATUS_REG, %edx
|
|
inb (%dx), %al
|
|
|
|
test $STATUS_REG_BSY, %al
|
|
jnz poll_drq
|
|
|
|
test $STATUS_REG_ERR, %al
|
|
jnz error
|
|
|
|
test $STATUS_REG_DRQ, %al
|
|
jz poll_drq
|
|
|
|
drq_set:
|
|
mov %ebx, %edx
|
|
add $IO_DATA_REG, %edx
|
|
|
|
mov 16(%ebp), %edi
|
|
mov $256, %ecx
|
|
cld
|
|
read_data:
|
|
inw (%dx), %ax
|
|
mov %ax, (%edi)
|
|
add $2, %edi
|
|
loop read_data
|
|
jmp done
|
|
|
|
not_found:
|
|
error:
|
|
mov $0x0, (%esp)
|
|
done:
|
|
pop %eax
|
|
pop %edi
|
|
pop %esi
|
|
pop %ebx
|
|
leave
|
|
ret
|
|
|
|
.global atapi_wait
|
|
atapi_wait:
|
|
push %ebp
|
|
mov %esp, %ebp
|
|
|
|
# 8(%ebp) bus
|
|
mov 8(%ebp), %edx
|
|
|
|
add $IO_STATUS_REG, %edx
|
|
inb (%dx), %al
|
|
inb (%dx), %al
|
|
inb (%dx), %al
|
|
inb (%dx), %al
|
|
|
|
pop %edx
|
|
leave
|
|
ret
|
|
|
|
.global send_scsi_packet
|
|
send_scsi_packet:
|
|
push %ebp
|
|
mov %esp, %ebp
|
|
|
|
push %esi
|
|
push %ecx
|
|
push %edx
|
|
|
|
# 8(%ebp) bus
|
|
# 12(%ebp) cmd
|
|
# 16(%ebp) sz
|
|
mov 8(%ebp), %edx
|
|
add $IO_DATA_REG, %edx
|
|
mov 12(%ebp), %esi
|
|
mov 16(%ebp), %ecx
|
|
|
|
cld
|
|
rep outsw
|
|
|
|
pop %edx
|
|
pop %ecx
|
|
pop %esi
|
|
leave
|
|
ret
|
|
|
|
.global read_data_words
|
|
read_data_words:
|
|
push %ebp
|
|
mov %esp, %ebp
|
|
|
|
push %edi
|
|
push %ecx
|
|
push %edx
|
|
|
|
# 8(%ebp) bus
|
|
# 12(%ebp) buf
|
|
# 16(%ebp) sz
|
|
mov 8(%ebp), %edx
|
|
add $IO_DATA_REG, %edx
|
|
mov 12(%ebp), %edi
|
|
mov 16(%ebp), %ecx
|
|
|
|
cld
|
|
rep insw
|
|
|
|
pop %edx
|
|
pop %ecx
|
|
pop %edi
|
|
leave
|
|
ret |