Context Navigation

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

Visit:

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

Changes to XTIDE Universal BIOS:

XT-CF DMA transfers should now work.

File size: 9.4 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
[376]	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.
[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:
[363]	75	; AL, BX, CX, DX
[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
	95
[410]	96
[399]	97	;;; SelectDrive
[3]	98	; Try to select drive and wait until ready
[421]	99	call AccessDPT_GetDriveSelectByteForOldInt13hToAL
[150]	100	mov [bp+IDEPACK.bDrvAndHead], al
	101	call Device_SelectDrive
[410]	102	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_SELECT_DRIVE
	103	jnc SHORT .ContinueInitializationSinceDriveSelectedSuccesfully
	104	jmp .ReturnWithErrorCodeInAH
	105	.ContinueInitializationSinceDriveSelectedSuccesfully:
[399]	106
[3]	107
[473]	108	;;; Set XT-CF mode
	109	%ifdef MODULE_8BIT_IDE
	110	call AccessDPT_GetIdevarsToCSBX
	111	mov al, [cs:bx+IDEVARS.bXTCFcontrolRegister]
[480]	112	call AH9h_SetModeFromALtoXTCF
[473]	113	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_SET_XTCF_MODE
	114	.DoNotSetXTCFmode:
	115
	116
[480]	117	;;; Set 8-bit PIO mode
	118	call AH9h_Enable8bitModeForDevice8bitAta
	119	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_SET_8BIT_MODE
	120	.DoNotSet8bitMode:
	121	%endif ; MODULE_8BIT_IDE
	122
	123
[399]	124	;;; InitializeDeviceParameters
[421]	125	; Initialize CHS parameters if LBA is not used and
	126	; user has specified P-CHS parameters
	127	test BYTE [di+DPT.bFlagsLow], FLGL_DPT_ASSISTED_LBA
[399]	128	jnz SHORT .SkipInitializeDeviceParameters ; No need to initialize CHS parameters if LBA mode enabled
[421]	129	call AccessDPT_GetPointerToDRVPARAMStoCSBX
	130	test BYTE [cs:bx+DRVPARAMS.wFlags], FLG_DRVPARAMS_USERCHS ; User specified P-CHS?
	131	jz SHORT .SkipInitializeDeviceParameters
[3]	132
[157]	133	; Initialize Logical Sectors per Track and Max Head number
[421]	134	mov ax, [cs:bx+DRVPARAMS.wHeadsAndSectors]
	135	dec ax ; Max Head number
	136	xchg al, ah ; Heads now in AH
	137	mov dx, ax ; Sectors per Track now in DL
[150]	138	mov al, COMMAND_INITIALIZE_DEVICE_PARAMETERS
	139	mov bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_BSY, FLG_STATUS_BSY)
[399]	140	call Idepack_StoreNonExtParametersAndIssueCommandFromAL
[410]	141	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_INITIALIZE_CHS_PARAMETERS
[399]	142	.SkipInitializeDeviceParameters:
[3]	143
[410]	144
[399]	145	;;; SetWriteCache
	146	; Enable or Disable Write Cache
[276]	147	call AccessDPT_GetPointerToDRVPARAMStoCSBX
	148	mov bl, [cs:bx+DRVPARAMS.wFlags]
[399]	149	push bx ; Save .wFlags for later use in InitializeBlockMode
[276]	150	and bx, BYTE MASK_DRVPARAMS_WRITECACHE
[399]	151	jz SHORT .SkipSetWriteCache ; DEFAULT_WRITE_CACHE
[276]	152	mov si, [cs:bx+.rgbWriteCacheCommands]
[399]	153	call AH23h_SetControllerFeatures
[410]	154	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_SET_WRITE_CACHE
[399]	155	.SkipSetWriteCache:
[276]	156
[410]	157
[399]	158	;;; RecalibrateDrive
	159	; Recalibrate drive by seeking to cylinder 0
	160	call AH11h_RecalibrateDrive
[410]	161	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_RECALIBRATE_DRIVE
[276]	162
[399]	163
	164	;;; InitializeBlockMode
	165	; Initialize block mode transfers
	166	pop ax ; Restore .wFlags saved in SetWriteCache
	167	test BYTE [di+DPT.bFlagsHigh], FLGH_DPT_BLOCK_MODE_SUPPORTED
	168	jz SHORT .BlockModeNotSupportedOrDisabled
	169	test al, FLG_DRVPARAMS_BLOCKMODE
	170	jz SHORT .BlockModeNotSupportedOrDisabled
	171
	172	; Try block sizes until we find largest possible supported by drive
	173	mov bl, 128
	174	.TryNextBlockSize:
	175	mov al, bl
	176	call AH24h_SetBlockSize ; Stores block size to DPT
	177	jnc SHORT .SupportedBlockSizeFound
	178	shr bl, 1
	179	jnc SHORT .TryNextBlockSize
[410]	180	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_SET_BLOCK_MODE
[399]	181	.BlockModeNotSupportedOrDisabled:
	182	.SupportedBlockSizeFound:
	183
[410]	184
[363]	185	%ifdef MODULE_ADVANCED_ATA
[399]	186	;;; InitializePioMode
	187	; Initialize fastest supported PIO mode
[364]	188	mov dl, PIO_DEFAULT_MODE_DISABLE_IORDY
	189	test BYTE [di+DPT.bFlagsHigh], FLGH_DPT_IORDY
	190	jz SHORT .IordyNotSupported
	191
	192	; Advanced PIO mode 3 and above
	193	mov dl, [di+DPT_ADVANCED_ATA.bPioMode]
	194	or dl, PIO_FLOW_CONTROL_MODE_xxx
	195
	196	.IordyNotSupported:
[363]	197	mov si, FEATURE_SET_TRANSFER_MODE
[399]	198	call AH23h_SetControllerFeatures
[410]	199	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_SET_PIO_MODE
[399]	200	%endif ; MODULE_ADVANCED_ATA
[363]	201
[410]	202
[399]	203	%ifdef MODULE_FEATURE_SETS
	204	;;; InitStandbyTimer
	205	; Initialize the standby timer (if supported)
	206	test BYTE [di+DPT.bFlagsHigh], FLGH_DPT_POWER_MANAGEMENT_SUPPORTED
[410]	207	jz SHORT .NoPowerManagementSupport
[363]	208
[399]	209	mov al, COMMAND_IDLE
	210	mov dl, [cs:ROMVARS.bIdleTimeout]
	211	mov bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_BSY, FLG_STATUS_BSY)
	212	call Idepack_StoreNonExtParametersAndIssueCommandFromAL
