source: xtideuniversalbios/trunk/XTIDE_Universal_BIOS/Src/Initialization/AtaID.asm@ 553

Last change on this file since 553 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: 8.5 KB
Line 
1; Project name : XTIDE Universal BIOS
2; Description : Functions for accessing ATA information read with
3; IDENTIFY DEVICE command.
4
5;
6; XTIDE Universal BIOS and Associated Tools
7; Copyright (C) 2009-2010 by Tomi Tilli, 2011-2013 by XTIDE Universal BIOS Team.
8;
9; This program is free software; you can redistribute it and/or modify
10; it under the terms of the GNU General Public License as published by
11; the Free Software Foundation; either version 2 of the License, or
12; (at your option) any later version.
13;
14; This program is distributed in the hope that it will be useful,
15; but WITHOUT ANY WARRANTY; without even the implied warranty of
16; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17; GNU General Public License for more details.
18; Visit http://www.gnu.org/licenses/old-licenses/gpl-2.0.html
19;
20
21; Section containing code
22SECTION .text
23
24;--------------------------------------------------------------------
25; AtaID_VerifyFromESSI
26; Parameters:
27; ES:SI: Ptr to 512-byte ATA information read from the drive
28; Returns:
29; CF: Set if failed to verify ATA-ID
30; Cleared if ATA-ID verified successfully
31; Corrupts registers:
32; AX, BX, CX
33;--------------------------------------------------------------------
34AtaID_VerifyFromESSI:
35 ; We cannot start by reading ATA version since the ID might be
36 ; corrupted. We start by making sure P-CHS values are valid.
37 ; If they are, we assume the ATA ID to be valid. Fortunately we can do
38 ; further checking for ATA-5 and later since they contain signature and
39 ; checksum bytes. Those are not available for ATA-4 and older.
40
41 ; Verify P-CHS cylinders
42 mov bx, ATA1.wCylCnt
43 mov cx, MAX_VALID_PCHS_CYLINDERS
44 call .CompareCHorSfromOffsetBXtoMaxValueInCX
45
46 mov bl, ATA1.wHeadCnt & 0FFh
47 mov cx, MAX_VALID_PCHS_HEADS
48 call .CompareCHorSfromOffsetBXtoMaxValueInCX
49
50 mov bl, ATA1.wSPT & 0FFh
51 mov cl, MAX_VALID_PCHS_SECTORS_PER_TRACK
52 call .CompareCHorSfromOffsetBXtoMaxValueInCX
53
54 ; Check signature byte. It is only found on ATA-5 and later. It should be zero on
55 ; ATA-4 and older.
56 mov al, [es:si+ATA6.bSignature]
57 test al, al
58 jz SHORT .AtaIDverifiedSuccessfully ; Old ATA so Signature and Checksum is not available
59 cmp al, A6_wIntegrity_SIGNATURE
60 jne SHORT .FailedToVerifyAtaID
61
62 ; Check checksum byte since signature was present
63 mov cx, ATA6_size
64 call Memory_SumCXbytesFromESSItoAL ; Returns with ZF set according to result
65 jnz SHORT .FailedToVerifyAtaID
66
67 ; ATA-ID is now verified to be valid
68.AtaIDverifiedSuccessfully:
69 clc
70 ret
71
72;--------------------------------------------------------------------
73; .CompareCHorSfromOffsetBXtoMaxValueInCX
74; Parameters:
75; BX: C, H or S offset to ATA-ID
76; CX: Maximum valid C, H or S value
77; ES:SI: Ptr to 512-byte ATA information read from the drive
78; Returns:
79; Exits from AtaID_VerifyFromESSI with CF set if invalid value
80; Corrupts registers:
81; AX
82;--------------------------------------------------------------------
83.CompareCHorSfromOffsetBXtoMaxValueInCX:
84 mov ax, [es:bx+si]
85 test ax, ax
86 jz SHORT .InvalidPCHorSinOffsetBX
87 cmp ax, cx ; Compare to max valid value
88 jbe SHORT .ValidPCHorSinOffsetBX
89.InvalidPCHorSinOffsetBX:
90 add sp, BYTE 2 ; Clear return address for this function
91.FailedToVerifyAtaID:
92 stc ; Set carry to indicate invalid ATA-ID
93.ValidPCHorSinOffsetBX:
94 ret
95
96
97;--------------------------------------------------------------------
98; Writes user defined limits from ROMVARS to ATA ID read from the drive.
99; Modifying the ATA ID reduces code and possibilites for bugs since
100; only little furher checks are needed elsewhere.
101;
102; AtaID_ModifyESSIforUserDefinedLimitsAndReturnTranslateModeInDX
103; Parameters:
104; DS:DI: Ptr to incomplete Disk Parameter Table
105; ES:SI: Ptr to 512-byte ATA information read from the drive
106; CS:BP: Ptr to IDEVARS for the controller
107; Returns:
108; DX: User defined P-CHS to L-CHS translate mode
109; Corrupts registers:
110; AX, BX, CX
111;--------------------------------------------------------------------
112AtaID_ModifyESSIforUserDefinedLimitsAndReturnTranslateModeInDX:
113 call AccessDPT_GetPointerToDRVPARAMStoCSBX
114 push ds
115 push es
116 pop ds ; DS:SI now points to ATA information
117
118 ; Load User Defined CHS or LBA to CX:AX
119 mov dx, [cs:bx+DRVPARAMS.wFlags]
120 mov ax, [cs:bx+DRVPARAMS.wCylinders] ; Or .dwMaximumLBA
121 mov cx, [cs:bx+DRVPARAMS.wHeadsAndSectors] ; Or .dwMaximumLBA+2
122
123 ; * User defined CHS *
124 test dl, FLG_DRVPARAMS_USERCHS
125 jz SHORT .NoUserDefinedCHS
126
127 ; Apply new CHS and disable LBA (we also want to set CHS addressing)
128 mov [si+ATA1.wCylCnt], ax
129 eMOVZX ax, cl
130 mov [si+ATA1.wHeadCnt], ax
131 mov al, ch
132 mov [si+ATA1.wSPT], ax
133 and BYTE [si+ATA1.wCaps+1], ~(A1_wCaps_LBA>>8)
134 and BYTE [si+ATA6.wSetSup83+1], ~(A6_wSetSup83_LBA48>>8)
135.NoUserDefinedCHS:
136
137 ; * User defined LBA *
138 test dl, FLG_DRVPARAMS_USERLBA
139 jz SHORT .NoUserDefinedLBA
140
141 ; Apply new LBA and disable LBA48
142 cmp cx, [si+ATA1.dwLBACnt+2]
143 ja SHORT .NoUserDefinedLBA ; Do not set larger than drive
144 jb SHORT .StoreNewLBA
145 cmp ax, [si+ATA1.dwLBACnt]
146 ja SHORT .NoUserDefinedLBA ; Allow same size to disable LBA48
147.StoreNewLBA:
148 mov [si+ATA1.dwLBACnt], ax
149 mov [si+ATA1.dwLBACnt+2], cx
150 and BYTE [si+ATA6.wSetSup83+1], ~(A6_wSetSup83_LBA48>>8)
151.NoUserDefinedLBA:
152
153 ; * Load P-CHS to L-CHS translate mode to DX *
154 and dx, BYTE MASK_DRVPARAMS_TRANSLATEMODE
155 eSHR_IM dx, TRANSLATEMODE_FIELD_POSITION
156
157 pop ds
158 ret
159
160
161%ifdef MODULE_ADVANCED_ATA
162;--------------------------------------------------------------------
163; AtaID_GetMaxPioModeToAXandMinCycleTimeToCX
164; Parameters:
165; ES:SI: Ptr to 512-byte ATA information read from the drive
166; Returns:
167; AL: Max supported PIO mode
168; AH: FLGH_DPT_IORDY if IORDY supported, zero otherwise
169; CX: Minimum Cycle Time in nanosecs
170; Corrupts registers:
171; BX
172;--------------------------------------------------------------------
173AtaID_GetMaxPioModeToAXandMinCycleTimeToCX:
174 ; Get PIO mode and cycle time for PIO 0...2
175 mov bx, [es:si+ATA1.bPioMode]
176 mov ax, bx ; AH = 0, AL = PIO mode 0, 1 or 2
177 eSHL_IM bx, 1 ; Shift for WORD lookup
178 mov cx, [cs:bx+.rgwPio0to2CycleTimeInNanosecs]
179
180 ; Check if IORDY is supported
181 test BYTE [es:si+ATA2.wCaps+1], A2_wCaps_IORDY >> 8
182 jz SHORT .ReturnPioTimings ; No PIO 3 or higher if no IORDY
183 mov ah, FLGH_DPT_IORDY
184
185 ; Check if Advanced PIO modes are supported (3 and above)
186 test BYTE [es:si+ATA2.wFields], A2_wFields_64to70
187 jz SHORT .ReturnPioTimings
188
189 ; Get Advanced PIO mode
190 ; (Hard Disks supports up to 4 but CF cards can support 5 and 6)
191 mov bl, [es:si+ATA2.bPIOSupp]
192.CheckNextFlag:
193 inc ax
194 shr bl, 1
195 jnz SHORT .CheckNextFlag
196 MIN_U al, 6 ; Make sure not above lookup tables
197 mov cx, [es:si+ATA2.wPIOMinCyF] ; Advanced modes use IORDY
198.ReturnPioTimings:
199 ret
200
201.rgwPio0to2CycleTimeInNanosecs:
202 dw PIO_0_MIN_CYCLE_TIME_NS
203 dw PIO_1_MIN_CYCLE_TIME_NS
204 dw PIO_2_MIN_CYCLE_TIME_NS
205
206
207;--------------------------------------------------------------------
208; AtaID_GetRecoveryTimeToAXfromPioModeInBXandCycleTimeInCX
209; Parameters:
210; BX: PIO Mode
211; CX: PIO Cycle Time in nanosecs
212; Returns:
213; AX: Active Time in nanosecs
214; Corrupts registers:
215; BX, CX
216;--------------------------------------------------------------------
217AtaID_GetRecoveryTimeToAXfromPioModeInBXandCycleTimeInCX:
218 call AtaID_GetActiveTimeToAXfromPioModeInBX
219 mov bl, [cs:bx+.rgbPioModeToAddressValidTimeNs]
220 sub cx, bx ; Cycle Time (t0) - Address Valid Time (t1)
221 sub cx, ax ; - Active Time (t2)
222 xchg ax, cx ; AX = Recovery Time (t2i)
223 ret
224
225.rgbPioModeToAddressValidTimeNs:
226 db PIO_0_MIN_ADDRESS_VALID_NS
227 db PIO_1_MIN_ADDRESS_VALID_NS
228 db PIO_2_MIN_ADDRESS_VALID_NS
229 db PIO_3_MIN_ADDRESS_VALID_NS
230 db PIO_4_MIN_ADDRESS_VALID_NS
231 db PIO_5_MIN_ADDRESS_VALID_NS
232 db PIO_6_MIN_ADDRESS_VALID_NS
233
234
235;--------------------------------------------------------------------
236; AtaID_GetActiveTimeToAXfromPioModeInBX
237; Parameters:
238; BX: PIO Mode
239; Returns:
240; AX: Active Time in nanosecs
241; Corrupts registers:
242; Nothing
243;--------------------------------------------------------------------
244AtaID_GetActiveTimeToAXfromPioModeInBX:
245 eMOVZX ax, [cs:bx+.rgbPioModeToActiveTimeNs]
246 ret
247
248.rgbPioModeToActiveTimeNs:
249 db PIO_0_MIN_ACTIVE_TIME_NS
250 db PIO_1_MIN_ACTIVE_TIME_NS
251 db PIO_2_MIN_ACTIVE_TIME_NS
252 db PIO_3_MIN_ACTIVE_TIME_NS
253 db PIO_4_MIN_ACTIVE_TIME_NS
254 db PIO_5_MIN_ACTIVE_TIME_NS
255 db PIO_6_MIN_ACTIVE_TIME_NS
256
257%endif ; MODULE_ADVANCED_ATA
Note: See TracBrowser for help on using the repository browser.