1 | ; File name : CompatibleDPT.asm |
---|
2 | ; Project name : IDE BIOS |
---|
3 | ; Created date : 6.4.2010 |
---|
4 | ; Last update : 6.4.2010 |
---|
5 | ; Author : Tomi Tilli |
---|
6 | ; Description : Functions for creating Disk Parameter Tables for |
---|
7 | ; software compatibility only. These DPTs are not used |
---|
8 | ; by our BIOS. |
---|
9 | |
---|
10 | ; Section containing code |
---|
11 | SECTION .text |
---|
12 | |
---|
13 | ;-------------------------------------------------------------------- |
---|
14 | ; Creates compatible for drives 80h and 81h. There will be stored |
---|
15 | ; to interrupt vectors 41h and 46h. |
---|
16 | ; |
---|
17 | ; CompatibleDPT_CreateForDrives80hAnd81h |
---|
18 | ; Parameters: |
---|
19 | ; DS: RAMVARS segment |
---|
20 | ; ES: BDA segment (zero) |
---|
21 | ; Returns: |
---|
22 | ; Nothing |
---|
23 | ; Corrupts registers: |
---|
24 | ; All except DS and ES |
---|
25 | ;-------------------------------------------------------------------- |
---|
26 | ALIGN JUMP_ALIGN |
---|
27 | CompatibleDPT_CreateForDrives80hAnd81h: |
---|
28 | ; Only create compatible DPTs in full mode |
---|
29 | test BYTE [cs:ROMVARS.wFlags], FLG_ROMVARS_FULLMODE |
---|
30 | jz SHORT CompatibleDPT_StoreCustomDPTs |
---|
31 | |
---|
32 | mov dl, 80h |
---|
33 | call FindDPT_ForDriveNumber ; DPT to DS:DI |
---|
34 | jnc SHORT .CreateForDrive81h |
---|
35 | call CompatibleDPT_CreateForDrive80h |
---|
36 | ALIGN JUMP_ALIGN |
---|
37 | .CreateForDrive81h: |
---|
38 | mov dl, 81h |
---|
39 | call FindDPT_ForDriveNumber |
---|
40 | jnc SHORT .Return |
---|
41 | call CompatibleDPT_CreateForDrive81h |
---|
42 | ALIGN JUMP_ALIGN |
---|
43 | .Return: |
---|
44 | ret |
---|
45 | |
---|
46 | |
---|
47 | ;-------------------------------------------------------------------- |
---|
48 | ; Stores pointers to our custom DPTs for drives 80h and 81h. |
---|
49 | ; |
---|
50 | ; CompatibleDPT_StoreCustomDPTs |
---|
51 | ; Parameters: |
---|
52 | ; ES: BDA and interrupt vector segment (zero) |
---|
53 | ; Returns: |
---|
54 | ; Nothing |
---|
55 | ; Corrupts registers: |
---|
56 | ; DX, DI |
---|
57 | ;-------------------------------------------------------------------- |
---|
58 | ALIGN JUMP_ALIGN |
---|
59 | CompatibleDPT_StoreCustomDPTs: |
---|
60 | mov dl, 80h |
---|
61 | call FindDPT_ForDriveNumber ; DPT to DS:DI |
---|
62 | jnc SHORT .FindForDrive81h |
---|
63 | mov [es:INTV_HD0DPT*4], di |
---|
64 | mov [es:INTV_HD0DPT*4+2], ds |
---|
65 | ALIGN JUMP_ALIGN |
---|
66 | .FindForDrive81h: |
---|
67 | inc dx |
---|
68 | call FindDPT_ForDriveNumber |
---|
69 | jnc SHORT .Return |
---|
70 | mov [es:INTV_HD1DPT*4], di |
---|
71 | mov [es:INTV_HD1DPT*4+2], ds |
---|
72 | ALIGN JUMP_ALIGN |
---|
73 | .Return: |
---|
74 | ret |
---|
75 | |
---|
76 | |
---|
77 | ;-------------------------------------------------------------------- |
---|
78 | ; Copies parameters from our custom DPT struct to a |
---|
79 | ; standard COMPATIBLE_FDPT or COMPATIBLE_EDPT struct. |
---|
80 | ; |
---|
81 | ; CompatibleDPT_CreateForDrive80h |
---|
82 | ; CompatibleDPT_CreateForDrive81h |
---|
83 | ; Parameters: |
---|
84 | ; DS:DI: Ptr to DPT |
---|
85 | ; ES: BDA and interrupt vector segment (zero) |
---|
86 | ; Returns: |
---|
87 | ; Nothing |
---|
88 | ; Corrupts registers: |
---|
89 | ; AX, BX, CX, DX, SI |
---|
90 | ;-------------------------------------------------------------------- |
---|
91 | ALIGN JUMP_ALIGN |
---|
92 | CompatibleDPT_CreateForDrive80h: |
---|
93 | mov si, FULLRAMVARS.drv80hCompDPT ; DS:SI now points compatible DPT |
---|
94 | call CompatibleDPT_CopyFromCustom |
---|
95 | mov [es:INTV_HD0DPT*4], si |
---|
96 | mov [es:INTV_HD0DPT*4+2], ds |
---|
97 | ret |
---|
98 | ALIGN JUMP_ALIGN |
---|
99 | CompatibleDPT_CreateForDrive81h: |
---|
100 | mov si, FULLRAMVARS.drv81hCompDPT ; DS:SI now points compatible DPT |
---|
101 | call CompatibleDPT_CopyFromCustom |
---|
102 | mov [es:INTV_HD1DPT*4], si |
---|
103 | mov [es:INTV_HD1DPT*4+2], ds |
---|
104 | ret |
---|
105 | |
---|
106 | |
---|
107 | ;-------------------------------------------------------------------- |
---|
108 | ; Copies parameters from our custom DPT struct to a |
---|
109 | ; standard COMPATIBLE_FDPT or COMPATIBLE_EDPT struct. |
---|
110 | ; |
---|
111 | ; CompatibleDPT_CopyFromCustom |
---|
112 | ; Parameters: |
---|
113 | ; DS:SI: Ptr to COMPATIBLE_FDPT or COMPATIBLE_EDPT |
---|
114 | ; DS:DI: Ptr to DPT |
---|
115 | ; Returns: |
---|
116 | ; Nothing |
---|
117 | ; Corrupts registers: |
---|
118 | ; AX, BX, CX, DX |
---|
119 | ;-------------------------------------------------------------------- |
---|
120 | ALIGN JUMP_ALIGN |
---|
121 | CompatibleDPT_CopyFromCustom: |
---|
122 | call AccessDPT_GetLCHSfromPCHS ; AX=Lsects, BX=Lcyls, DX=Lheads |
---|
123 | test BYTE [di+DPT.bFlags], FLG_DPT_EBIOS ; Drive larger than 504 MiB? |
---|
124 | jnz SHORT CompatibleDPT_CopyFromCustomToEDPT |
---|
125 | ; Fall to CompatibleDPT_CopyFromCustomToFDPT |
---|
126 | |
---|
127 | ;-------------------------------------------------------------------- |
---|
128 | ; Copies parameters from our custom DPT struct to a |
---|
129 | ; standard COMPATIBLE_FDPT struct for drives up to 504 MiB. |
---|
130 | ; |
---|
131 | ; CompatibleDPT_CopyFromCustomToFDPT |
---|
132 | ; Parameters: |
---|
133 | ; AX: L-CHS sectors per track |
---|
134 | ; BX: L-CHS cylinders |
---|
135 | ; DX: L-CHS heads |
---|
136 | ; DS:SI: Ptr to COMPATIBLE_FDPT |
---|
137 | ; DS:DI: Ptr to DPT |
---|
138 | ; Returns: |
---|
139 | ; Nothing |
---|
140 | ; Corrupts registers: |
---|
141 | ; AX, BX |
---|
142 | ;-------------------------------------------------------------------- |
---|
143 | ;ALIGN JUMP_ALIGN |
---|
144 | CompatibleDPT_CopyFromCustomToFDPT: |
---|
145 | mov [si+COMPATIBLE_FDPT.wCyls], bx |
---|
146 | mov [si+COMPATIBLE_FDPT.bHeads], dl |
---|
147 | mov [si+COMPATIBLE_FDPT.bSectPerTrack], al |
---|
148 | mov WORD [si+COMPATIBLE_FDPT.wWrPreCmpCyl], -1 |
---|
149 | mov al, [di+DPT.bDrvCtrl] |
---|
150 | mov [si+COMPATIBLE_FDPT.bDrvCtrl], al |
---|
151 | mov BYTE [si+COMPATIBLE_FDPT.bNormTimeout], B_TIMEOUT_BSY |
---|
152 | mov BYTE [si+COMPATIBLE_FDPT.bFormatTimeout], B_TIMEOUT_DRQ |
---|
153 | mov BYTE [si+COMPATIBLE_FDPT.bCheckTimeout], B_TIMEOUT_DRQ |
---|
154 | dec bx |
---|
155 | mov [si+COMPATIBLE_FDPT.wLZoneCyl], bx |
---|
156 | ret |
---|
157 | |
---|
158 | |
---|
159 | ;-------------------------------------------------------------------- |
---|
160 | ; Copies parameters from our custom DPT struct to a |
---|
161 | ; standard COMPATIBLE_EDPT struct. |
---|
162 | ; |
---|
163 | ; CompatibleDPT_CopyFromCustomToEDPT |
---|
164 | ; Parameters: |
---|
165 | ; AX: L-CHS sectors per track |
---|
166 | ; BX: L-CHS cylinders |
---|
167 | ; DX: L-CHS heads |
---|
168 | ; DS:SI: Ptr to COMPATIBLE_EDPT |
---|
169 | ; DS:DI: Ptr to DPT |
---|
170 | ; Returns: |
---|
171 | ; Nothing |
---|
172 | ; Corrupts registers: |
---|
173 | ; AX, BX, CX, DX |
---|
174 | ;-------------------------------------------------------------------- |
---|
175 | ALIGN JUMP_ALIGN |
---|
176 | CompatibleDPT_CopyFromCustomToEDPT: |
---|
177 | mov [si+COMPATIBLE_EDPT.wLCyls], bx |
---|
178 | mov [si+COMPATIBLE_EDPT.bLHeads], dl |
---|
179 | mov BYTE [si+COMPATIBLE_EDPT.bSignature], COMPATIBLE_EDPT_SIGNATURE |
---|
180 | mov [si+COMPATIBLE_EDPT.bPSect], al |
---|
181 | mov [si+COMPATIBLE_EDPT.bLSect], al |
---|
182 | mov al, [di+DPT.bDrvCtrl] |
---|
183 | mov [si+COMPATIBLE_EDPT.bDrvCtrl], al |
---|
184 | mov ax, [di+DPT.wPCyls] |
---|
185 | mov [si+COMPATIBLE_EDPT.wPCyls], ax |
---|
186 | mov al, [di+DPT.bPHeads] |
---|
187 | mov [si+COMPATIBLE_EDPT.bPHeads], al |
---|
188 | ; Fall to CompatibleDPT_StoreChecksum |
---|
189 | |
---|
190 | ;-------------------------------------------------------------------- |
---|
191 | ; Stores checksum byte to the end of COMPATIBLE_EDPT struct. |
---|
192 | ; |
---|
193 | ; CompatibleDPT_StoreChecksum |
---|
194 | ; Parameters: |
---|
195 | ; DS:SI: Ptr to COMPATIBLE_EDPT |
---|
196 | ; Returns: |
---|
197 | ; Nothing |
---|
198 | ; Corrupts registers: |
---|
199 | ; AX, BX, CX |
---|
200 | ;-------------------------------------------------------------------- |
---|
201 | ;ALIGN JUMP_ALIGN |
---|
202 | CompatibleDPT_StoreChecksum: |
---|
203 | xor ax, ax |
---|
204 | xor bx, bx |
---|
205 | mov cx, COMPATIBLE_EDPT_size-1 |
---|
206 | ALIGN JUMP_ALIGN |
---|
207 | .SumLoop: |
---|
208 | add al, [bx+si] |
---|
209 | inc bx |
---|
210 | loop .SumLoop |
---|
211 | neg al |
---|
212 | mov [si+COMPATIBLE_EDPT.bChecksum], al |
---|
213 | ret |
---|