[410]	213	STORE_ERROR_FLAG_TO_DPT FLG_INITERROR_FAILED_TO_INITIALIZE_STANDBY_TIMER
[399]	214	.NoPowerManagementSupport:
	215	%endif ; MODULE_FEATURE_SETS
	216
[410]	217
[399]	218	; There might have been several errors so just return one error code for them all
[410]	219	.ReturnWithErrorCodeInAH:
[400]	220	%ifdef MODULE_ADVANCED_ATA
[422]	221	mov ah, [di+DPT.bInitError]
[399]	222	test ah, ah ; Clears CF
[410]	223	jz SHORT .ReturnWithSuccess
[399]	224	mov ah, RET_HD_RESETFAIL
	225	stc
[410]	226	.ReturnWithSuccess:
[400]	227	%endif
[399]	228
	229	pop si
	230	pop es
[363]	231	ret
	232
	233
[410]	234	.rgbWriteCacheCommands:
	235	db 0 ; DEFAULT_WRITE_CACHE
	236	db FEATURE_DISABLE_WRITE_CACHE ; DISABLE_WRITE_CACHE
	237	db FEATURE_ENABLE_WRITE_CACHE ; ENABLE_WRITE_CACHE
	238
	239
	240
[363]	241	;--------------------------------------------------------------------
[410]	242	; SetErrorFlagFromALwithErrorCodeInAH
[363]	243	; Parameters:
	244	; AH: BIOS Error Code
	245	; AL: Error flag to set
	246	; DS:DI: Ptr to DPT
[410]	247	; CF: Set if error code in AH
	248	; Clear if AH = 0
[363]	249	; Returns:
	250	; CF: Clear if no error
	251	; Set if error flag was set
	252	; Corrupts registers:
[370]	253	; Nothing
[363]	254	;--------------------------------------------------------------------
[410]	255	IgnoreInvalidCommandError:
[399]	256	xor ah, ah ; Clears CF
[410]	257	SetErrorFlagFromALwithErrorCodeInAH:
[365]	258	jnc SHORT .NoErrorFlagToSet
[363]	259	cmp ah, RET_HD_INVALID
[410]	260	jbe SHORT IgnoreInvalidCommandError
[363]	261
[422]	262	or [di+DPT.bInitError], al
[363]	263	stc
[365]	264	.NoErrorFlagToSet:
[3]	265	ret
[480]	266
	267
	268	%ifdef MODULE_8BIT_IDE
	269	;--------------------------------------------------------------------
	270	; AH9h_SetModeFromALtoXTCF
	271	; Parameters:
	272	; AL: XT-CF Mode to set
	273	; DS:DI: Ptr to DPT (in RAMVARS segment)
	274	; SS:BP: Ptr to IDEPACK
	275	; Returns:
	276	; AH: Int 13h return status
	277	; CF: Clear if successful or device is not XT-CF
	278	; Set if failed to set mode for XT-CF
	279	; Corrupts registers:
	280	; AL, BX, CX, DX, SI
	281	;--------------------------------------------------------------------
	282	AH9h_SetModeFromALtoXTCF:
	283	call AccessDPT_IsThisDeviceXTCF
	284	jne SHORT IgnoreInvalidCommandError
	285	jmp AH1Eh_ChangeXTCFmodeBasedOnControlRegisterInAL
	286
	287
	288	;--------------------------------------------------------------------
	289	; AH9h_Enable8bitModeForDevice8bitAta
	290	; Parameters:
	291	; DS:DI: Ptr to DPT (in RAMVARS segment)
	292	; SS:BP: Ptr to IDEPACK
	293	; Returns:
	294	; AH: Int 13h return status
	295	; CF: Clear if successful or device is not DEVICE_8BIT_ATA
	296	; Set if failed to set 8-bit mode for DEVICE_8BIT_ATA
	297	; Corrupts registers:
	298	; AL, BX, CX, DX, SI
	299	;--------------------------------------------------------------------
	300	AH9h_Enable8bitModeForDevice8bitAta:
	301	cmp BYTE [di+DPT_ATA.bDevice], DEVICE_8BIT_ATA
	302	jne SHORT IgnoreInvalidCommandError
	303	jmp AH23h_Enable8bitPioMode
	304	%endif ; MODULE_8BIT_IDE

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

Download in other formats: