source: xtideuniversalbios/trunk/XTIDE_Universal_BIOS/Src/Handlers/Int13h/AH9h_HInit.asm @ 618

Last change on this file since 618 was 618, checked in by krille_n_, 3 years ago

Changes:

  • Updated the BIOS makefile. Added the NO_ATAID_CORRECTION define back to the Tiny build as I've realized that the correction code should not be needed for builds without MODULE_EBIOS. Also added a new makefile target 'custom' to make it easier for people to make custom builds.
  • Fixed a bug where calling INT 13h/AH=15h for drives not handled by XUB (floppy drives for example) would return an error due to the fact that any non-zero return value in AH from the other BIOS would cause the CF to be set in Int13h_SetErrorCodeToIntpackInSSBPfromAH. The return path is now via Int13h_ReturnFromHandlerWithoutStoringErrorCode which means that no status/error code will be returned in the BDA but that should not be a problem as the other BIOS should do that anyway. This change also fixed another potential problem where return values in DL from the other BIOS were assumed to be drive numbers when MODULE_SERIAL_FLOPPY is included in the build.
  • Minor optimizations and fixes.
File size: 9.7 KB
Line 
1; Project name  :   XTIDE Universal BIOS
2; Description   :   Int 13h function AH=9h, Initialize Drive Parameters.
3
4;
5; XTIDE Universal BIOS and Associated Tools
6; Copyright (C) 2009-2010 by Tomi Tilli, 2011-2013 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; STORE_ERROR_FLAG_TO_DPT
25;   Parameters:
26;       %1:     Error flag to set
27;       AH:     BIOS Error Code
28;       DS:DI:  Ptr to DPT
29;       CF:     Set if error code in AH
30;   Returns:
31;       CF:     Clear if no error
32;               Set if error flag was set
33;   Corrupts registers:
34;       Nothing
35;--------------------------------------------------------------------
36%macro STORE_ERROR_FLAG_TO_DPT 1
37    mov     al, %1
38    call    SetErrorFlagFromALwithErrorCodeInAH
39%endmacro
40
41
42;--------------------------------------------------------------------
43; Int 13h function AH=9h, Initialize Drive Parameters.
44;
45; AH9h_HandlerForInitializeDriveParameters
46;   Parameters:
47;       DL:     Translated Drive number
48;       DS:DI:  Ptr to DPT (in RAMVARS segment)
49;       SS:BP:  Ptr to IDEPACK
50;   Returns with INTPACK:
51;       AH:     Int 13h return status
52;       CF:     0 if successful, 1 if error
53;--------------------------------------------------------------------
54AH9h_HandlerForInitializeDriveParameters:
55%ifndef USE_186
56    call    AH9h_InitializeDriveForUse
57    jmp     Int13h_ReturnFromHandlerAfterStoringErrorCodeFromAH
58%else
59    push    Int13h_ReturnFromHandlerAfterStoringErrorCodeFromAH
60    ; Fall to AH9h_InitializeDriveForUse
61%endif
62
63
64;--------------------------------------------------------------------
65; Initialize drive to be ready for use.
66;
67; AH9h_InitializeDriveForUse
68;   Parameters:
69;       DS:DI:  Ptr to DPT (in RAMVARS segment)
70;       SS:BP:  Ptr to IDEPACK
71;   Returns:
72;       AH:     Int 13h return status
73;       CF:     0 if successful, 1 if error
74;   Corrupts registers:
75;       AL, CX
76;--------------------------------------------------------------------
77AH9h_InitializeDriveForUse:
78    xor     ax, ax              ; Clear AH to assume no errors
79
80%ifdef MODULE_ADVANCED_ATA
81    ; Clear Initialization Error flags from DPT
82    mov     [di+DPT.bInitError], al
83%endif
84
85%ifdef MODULE_SERIAL
86    ; No need to do this for serial devices
87    test    BYTE [di+DPT.bFlagsHigh], FLGH_DPT_SERIAL_DEVICE    ; Clears CF
88    jz      SHORT .ContinueInitialization
89    ret     ; With AH and CF cleared
90.ContinueInitialization:
91%endif
92
93    push    es
94    push    si
95    push    dx
96    push    bx
97
98
99;;; SelectDrive
100    ; Try to select drive and wait until ready
101    call    AccessDPT_GetDriveSelectByteToAL
102    mov     [bp+IDEPACK.bDrvAndHead], al
103    call    Device_SelectDrive
104    STORE_ERROR_FLAG_TO_DPT     FLG_INITERROR_FAILED_TO_SELECT_DRIVE
105%ifdef USE_386
106    jc      .ReturnWithErrorCodeInAH
107%else
108    jnc     SHORT .ContinueInitializationSinceDriveSelectedSuccessfully
109    jmp     .ReturnWithErrorCodeInAH
110.ContinueInitializationSinceDriveSelectedSuccessfully:
111%endif
112
113
114%ifdef MODULE_8BIT_IDE_ADVANCED
115;;; Set XT-CF mode
116    call    AH1Eh_GetCurrentXTCFmodeToAX
117    call    AH9h_SetModeFromALtoXTCF
118    STORE_ERROR_FLAG_TO_DPT     FLG_INITERROR_FAILED_TO_SET_XTCF_MODE
119%endif  ; MODULE_8BIT_IDE_ADVANCED
120
121%ifdef MODULE_8BIT_IDE
122;;; Set 8-bit PIO mode
123    call    AH9h_Enable8bitModeForDevice8bitAta
124    STORE_ERROR_FLAG_TO_DPT     FLG_INITERROR_FAILED_TO_SET_8BIT_MODE
125%endif ; MODULE_8BIT_IDE
126
127
128;;; InitializeDeviceParameters
129    ; Initialize Logical Sectors per Track and Max Head number
130    mov     ax, [di+DPT.wPchsHeadsAndSectors]
131    dec     ax                          ; Max Head number
132    xchg    ah, al
133    mov     dl, al                      ; Sectors per track
134    mov     al, COMMAND_INITIALIZE_DEVICE_PARAMETERS
135    mov     bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_BSY, FLG_STATUS_BSY)
136    call    Idepack_StoreNonExtParametersAndIssueCommandFromAL
137    STORE_ERROR_FLAG_TO_DPT     FLG_INITERROR_FAILED_TO_INITIALIZE_CHS_PARAMETERS
138
139
140;;; SetWriteCache
141    ; Enable or Disable Write Cache
142    call    AccessDPT_GetPointerToDRVPARAMStoCSBX
143    mov     bl, [cs:bx+DRVPARAMS.wFlags]
144    push    bx  ; Save .wFlags for later use in InitializeBlockMode
145    and     bx, BYTE MASK_DRVPARAMS_WRITECACHE
146    jz      SHORT .SkipSetWriteCache        ; DEFAULT_WRITE_CACHE
147    mov     si, [cs:bx+.rgbWriteCacheCommands]
148    call    AH23h_SetControllerFeatures
149    STORE_ERROR_FLAG_TO_DPT     FLG_INITERROR_FAILED_TO_SET_WRITE_CACHE
150.SkipSetWriteCache:
151
152
153;;; RecalibrateDrive
154    ; Recalibrate drive by seeking to cylinder 0
155    call    AH11h_RecalibrateDrive
156    STORE_ERROR_FLAG_TO_DPT     FLG_INITERROR_FAILED_TO_RECALIBRATE_DRIVE
157
158
159;;; InitializeBlockMode
160    ; Initialize block mode transfers
161    pop     ax  ; Restore .wFlags saved in SetWriteCache
162    test    al, FLG_DRVPARAMS_BLOCKMODE ; Tested here so block mode can be enabled with AH=24h
163    jz      SHORT .BlockModeDisabled
164
165    ; Try block sizes until we find largest possible supported by drive
166    mov     bl, 128
167.TryNextBlockSize:
168    mov     al, bl
169    call    AH24h_SetBlockSize  ; Stores block size to DPT
170    jnc     SHORT .SupportedBlockSizeFound
171    shr     bl, 1
172    jnc     SHORT .TryNextBlockSize
173    STORE_ERROR_FLAG_TO_DPT     FLG_INITERROR_FAILED_TO_SET_BLOCK_MODE
174.BlockModeDisabled:
175.SupportedBlockSizeFound:
176
177
178%ifdef MODULE_ADVANCED_ATA
179;;; InitializePioMode
180    ; Initialize fastest supported PIO mode
181    mov     dl, PIO_DEFAULT_MODE_DISABLE_IORDY
182    test    BYTE [di+DPT.bFlagsHigh], FLGH_DPT_IORDY
183    jz      SHORT .IordyNotSupported
184
185    ; Advanced PIO mode 3 and above
186    mov     dl, PIO_FLOW_CONTROL_MODE_xxx
187    or      dl, [di+DPT_ADVANCED_ATA.bPioMode]
188
189.IordyNotSupported:
190    mov     si, FEATURE_SET_TRANSFER_MODE
191    call    AH23h_SetControllerFeatures
192    STORE_ERROR_FLAG_TO_DPT     FLG_INITERROR_FAILED_TO_SET_PIO_MODE
193%endif ; MODULE_ADVANCED_ATA
194
195
196%ifdef MODULE_POWER_MANAGEMENT
197;;; InitStandbyTimer
198    ; Initialize the standby timer (if supported)
199    mov     dh, [di+DPT.bFlagsHigh]
200    test    dh, FLGH_DPT_POWER_MANAGEMENT_SUPPORTED
201    jz      SHORT .NoPowerManagementSupport
202
203    ; Do we need to disable APM?
204    mov     dl, [cs:ROMVARS.bIdleTimeout]
205    push    dx
206    test    dh, FLGH_DPT_APM_SUPPORTED
207    jz      SHORT .NoAdvancedPowerManagementSupport
208    call    AH23h_EnableOrDisableAdvancedPowerManagement
209.NoAdvancedPowerManagementSupport:
210
211    ; COMMAND_IDLE is not enough for Toshiba 1,8" HDD since idle mode is the default mode
212    ; COMMAND_STAND_BY seemed to do the trick
213    pop     dx
214    push    dx
215    mov     al, COMMAND_STAND_BY
216    mov     bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_BSY, FLG_STATUS_BSY)
217    call    Idepack_StoreNonExtParametersAndIssueCommandFromAL
218    STORE_ERROR_FLAG_TO_DPT     FLG_INITERROR_FAILED_TO_INITIALIZE_STANDBY_TIMER
219
220    pop     dx
221    mov     al, COMMAND_IDLE
222    mov     bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_BSY, FLG_STATUS_BSY)
223    call    Idepack_StoreNonExtParametersAndIssueCommandFromAL
224    STORE_ERROR_FLAG_TO_DPT     FLG_INITERROR_FAILED_TO_INITIALIZE_STANDBY_TIMER
225.NoPowerManagementSupport:
226%endif ; MODULE_POWER_MANAGEMENT
227
228
229    ; There might have been several errors so just return one error code for them all
230.ReturnWithErrorCodeInAH:
231%ifdef MODULE_ADVANCED_ATA
232    mov     ah, [di+DPT.bInitError]
233    test    ah, ah  ; Clears CF
234    jz      SHORT .ReturnWithSuccess
235    mov     ah, RET_HD_RESETFAIL
236    stc
237.ReturnWithSuccess:
238%endif
239
240    pop     bx
241    pop     dx
242    pop     si
243    pop     es
244    ret
245
246
247.rgbWriteCacheCommands:
248    db      0                               ; DEFAULT_WRITE_CACHE
249    db      FEATURE_DISABLE_WRITE_CACHE     ; DISABLE_WRITE_CACHE
250    db      FEATURE_ENABLE_WRITE_CACHE      ; ENABLE_WRITE_CACHE
251
252
253
254%ifdef MODULE_8BIT_IDE
255;--------------------------------------------------------------------
256; AH9h_Enable8bitModeForDevice8bitAta
257;   Parameters:
258;       DS:DI:  Ptr to DPT (in RAMVARS segment)
259;       SS:BP:  Ptr to IDEPACK
260;   Returns:
261;       AH:     Int 13h return status
262;       CF:     Clear if successful or device is not DEVICE_8BIT_ATA
263;               Set if failed to set 8-bit mode for DEVICE_8BIT_ATA
264;   Corrupts registers:
265;       AL, BX, CX, DX, SI
266;--------------------------------------------------------------------
267AH9h_Enable8bitModeForDevice8bitAta:
268    cmp     BYTE [di+DPT_ATA.bDevice], DEVICE_8BIT_ATA
269%ifdef MODULE_8BIT_IDE_ADVANCED
270    jne     SHORT IgnoreInvalidCommandError
271    jmp     AH23h_Enable8bitPioMode
272%else ; ~MODULE_8BIT_IDE_ADVANCED
273    je      AH23h_Enable8bitPioMode
274    ; Fall to IgnoreInvalidCommandError
275%endif ; MODULE_8BIT_IDE_ADVANCED
276%endif ; MODULE_8BIT_IDE
277
278
279%ifdef MODULE_8BIT_IDE_ADVANCED
280;--------------------------------------------------------------------
281; AH9h_SetModeFromALtoXTCF
282;   Parameters:
283;       AL:     XT-CF Mode to set
284;       DS:DI:  Ptr to DPT (in RAMVARS segment)
285;       SS:BP:  Ptr to IDEPACK
286;   Returns:
287;       AH:     Int 13h return status
288;       CF:     Clear if successful or device is not XT-CF
289;               Set if failed to set mode for XT-CF
290;   Corrupts registers:
291;       AL, BX, CX, DX, SI
292;--------------------------------------------------------------------
293AH9h_SetModeFromALtoXTCF:
294    call    AccessDPT_IsThisDeviceXTCF
295    jnc     AH1Eh_ChangeXTCFmodeBasedOnModeInAL
296    ; Fall to IgnoreInvalidCommandError
297%endif ; MODULE_8BIT_IDE_ADVANCED
298
299
300;--------------------------------------------------------------------
301; SetErrorFlagFromALwithErrorCodeInAH
302;   Parameters:
303;       AH:     BIOS Error Code
304;       AL:     Error flag to set
305;       DS:DI:  Ptr to DPT
306;       CF:     Set if error code in AH
307;               Clear if AH = 0
308;   Returns:
309;       CF:     Clear if no error
310;               Set if error flag was set
311;   Corrupts registers:
312;       Nothing
313;--------------------------------------------------------------------
314IgnoreInvalidCommandError:
315    xor     ah, ah  ; Clears CF
316SetErrorFlagFromALwithErrorCodeInAH:
317    jnc     SHORT .NoErrorFlagToSet
318    cmp     ah, RET_HD_INVALID
319    jbe     SHORT IgnoreInvalidCommandError
320
321    or      [di+DPT.bInitError], al
322    stc
323.NoErrorFlagToSet:
324    ret
Note: See TracBrowser for help on using the repository browser.