source: xtideuniversalbios/tags/XTIDE_Universal_BIOS_v1.1.3/Src/Handlers/Int13h/AH9h_HInit.asm@ 462

; File name     :   AH9h_HInit.asm
; Project name  :   IDE BIOS
; Created date  :   9.12.2007
; Last update   :   1.8.2010
; Author        :   Tomi Tilli
; Description   :   Int 13h function AH=9h, Initialize Drive Parameters.

; Section containing code
SECTION .text

;--------------------------------------------------------------------
; Int 13h function AH=9h, Initialize Drive Parameters.
;
; AH9h_HandlerForInitializeDriveParameters
;   Parameters:
;       AH:     Bios function 9h
;       DL:     Drive number
;   Parameters loaded by Int13h_Jump:
;       DS:     RAMVARS segment
;   Returns:
;       AH:     Int 13h return status
;       CF:     0 if succesfull, 1 if error
;       IF:     1
;   Corrupts registers:
;       Flags
;--------------------------------------------------------------------
ALIGN JUMP_ALIGN
AH9h_HandlerForInitializeDriveParameters:
    push    dx
    push    cx
    push    bx
    push    ax
    call    AH9h_InitializeDriveForUse
    jmp     Int13h_PopXRegsAndReturn


;--------------------------------------------------------------------
; Initialized drive to be ready for use.
;
; AH9h_InitializeDriveForUse
;   Parameters:
;       DL:     Drive number
;       DS:     RAMVARS segment
;   Returns:
;       DS:DI:  Ptr to DPT
;       AH:     Int 13h return status
;       CF:     0 if succesfull, 1 if error
;   Corrupts registers:
;       AL, BX
;--------------------------------------------------------------------
ALIGN JUMP_ALIGN
AH9h_InitializeDriveForUse:
    push    dx
    push    cx

    ; Try to select drive and wait until ready
    call    FindDPT_ForDriveNumber
    or      BYTE [di+DPT.bReset], MASK_RESET_ALL        ; Everything uninitialized
    call    HDrvSel_SelectDriveAndDisableIRQ
    jc      SHORT .ReturnNotSuccessfull
    and     BYTE [di+DPT.bReset], ~FLG_RESET_nDRDY      ; Clear since success

    ; Initialize CHS parameters if LBA is not used
    call    AH9h_InitializeDeviceParameters
    jc      SHORT .RecalibrateDrive
    and     BYTE [di+DPT.bReset], ~FLG_RESET_nINITPRMS

    ; Recalibrate drive by seeking to cylinder 0
ALIGN JUMP_ALIGN
.RecalibrateDrive:
    call    AH11h_RecalibrateDrive
    mov     dl, [di+DPT.bDrvNum]        ; Restore DL
    jc      SHORT .InitializeBlockMode
    and     BYTE [di+DPT.bReset], ~FLG_RESET_nRECALIBRATE

    ; Initialize block mode transfers
ALIGN JUMP_ALIGN
.InitializeBlockMode:
    call    AH9h_InitializeBlockMode
    ;mov        dl, [di+DPT.bDrvNum]        ; Restore DL
    jc      SHORT .ReturnNotSuccessfull
    and     BYTE [di+DPT.bReset], ~FLG_RESET_nSETBLOCK

    ; Force PIO mode 0
    ;call   AH9h_ForcePioMode0

.ReturnNotSuccessfull:
    pop     cx
    pop     dx
    ret


;--------------------------------------------------------------------
; Sends Initialize Device Parameters command to IDE Hard Disk.
; Initialization is used to initialize logical CHS parameters. Drives
; may not support all CHS values.
; This command is only supported by drives that supports CHS addressing.
;
; AH9h_InitializeDeviceParameters
;   Parameters:
;       DS:DI:  Ptr to DPT
;   Returns:
;       AH:     BIOS Error code
;       CF:     Cleared if succesfull
;               Set if any error
;   Corrupts registers:
;       AL, BX, CX
;--------------------------------------------------------------------
ALIGN JUMP_ALIGN
AH9h_InitializeDeviceParameters:
    ; No need to initialize CHS parameters if LBA mode enabled
    test    BYTE [di+DPT.bDrvSel], FLG_IDE_DRVHD_LBA    ; Clears CF
    jnz     SHORT .Return

    push    dx
    mov     bh, [di+DPT.bPHeads]
    dec     bh                      ; Max head number
    mov     dx, [RAMVARS.wIdeBase]
    call    HCommand_OutputTranslatedLCHSaddress
    mov     ah, HCMD_INIT_DEV
    mov     al, [di+DPT.bPSect]     ; Sectors per track
    call    HCommand_OutputSectorCountAndCommand
    call    HStatus_WaitBsyDefTime  ; Wait until drive ready (DRDY won't be set!)
    pop     dx
.Return:
    ret


;--------------------------------------------------------------------
; Initializes block mode transfers.
;
; AH9h_InitializeBlockMode
;   Parameters:
;       DL:     Drive number
;       DS:DI:  Ptr to DPT
;   Returns:
;       AH:     BIOS Error code
;       CF:     Cleared if succesfull
;               Set if any error
;   Corrupts registers:
;       AL, BX, CX, DX
;--------------------------------------------------------------------
ALIGN JUMP_ALIGN
AH9h_InitializeBlockMode:
    mov     ax, FLG_DRVPARAMS_BLOCKMODE
    call    AccessDPT_TestIdeVarsFlagsForMasterOrSlaveDrive
    jz      SHORT .Return               ; Block mode disabled (CF cleared)
    eMOVZX  ax, BYTE [di+DPT.bMaxBlock] ; Load max block size, zero AH
    test    al, al                      ; Block mode supported? (clears CF)
    jz      SHORT .Return               ;  If not, return
    jmp     AH24h_SetBlockSize
.Return:
    ret


;--------------------------------------------------------------------
; AH9h_ForcePioMode0
;   Parameters:
;       DL:     Drive number
;       DS:DI:  Ptr to DPT
;   Returns:
;       AH:     BIOS Error code
;       CF:     Cleared if succesfull
;               Set if any error
;   Corrupts registers:
;       AX, BX
;--------------------------------------------------------------------
;ALIGN JUMP_ALIGN
;AH9h_ForcePioMode0:
;   mov     bh, 08h     ; Parameter to Sector Count Register (PIO Flow Control Transfer Mode 0)
;   mov     ax, 2303h   ; Feature: Set transfer mode based on value in Sector Count register
;   int     13h
;   jc      SHORT .FailedToForcePIO0
;   ; Debug output here
;   ret
;.FailedToForcePIO0:
;   ; Debug output here
;   ret