source: xtideuniversalbios/trunk/XTIDE_Universal_BIOS/Src/VariablesAndDPTs/CompatibleDPT.asm@ 555

Last change on this file since 555 was 550, checked in by aitotat@…, 12 years ago

Changes to XTIDE Universal BIOS:

  • CREATE_COMPATIBLE_DPT is now MODULE_COMPATIBLE_TABLES.
  • DPTs pointed by INT 41h and INT 46h are now swapped when swapping drives 81h and 80h.
  • Block mode commands are no longer used when block size is set to 1 with AH=24h.
File size: 9.3 KB
RevLine 
[541]1; Project name : XTIDE Universal BIOS
2; Description : Functions to handle DPT structs to present drive geometry
3; to ill behaving applications that want
4; to read DPT from interrupt vectors 41h and 46h.
5
6;
7; XTIDE Universal BIOS and Associated Tools
8; Copyright (C) 2009-2010 by Tomi Tilli, 2011-2013 by XTIDE Universal BIOS Team.
9;
10; This program is free software; you can redistribute it and/or modify
11; it under the terms of the GNU General Public License as published by
12; the Free Software Foundation; either version 2 of the License, or
13; (at your option) any later version.
14;
15; This program is distributed in the hope that it will be useful,
16; but WITHOUT ANY WARRANTY; without even the implied warranty of
17; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18; GNU General Public License for more details.
19; Visit http://www.gnu.org/licenses/old-licenses/gpl-2.0.html
20;
21
22; Section containing code
23SECTION .text
24
25;--------------------------------------------------------------------
26; CompatibleDPT_CreateToAXSIforDriveDL
27; Parameters:
28; DL: Drive number (80h or 81h)
29; DS:DI: Ptr to DPT
30; Returns:
31; AX:SI Ptr to destination buffer
32; Corrupts registers:
33; CX, DX
34;--------------------------------------------------------------------
35CompatibleDPT_CreateToAXSIforDriveDL:
36 push es
37
38 call AccessDPT_GetDeviceControlByteToAL
39 xchg cx, ax ; Device control byte to CL
40 mov si, di ; DPT now in DS:SI
41 call GetBufferForDrive80hToESDI
42 shr dx, 1
43 jnc SHORT .BufferLoadedToESDI
44 add di, BYTE TRANSLATED_DPT_size ; For drive 81h
45.BufferLoadedToESDI:
46
47 call FillToESDIusingDPTfromDSSI
48 xchg di, si
49 mov ax, es
50
51 pop es
52 ret
53
54
55;--------------------------------------------------------------------
56; GetTemporaryBufferForDPTEtoESDI
57; GetBufferForDrive80hToESDI
58; Parameters:
59; DS: RAMVARS segment
60; Returns:
61; ES:DI: Ptr to buffer (in RAMVARS segment)
62; Corrupts registers:
63; Nothing
64;--------------------------------------------------------------------
[550]65%ifdef MODULE_EBIOS
[541]66GetTemporaryBufferForDPTEtoESDI:
67 call GetBufferForDrive80hToESDI
68 add di, BYTE TRANSLATED_DPT_size * 2
69 ret
[550]70%endif
[541]71
72GetBufferForDrive80hToESDI:
73 push ds
74 pop es
75 mov di, [cs:ROMVARS.bStealSize] ; No harm to read WORD
76 eSHL_IM di, 10 ; DI = RAMVARS size in bytes
[550]77%ifdef MODULE_EBIOS
[541]78 sub di, BYTE (TRANSLATED_DPT_size * 2) + DPTE_size
[550]79%else
80 sub di, BYTE TRANSLATED_DPT_size * 2
81%endif
[541]82 ret
83
84
85;--------------------------------------------------------------------
86; FillToESDIusingDPTfromDSSI
87; Parameters:
88; CL: Device Control Byte
89; DS:SI: Ptr to DPT
90; ES:DI Ptr to destination buffer
91; Returns:
92; Nothing
93; Corrupts registers:
94; AX, CX, DX
95;--------------------------------------------------------------------
96FillToESDIusingDPTfromDSSI:
[543]97 mov ax, [si+DPT.wLchsCylinders]
98 call AH8h_LimitAXtoMaximumLCylinders
[541]99 test BYTE [si+DPT.bFlagsLow], MASKL_DPT_TRANSLATEMODE
100 jz SHORT FillStandardDPTtoESDIfromDPTinDSSI
101 ; Fall to FillTranslatedDPTtoESDIfromDPTinDSSI
102
103;--------------------------------------------------------------------
104; FillTranslatedDPTtoESDIfromDPTinDSSI
105; Parameters:
[543]106; AX: Number of Logical Cylinders
[541]107; CL: Device Control Byte
108; DS:SI: Ptr to DPT
109; ES:DI: Ptr to destination buffer
110; Returns:
111; Nothing
112; Corrupts registers:
113; AX, CX, DX
114;--------------------------------------------------------------------
115FillTranslatedDPTtoESDIfromDPTinDSSI:
116 xor dx, dx ; Clear for checksum
117 call StoswThenAddALandAHtoDL ; Bytes 0 and 1 (Logical number of cylinders)
118
119 mov al, BYTE [si+DPT.bLchsHeads]
120 mov ah, TRANSLATED_DPT_SIGNATURE
121 call StoswThenAddALandAHtoDL ; Bytes 2 (Logical number of heads) and 3 (Axh signature to indicate Translated DPT)
122
123 eMOVZX ax, BYTE [si+DPT.bPchsSectorsPerTrack]
124 call StoswThenAddALandAHtoDL ; Bytes 4 (Physical sectors per track) and 5 (Write Precompensation Cylinder low)
125
126 mov al, ah
127 call StoswThenAddALandAHtoDL ; Bytes 6 (Write Precompensation Cylinder high) and 7
128
129 xchg ax, cx ; Device Control byte to AL
130 mov ah, [si+DPT.wPchsCylinders]
131 call StoswThenAddALandAHtoDL ; Bytes 8 (Drive Control Byte) and 9 (Physical number of cylinders low)
132
133 mov al, [si+DPT.wPchsCylinders+1]
134 mov ah, [si+DPT.bPchsHeads]
135 call StoswThenAddALandAHtoDL ; Bytes 10 (Physical number of cylinders high) and 11 (Physical number of heads)
136
137 xor ax, ax
138 call StoswThenAddALandAHtoDL ; Bytes 12 and 13 (Landing Zone Cylinder)
139
140 mov al, [si+DPT.bLchsSectorsPerTrack]
141%ifdef USE_186
142 push FillStandardDPTtoESDIfromDPTinDSSI.RestoreOffsetsAndReturn
143 jmp StoswALandChecksumFromDL ; Bytes 14 (Logical sectors per track) and 15 (Checksum)
144%else
145 call StoswALandChecksumFromDL
146 jmp SHORT FillStandardDPTtoESDIfromDPTinDSSI.RestoreOffsetsAndReturn
147%endif
148
149
150;--------------------------------------------------------------------
151; FillStandardDPTtoESDIfromDPTinDSSI
152; Parameters:
[543]153; AX: Number of Physical Cylinders == Number of Logical Cylinders
[541]154; CL: Device Control Byte
155; DS:SI: Ptr to DPT
156; ES:DI: Ptr to destination buffer
157; Returns:
158; Nothing
159; Corrupts registers:
160; AX
161;--------------------------------------------------------------------
162FillStandardDPTtoESDIfromDPTinDSSI:
163 stosw ; Bytes 0 and 1 (Physical number of cylinders)
164 eMOVZX ax, BYTE [si+DPT.bLchsHeads]
165 stosw ; Bytes 2 (Physical number of heads) and 3
166 mov al, ah ; Zero AX
167 stosw ; Bytes 4 and 5 (Write Precompensation Cylinder low)
168 stosw ; Bytes 6 (Write Precompensation Cylinder high) and 7
169 mov al, cl ; Device control byte to AL
170 stosw ; Bytes 8 (Drive Control Byte) and 9
171 mov al, ah ; Zero AX
172 stosw ; Bytes 10 and 11
173 stosw ; Bytes 12 and 13 (Landing Zone Cylinder)
174 mov al, [si+DPT.bLchsSectorsPerTrack]
175 stosw ; Bytes 14 (Physical sectors per track) and 15
176
177.RestoreOffsetsAndReturn:
178 sub di, BYTE STANDARD_DPT_size
179 ret
180
181
[550]182%ifdef MODULE_EBIOS
[541]183;--------------------------------------------------------------------
184; CompatibleDPT_CreateDeviceParameterTableExtensionToESBXfromDPTinDSSI
185; Parameters:
186; DS:SI: Ptr to DPT (in RAMVARS segment)
187; Returns:
188; ES:BX: Ptr to Device Parameter Table Extension (DPTE)
189; Corrupts registers:
190; AX, CX, DX, DI
191;--------------------------------------------------------------------
192CompatibleDPT_CreateDeviceParameterTableExtensionToESBXfromDPTinDSSI:
193 call GetTemporaryBufferForDPTEtoESDI ; valid until next AH=48h call
194
195 ; Set 32-bit flag for 32-bit controllers
196 mov cx, FLG_LBA_TRANSLATION_ENABLED ; DPTE.wFlags
197 cmp BYTE [si+DPT_ATA.bDevice], DEVICE_32BIT_ATA
198 eCMOVE cl, FLG_LBA_TRANSLATION_ENABLED | FLG_32BIT_XFER_MODE
199
200 ; DPTE.wBasePort
201 mov ax, [si+DPT.wBasePort]
202 call StoswThenAddALandAHtoDL ; Bytes 0 and 1
203
204 ; DPTE.wControlBlockPort
205 eMOVZX bx, BYTE [si+DPT.bIdevarsOffset]
206 mov ax, [cs:bx+IDEVARS.wControlBlockPort]
207 call StoswThenAddALandAHtoDL ; Bytes 2 and 3
208
209 ; DPTE.bDrvnhead and DPTE.bBiosVendor
210 xchg di, si
[542]211 call AccessDPT_GetDriveSelectByteToAL
[541]212 xchg si, di
213 call StoswThenAddALandAHtoDL ; Bytes 4 and 5
214
215 ; DPTE.bIRQ and DPTE.bBlockSize
216 mov al, [cs:bx+IDEVARS.bIRQ] ; No way to define that we might not use IRQ
217 mov ah, [si+DPT_ATA.bBlockSize]
218 cmp ah, 1
219 jbe SHORT .DoNotSetBlockModeFlag
220 or cl, FLG_BLOCK_MODE_ENABLED
221.DoNotSetBlockModeFlag:
222 call StoswThenAddALandAHtoDL ; Bytes 6 and 7
223
224 ; DPTE.bDmaChannelAndType and DPTE.bPioMode
225 xor ax, ax
226%ifdef MODULE_ADVANCED_ATA
227 or ah, [si+DPT_ADVANCED_ATA.bPioMode]
228 jz SHORT .NoDotSetFastPioFlag
229 cmp WORD [si+DPT_ADVANCED_ATA.wControllerID], BYTE 0
230 je SHORT .NoDotSetFastPioFlag
231 inc cx ; FLG_FAST_PIO_ENABLED
232.NoDotSetFastPioFlag:
233%endif
234 call StoswThenAddALandAHtoDL ; Bytes 8 and 9
235
236 ; Set CHS translation flags and store DPTE.wFlags
237 mov al, [si+DPT.bFlagsLow]
238 and al, MASKL_DPT_TRANSLATEMODE
239 jz SHORT .NoChsTranslationOrBitShiftTranslationSet
240 or cl, FLG_CHS_TRANSLATION_ENABLED
241 test al, FLGL_DPT_ASSISTED_LBA
242 jz SHORT .NoChsTranslationOrBitShiftTranslationSet
243 or cx, LBA_ASSISTED_TRANSLATION << TRANSLATION_TYPE_FIELD_POSITION
244.NoChsTranslationOrBitShiftTranslationSet:
245 xchg ax, cx
246 call StoswThenAddALandAHtoDL ; Bytes 10 and 11
247
248 ; DPTE.wReserved (must be zero)
249 xor ax, ax
250 call StoswThenAddALandAHtoDL ; Bytes 12 and 13
251
252 ; DPTE.bRevision and DPTE.bChecksum
253 mov al, DPTE_REVISION
254 call StoswALandChecksumFromDL ; Bytes 14 and 15
255 lea bx, [di-DPTE_size]
256 ret
[550]257%endif ; MODULE_EBIOS
[541]258
259
260;--------------------------------------------------------------------
261; StoswThenAddALandAHtoDL
262; Parameters:
263; AX: WORD to store
264; DL: Sum of bytes so far
265; ES:DI: Ptr to where to store AX
266; Returns:
267; DL: Sum of bytes so far
268; DI: Incremented by 2
269; Corrupts registers:
270; Nothing
271;--------------------------------------------------------------------
272StoswThenAddALandAHtoDL:
273 stosw
274 add dl, al
275 add dl, ah
276 ret
277
278
279;--------------------------------------------------------------------
280; StoswALandChecksumFromDL
281; Parameters:
282; AL: Last byte to store before checksum byte
283; DL: Sum of bytes so far
284; ES:DI: Ptr to where to store AL and Checksum byte
285; Returns:
286; DL: Sum of bytes so far
287; DI: Incremented by 2
288; Corrupts registers:
289; Nothing
290;--------------------------------------------------------------------
291StoswALandChecksumFromDL:
292 mov ah, al
293 add ah, dl
294 neg ah
295 stosw
296 ret
Note: See TracBrowser for help on using the repository browser.