source: xtideuniversalbios/trunk/XTIDE_Universal_BIOS/Src/Handlers/Int13h/Tools/Address.asm@ 502

Last change on this file since 502 was 422, checked in by aitotat@…, 13 years ago

Changes to XTIDE Universal BIOS:

  • Modified ROMVARS for user defined CHS translation mode.
  • Base DPT struct now includes initialization error flags again.
File size: 6.5 KB
Line 
1; Project name : XTIDE Universal BIOS
2; Description : Functions for address translations.
3
4;
5; XTIDE Universal BIOS and Associated Tools
6; Copyright (C) 2009-2010 by Tomi Tilli, 2011-2012 by XTIDE Universal BIOS Team.
7;
8; This program is free software; you can redistribute it and/or modify
9; it under the terms of the GNU General Public License as published by
10; the Free Software Foundation; either version 2 of the License, or
11; (at your option) any later version.
12;
13; This program is distributed in the hope that it will be useful,
14; but WITHOUT ANY WARRANTY; without even the implied warranty of
15; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16; GNU General Public License for more details.
17; Visit http://www.gnu.org/licenses/old-licenses/gpl-2.0.html
18;
19
20; Section containing code
21SECTION .text
22
23;---------------------------------------------------------------------
24; Address_ExtractLCHSparametersFromOldInt13hAddress
25; Parameters:
26; CH: Cylinder number, bits 7...0
27; CL: Bits 7...6: Cylinder number bits 9 and 8
28; Bits 5...0: Sector number
29; DH: Head number
30; Returns:
31; BL: Sector number (1...63)
32; BH: Head number (0...255)
33; CX: Cylinder number (0...1023)
34; Corrupts registers:
35; Nothing
36;--------------------------------------------------------------------
37ALIGN JUMP_ALIGN
38Address_ExtractLCHSparametersFromOldInt13hAddress:
39 mov bl, cl ; Copy sector number...
40 and bl, 3Fh ; ...and limit to 1...63
41 sub cl, bl ; Remove from cylinder number high
42 eROL_IM cl, 2 ; High bits to beginning
43 mov bh, dh ; Copy Head number
44 xchg cl, ch ; Cylinder number now in CX
45 ret
46
47
48;---------------------------------------------------------------------
49; Converts LARGE addressing mode LCHS parameters to IDE P-CHS parameters.
50; PCylinder = (LCylinder << n) + (LHead / PHeadCount)
51; PHead = LHead % PHeadCount
52; PSector = LSector
53;
54; ConvertLargeModeLCHStoPCHS:
55; Parameters:
56; BL: Sector number (1...63)
57; BH: Head number (0...239)
58; CX: Cylinder number (0...1023)
59; DS:DI: Ptr to Disk Parameter Table
60; Returns:
61; BL: Sector number (1...63)
62; BH: Head number (0...15)
63; CX: Cylinder number (0...16382)
64; Corrupts registers:
65; AX, DX
66;--------------------------------------------------------------------
67ALIGN JUMP_ALIGN
68ConvertLargeModeLCHStoPCHS:
69 ; LHead / PHeadCount and LHead % PHeadCount
70 eMOVZX ax, bh ; Copy L-CHS Head number to AX
71 div BYTE [di+DPT.bPchsHeads]; AL = LHead / PHeadCount, AH = LHead % PHeadCount
72 mov bh, ah ; Copy P-CHS Head number to BH
73 xor ah, ah ; AX = LHead / PHeadCount
74
75 ; (LCylinder << n) + (LHead / PHeadCount)
76 mov dx, cx ; Copy L-CHS Cylinder number to DX
77 mov cl, [di+DPT.bFlagsLow] ; Load shift count
78 and cl, MASKL_DPT_CHS_SHIFT_COUNT
79 shl dx, cl ; DX = LCylinder << n
80 add ax, dx ; AX = P-CHS Cylinder number
81 xchg cx, ax ; Move P-CHS Cylinder number to CX
82DoNotConvertLCHS:
83 ret
84
85
86;--------------------------------------------------------------------
87; Address_OldInt13hAddressToIdeAddress
88; Parameters:
89; CH: Cylinder number, bits 7...0
90; CL: Bits 7...6: Cylinder number bits 9 and 8
91; Bits 5...0: Starting sector number (1...63)
92; DH: Starting head number (0...255)
93; DS:DI: Ptr to DPT
94; Returns:
95; BL: LBA Low Register / Sector Number Register (LBA 7...0)
96; CL: LBA Mid Register / Low Cylinder Register (LBA 15...8)
97; CH: LBA High Register / High Cylinder Register (LBA 23...16)
98; BH: Drive and Head Register (LBA 27...24)
99; Corrupts registers:
100; AX, DX
101;--------------------------------------------------------------------
102ALIGN JUMP_ALIGN
103Address_OldInt13hAddressToIdeAddress:
104 call Address_ExtractLCHSparametersFromOldInt13hAddress
105 ACCESSDPT__GET_UNSHIFTED_TRANSLATE_MODE_TO_AXZF
106
107;;; 0: ADDRESSING_MODE_NORMAL
108 jz SHORT DoNotConvertLCHS
109
110;;; 1: ADDRESSING_MODE_LARGE
111 test al, FLGL_DPT_ASSISTED_LBA
112 jz SHORT ConvertLargeModeLCHStoPCHS
113
114;;; 2: ADDRESSING_MODE_ASSISTED_LBA
115 ; Fall through to ConvertAssistedLBAModeLCHStoLBARegisterValues
116
117
118;---------------------------------------------------------------------
119; Converts LCHS parameters to 28-bit LBA address.
120; Only 24-bits are used since LHCS to LBA28 conversion has 8.4GB limit.
121; LBA = ((cylToSeek*headsPerCyl+headToSeek)*sectPerTrack)+sectToSeek-1
122;
123; Returned address is in same registers that
124; DoNotConvertLCHS and ConvertLargeModeLCHStoPCHS returns.
125;
126; ConvertAssistedLBAModeLCHStoLBARegisterValues:
127; Parameters:
128; BL: Sector number (1...63)
129; BH: Head number (0...254)
130; CX: Cylinder number (0...1023)
131; DS:DI: Ptr to Disk Parameter Table
132; Returns:
133; BL: LBA Low Register / Sector Number Register (LBA 7...0)
134; CL: LBA Mid Register / Low Cylinder Register (LBA 15...8)
135; CH: LBA High Register / High Cylinder Register (LBA 23...16)
136; BH: Drive and Head Register (LBA 27...24)
137; Corrupts registers:
138; AX, DX
139;--------------------------------------------------------------------
140ConvertAssistedLBAModeLCHStoLBARegisterValues:
141 ; cylToSeek*headsPerCyl (18-bit result)
142 ; Max = 1023 * 255 = 260,865 = 3FB01h
143 mov ax, LBA_ASSIST_SPT ; Load Sectors per Track
144 xchg cx, ax ; Cylinder number to AX, Sectors per Track to CX
145%ifdef USE_386
146 movzx dx, [di+DPT.bLchsHeads]
147%else
148 cwd
149 mov dl, [di+DPT.bLchsHeads]
150%endif
151 mul dx ; DX:AX = cylToSeek*headsPerCyl
152
153 ; +=headToSeek (18-bit result)
154 ; Max = 260,865 + 254 = 261,119 = 3FBFFh
155 add al, bh ; Add Head number to DX:AX
156 adc ah, dh ; DH = Zero after previous multiplication
157 adc dl, dh
158
159 ; *=sectPerTrack (18-bit by 6-bit multiplication with 24-bit result)
160 ; Max = 261,119 * 63 = 16,450,497 = FB03C1h
161 xchg ax, dx ; Hiword to AX, loword to DX
162 mul cl ; AX = hiword * Sectors per Track
163 mov bh, al ; Backup hiword * Sectors per Track
164 xchg ax, dx ; Loword back to AX
165 mul cx ; DX:AX = loword * Sectors per Track
166 add dl, bh ; DX:AX = (cylToSeek*headsPerCyl+headToSeek)*sectPerTrack
167
168 ; +=sectToSeek-1 (24-bit result)
169 ; Max = 16,450,497 + 63 - 1 = 16,450,559 = FB03FFh
170 xor bh, bh ; Sector number now in BX
171 dec bx ; sectToSeek-=1
172 add ax, bx ; Add to loword
173 adc dl, bh ; Add possible carry to byte2, BH=zero
174
175 ; Copy DX:AX to proper return registers
176 xchg bx, ax ; BL = Sector Number Register (LBA 7...0)
177 mov cl, bh ; Low Cylinder Register (LBA 15...8)
178 mov ch, dl ; High Cylinder Register (LBA 23...16)
179 mov bh, dh ; Drive and Head Register (LBA 27...24)
180 ret
Note: See TracBrowser for help on using the repository browser.