Context Navigation

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

Visit:

Last change on this file since 538 was 526, checked in by krille_n_@…, 11 years ago

Changes:

Update of the copyright notices to include the year 2013.

File size: 9.6 KB

Rev	Line
[148]	1	; Project name : XTIDE Universal BIOS
[3]	2	; Description : Int 13h function AH=9h, Initialize Drive Parameters.
	3
[376]	4	;
[399]	5	; XTIDE Universal BIOS and Associated Tools
[526]	6	; Copyright (C) 2009-2010 by Tomi Tilli, 2011-2013 by XTIDE Universal BIOS Team.
[376]	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.
[399]	12	;
[376]	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
[399]	16	; GNU General Public License for more details.
[376]	17	; Visit http://www.gnu.org/licenses/old-licenses/gpl-2.0.html
[399]	18	;
[376]	19
[3]	20	; Section containing code
	21	SECTION .text
	22
	23	;--------------------------------------------------------------------
[410]	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	;--------------------------------------------------------------------
[3]	43	; Int 13h function AH=9h, Initialize Drive Parameters.
	44	;
	45	; AH9h_HandlerForInitializeDriveParameters
	46	; Parameters:
[148]	47	; DL: Translated Drive number
	48	; DS:DI: Ptr to DPT (in RAMVARS segment)
[150]	49	; SS:BP: Ptr to IDEPACK
	50	; Returns with INTPACK:
[3]	51	; AH: Int 13h return status
[294]	52	; CF: 0 if successful, 1 if error
[3]	53	;--------------------------------------------------------------------
	54	AH9h_HandlerForInitializeDriveParameters:
[84]	55	%ifndef USE_186
[3]	56	call AH9h_InitializeDriveForUse
[148]	57	jmp Int13h_ReturnFromHandlerAfterStoringErrorCodeFromAH
[84]	58	%else
[148]	59	push Int13h_ReturnFromHandlerAfterStoringErrorCodeFromAH
[162]	60	; Fall to AH9h_InitializeDriveForUse
[84]	61	%endif
[3]	62
	63
	64	;--------------------------------------------------------------------
[399]	65	; Initialize drive to be ready for use.
[3]	66	;
	67	; AH9h_InitializeDriveForUse
	68	; Parameters:
[148]	69	; DS:DI: Ptr to DPT (in RAMVARS segment)
[150]	70	; SS:BP: Ptr to IDEPACK
[3]	71	; Returns:
	72	; AH: Int 13h return status
[294]	73	; CF: 0 if successful, 1 if error
[3]	74	; Corrupts registers:
[521]	75	; AL, CX
[3]	76	;--------------------------------------------------------------------
	77	AH9h_InitializeDriveForUse:
[410]	78	xor ax, ax ; Clear AH to assume no errors
[3]	79
[400]	80	%ifdef MODULE_ADVANCED_ATA
[399]	81	; Clear Initialization Error flags from DPT
[422]	82	mov [di+DPT.bInitError], al
[400]	83	%endif
[399]	84
[258]	85	%ifdef MODULE_SERIAL
[399]	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
[410]	90	.ContinueInitialization:
[258]	91	%endif
[294]	92
[399]	93	push es
	94	push si
[521]	95	push dx
	96	push bx
[399]	97
[410]	98
[399]	99	;;; SelectDrive
[3]	100	; Try to select drive and wait until ready
[421]	101	call AccessDPT_GetDriveSelectByteForOldInt13hToAL
[150]	102	mov [bp+IDEPACK.bDrvAndHead], al
	103	call Device_SelectDrive
[410]	104	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_SELECT_DRIVE
[505]	105	%ifdef USE_386
	106	jc .ReturnWithErrorCodeInAH
	107	%else
[410]	108	jnc SHORT .ContinueInitializationSinceDriveSelectedSuccesfully
	109	jmp .ReturnWithErrorCodeInAH
	110	.ContinueInitializationSinceDriveSelectedSuccesfully:
[505]	111	%endif
[399]	112
[3]	113
[473]	114	;;; Set XT-CF mode
[493]	115	%ifdef MODULE_8BIT_IDE_ADVANCED
[473]	116	call AccessDPT_GetIdevarsToCSBX
	117	mov al, [cs:bx+IDEVARS.bXTCFcontrolRegister]
[480]	118	call AH9h_SetModeFromALtoXTCF
[473]	119	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_SET_XTCF_MODE
	120	.DoNotSetXTCFmode:
[493]	121	%endif ; MODULE_8BIT_IDE_ADVANCED
[473]	122
[493]	123	%ifdef MODULE_8BIT_IDE
[480]	124	;;; Set 8-bit PIO mode
	125	call AH9h_Enable8bitModeForDevice8bitAta
	126	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_SET_8BIT_MODE
	127	.DoNotSet8bitMode:
	128	%endif ; MODULE_8BIT_IDE
	129
	130
