1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
|
%ifndef _DISK_ASM
%define _DISK_ASM
%include "stdio.asm"
disk_info:
push bp
mov bp, sp
xor dx, dx
mov ah, 41h
mov bx, 55aah
mov dl, [bp + 4] ; drive number {80h..ffh}
int 13h
jc .return
shr ax, 8
push dx
push cx
push ax
push disk_info_fmt
call printf
add sp, 6
.return:
mov sp, bp
pop bp
ret
disk_info_fmt: db 'HDD(%c): INT 13h Ext: %x (%x)', CR, 0
disk_lba_chs:
push bp
mov bp, sp
mov ax, word [bp - 2] ; LBA
mov sp, bp
pop bp
ret
disk_reset:
push bp
mov bp, sp
pusha
mov ah, 00h ; reset disk
mov dl, [bp + 4] ; disk number
int 13h ; BIOS disk service
jnc .success
push error_msg_disk_reset
call panic
.success:
push msg_disk_reset
call puts
add sp, 2
popa
mov sp, bp
pop bp
ret
disk_read:
push bp
mov bp, sp
push di
mov di, 3 ; retry counter
.readloop:
push ax
push bx
push cx
mov ah, 02h ; BIOS - read disk sectors
int 13h ; BIOS disk service
jnc .success
push dx
call disk_reset
add sp, 2
pop cx
pop bx
pop ax
dec di
jnz .readloop
push error_msg_disk_read
call panic
add sp, 2
.success:
pop di
mov sp, bp
pop bp
ret
; data
drive0: dw 0
msg_disk_reset: db "Drive reset successful.", CR, 0
msg_disk_read: db "Sector read successful.", CR, 0
error_msg_disk_reset: db "Drive reset failed!", CR, 0
error_msg_disk_read: db "Drive read failed!", CR, 0
%endif ; _DISK_ASM
|