[399]	131	;;; InitializeDeviceParameters
[421]	132	; Initialize CHS parameters if LBA is not used and
	133	; user has specified P-CHS parameters
	134	test BYTE [di+DPT.bFlagsLow], FLGL_DPT_ASSISTED_LBA
[399]	135	jnz SHORT .SkipInitializeDeviceParameters ; No need to initialize CHS parameters if LBA mode enabled
[421]	136	call AccessDPT_GetPointerToDRVPARAMStoCSBX
	137	test BYTE [cs:bx+DRVPARAMS.wFlags], FLG_DRVPARAMS_USERCHS ; User specified P-CHS?
	138	jz SHORT .SkipInitializeDeviceParameters
[3]	139
[157]	140	; Initialize Logical Sectors per Track and Max Head number
[421]	141	mov ax, [cs:bx+DRVPARAMS.wHeadsAndSectors]
	142	dec ax ; Max Head number
	143	xchg al, ah ; Heads now in AH
	144	mov dx, ax ; Sectors per Track now in DL
[150]	145	mov al, COMMAND_INITIALIZE_DEVICE_PARAMETERS
	146	mov bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_BSY, FLG_STATUS_BSY)
[399]	147	call Idepack_StoreNonExtParametersAndIssueCommandFromAL
[410]	148	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_INITIALIZE_CHS_PARAMETERS
[399]	149	.SkipInitializeDeviceParameters:
[3]	150
[410]	151
[399]	152	;;; SetWriteCache
	153	; Enable or Disable Write Cache
[276]	154	call AccessDPT_GetPointerToDRVPARAMStoCSBX
	155	mov bl, [cs:bx+DRVPARAMS.wFlags]
[399]	156	push bx ; Save .wFlags for later use in InitializeBlockMode
[276]	157	and bx, BYTE MASK_DRVPARAMS_WRITECACHE
[399]	158	jz SHORT .SkipSetWriteCache ; DEFAULT_WRITE_CACHE
[276]	159	mov si, [cs:bx+.rgbWriteCacheCommands]
[399]	160	call AH23h_SetControllerFeatures
[410]	161	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_SET_WRITE_CACHE
[399]	162	.SkipSetWriteCache:
[276]	163
[410]	164
[399]	165	;;; RecalibrateDrive
	166	; Recalibrate drive by seeking to cylinder 0
	167	call AH11h_RecalibrateDrive
[410]	168	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_RECALIBRATE_DRIVE
[276]	169
[399]	170
	171	;;; InitializeBlockMode
	172	; Initialize block mode transfers
	173	pop ax ; Restore .wFlags saved in SetWriteCache
	174	test BYTE [di+DPT.bFlagsHigh], FLGH_DPT_BLOCK_MODE_SUPPORTED
	175	jz SHORT .BlockModeNotSupportedOrDisabled
	176	test al, FLG_DRVPARAMS_BLOCKMODE
	177	jz SHORT .BlockModeNotSupportedOrDisabled
	178
	179	; Try block sizes until we find largest possible supported by drive
	180	mov bl, 128
	181	.TryNextBlockSize:
	182	mov al, bl
	183	call AH24h_SetBlockSize ; Stores block size to DPT
	184	jnc SHORT .SupportedBlockSizeFound
	185	shr bl, 1
	186	jnc SHORT .TryNextBlockSize
[410]	187	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_SET_BLOCK_MODE
[399]	188	.BlockModeNotSupportedOrDisabled:
	189	.SupportedBlockSizeFound:
	190
[410]	191
[363]	192	%ifdef MODULE_ADVANCED_ATA
[399]	193	;;; InitializePioMode
	194	; Initialize fastest supported PIO mode
[364]	195	mov dl, PIO_DEFAULT_MODE_DISABLE_IORDY
	196	test BYTE [di+DPT.bFlagsHigh], FLGH_DPT_IORDY
	197	jz SHORT .IordyNotSupported
	198
	199	; Advanced PIO mode 3 and above
	200	mov dl, [di+DPT_ADVANCED_ATA.bPioMode]
	201	or dl, PIO_FLOW_CONTROL_MODE_xxx
	202
	203	.IordyNotSupported:
[363]	204	mov si, FEATURE_SET_TRANSFER_MODE
[399]	205	call AH23h_SetControllerFeatures
[410]	206	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_SET_PIO_MODE
[399]	207	%endif ; MODULE_ADVANCED_ATA
[363]	208
[410]	209
[399]	210	%ifdef MODULE_FEATURE_SETS
	211	;;; InitStandbyTimer
	212	; Initialize the standby timer (if supported)
	213	test BYTE [di+DPT.bFlagsHigh], FLGH_DPT_POWER_MANAGEMENT_SUPPORTED
[410]	214	jz SHORT .NoPowerManagementSupport
[363]	215
[399]	216	mov al, COMMAND_IDLE
	217	mov dl, [cs:ROMVARS.bIdleTimeout]
	218	mov bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_BSY, FLG_STATUS_BSY)
	219	call Idepack_StoreNonExtParametersAndIssueCommandFromAL
[410]	220	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_INITIALIZE_STANDBY_TIMER
[399]	221	.NoPowerManagementSupport:
	222	%endif ; MODULE_FEATURE_SETS
	223
[410]	224
[399]	225	; There might have been several errors so just return one error code for them all
[410]	226	.ReturnWithErrorCodeInAH:
[400]	227	%ifdef MODULE_ADVANCED_ATA
[422]	228	mov ah, [di+DPT.bInitError]
[399]	229	test ah, ah ; Clears CF
[410]	230	jz SHORT .ReturnWithSuccess
[399]	231	mov ah, RET_HD_RESETFAIL
	232	stc
[410]	233	.ReturnWithSuccess:
[400]	234	%endif
[399]	235
[521]	236	pop bx
	237	pop dx
[399]	238	pop si
	239	pop es
[363]	240	ret
	241
	242
[410]	243	.rgbWriteCacheCommands:
	244	db 0 ; DEFAULT_WRITE_CACHE
	245	db FEATURE_DISABLE_WRITE_CACHE ; DISABLE_WRITE_CACHE
	246	db FEATURE_ENABLE_WRITE_CACHE ; ENABLE_WRITE_CACHE
	247
	248
	249
[363]	250	;--------------------------------------------------------------------
[410]	251	; SetErrorFlagFromALwithErrorCodeInAH
[363]	252	; Parameters:
	253	; AH: BIOS Error Code
	254	; AL: Error flag to set
	255	; DS:DI: Ptr to DPT
[410]	256	; CF: Set if error code in AH
	257	; Clear if AH = 0
[363]	258	; Returns:
	259	; CF: Clear if no error
	260	; Set if error flag was set
	261	; Corrupts registers:
[370]	262	; Nothing
[363]	263	;--------------------------------------------------------------------
[410]	264	IgnoreInvalidCommandError:
[399]	265	xor ah, ah ; Clears CF
[410]	266	SetErrorFlagFromALwithErrorCodeInAH:
[365]	267	jnc SHORT .NoErrorFlagToSet
[363]	268	cmp ah, RET_HD_INVALID
[410]	269	jbe SHORT IgnoreInvalidCommandError
[363]	270
[422]	271	or [di+DPT.bInitError], al
[363]	272	stc
[365]	273	.NoErrorFlagToSet:
[3]	274	ret
[480]	275
	276
[493]	277	%ifdef MODULE_8BIT_IDE_ADVANCED
[480]	278	;--------------------------------------------------------------------
	279	; AH9h_SetModeFromALtoXTCF
	280	; Parameters:
	281	; AL: XT-CF Mode to set
	282	; DS:DI: Ptr to DPT (in RAMVARS segment)
	283	; SS:BP: Ptr to IDEPACK
	284	; Returns:
	285	; AH: Int 13h return status
	286	; CF: Clear if successful or device is not XT-CF
	287	; Set if failed to set mode for XT-CF
	288	; Corrupts registers:
	289	; AL, BX, CX, DX, SI
	290	;--------------------------------------------------------------------
	291	AH9h_SetModeFromALtoXTCF:
	292	call AccessDPT_IsThisDeviceXTCF
	293	jne SHORT IgnoreInvalidCommandError
	294	jmp AH1Eh_ChangeXTCFmodeBasedOnControlRegisterInAL
[493]	295	%endif ; MODULE_8BIT_IDE_ADVANCED
[480]	296
[493]	297	%ifdef MODULE_8BIT_IDE
[480]	298	;--------------------------------------------------------------------
	299	; AH9h_Enable8bitModeForDevice8bitAta
	300	; Parameters:
	301	; DS:DI: Ptr to DPT (in RAMVARS segment)
	302	; SS:BP: Ptr to IDEPACK
	303	; Returns:
	304	; AH: Int 13h return status
	305	; CF: Clear if successful or device is not DEVICE_8BIT_ATA
	306	; Set if failed to set 8-bit mode for DEVICE_8BIT_ATA
	307	; Corrupts registers:
	308	; AL, BX, CX, DX, SI
	309	;--------------------------------------------------------------------
	310	AH9h_Enable8bitModeForDevice8bitAta:
	311	cmp BYTE [di+DPT_ATA.bDevice], DEVICE_8BIT_ATA
	312	jne SHORT IgnoreInvalidCommandError
	313	jmp AH23h_Enable8bitPioMode
[493]	314	%endif

Note: See TracBrowser for help on using the repository browser.

Download in other formats: