source: xtideuniversalbios/trunk/XTIDE_Universal_BIOS/Src/Handlers/Int13h/AHDh_HReset.asm @ 473

; Project name  :   XTIDE Universal BIOS
; Description   :   Int 13h function AH=Dh, Reset Hard Disk (Alternate reset).

;
; XTIDE Universal BIOS and Associated Tools
; Copyright (C) 2009-2010 by Tomi Tilli, 2011-2012 by XTIDE Universal BIOS Team.
;
; This program is free software; you can redistribute it and/or modify
; it under the terms of the GNU General Public License as published by
; the Free Software Foundation; either version 2 of the License, or
; (at your option) any later version.
;
; This program is distributed in the hope that it will be useful,
; but WITHOUT ANY WARRANTY; without even the implied warranty of
; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
; GNU General Public License for more details.
; Visit http://www.gnu.org/licenses/old-licenses/gpl-2.0.html
;

; Section containing code
SECTION .text

;--------------------------------------------------------------------
; Int 13h function AH=Dh, Reset Hard Disk (Alternate reset).
;
; AHDh_HandlerForResetHardDisk
;   Parameters:
;       DL:     Translated Drive number
;       DS:DI:  Ptr to DPT (in RAMVARS segment)
;       SS:BP:  Ptr to IDEPACK
;   Returns with INTPACK:
;       AH:     Int 13h return status
;       CF:     0 if successful, 1 if error
;--------------------------------------------------------------------
AHDh_HandlerForResetHardDisk:
%ifndef USE_186
    call    AHDh_ResetDrive
    jmp     Int13h_ReturnFromHandlerAfterStoringErrorCodeFromAH
%else
    push    Int13h_ReturnFromHandlerAfterStoringErrorCodeFromAH
    ; Fall to AHDh_ResetDrive
%endif


;--------------------------------------------------------------------
; Resets hard disk.
;
; AHDh_ResetDrive
;   Parameters:
;       DS:DI:  Ptr to DPT
;       SS:BP:  Ptr to IDEPACK
;   Returns:
;       AH:     Int 13h return status
;       CF:     0 if successful, 1 if error
;   Corrupts registers:
;       AL, SI
;--------------------------------------------------------------------
AHDh_ResetDrive:
    push    dx
    push    cx
    push    bx
    push    di

%ifdef MODULE_IRQ
    call    Interrupts_UnmaskInterruptControllerForDriveInDSDI
%endif
    call    Device_ResetMasterAndSlaveController
    ;jc     SHORT .ReturnError                  ; CF would be set if slave drive present without master
                                                ; (error register has special values after reset)

    ; Initialize Master and Slave drives
    call    AccessDPT_GetIdevarsToCSBX
    xchg    ax, bx                              ; (AL) pointer to controller we are looking to reset
                                                ; (AH) initialize error code, assume success

    mov     si, IterateAndResetDrives           ; Callback function for FindDPT_IterateAllDPTs
    call    FindDPT_IterateAllDPTs

    shr     ah, 1                               ; Move error code and CF into proper position

    pop     di
    pop     bx
    pop     cx
    pop     dx
    ret

;--------------------------------------------------------------------
; IterateAndResetDrives: Iteration routine for use with IterateAllDPTs.
;
; When a drive on the controller is found, it is reset, and the error code
; merged into overall error code for this controller.  Master will be reset
; first.  Note that the iteration will go until the end of the DPT list.
;
;   Parameters:
;       AL:     Offset to IDEVARS for drives to initialize
;       AH:     Error status from previous initialization
;       DS:DI:  Ptr to DPT to examine
;   Returns:
;       AH:     Error status from initialization
;       CF:     Set to iterate all DPTs
;   Corrupts registers:
;       AL, BX, DX
;--------------------------------------------------------------------
IterateAndResetDrives:
    cmp     al, [di+DPT.bIdevarsOffset]         ; The right controller?
    jne     .Done
    push    cx
    push    ax
    call    AHDh_WaitUntilDriveMotorHasReachedFullSpeed
    call    AH9h_InitializeDriveForUse          ; Initialize Master or Slave (Master will come first in DPT list)

%ifdef MODULE_ADVANCED_ATA
    jc      SHORT .SkipControllerInitSinceError
    ; Here we initialize the more advanced controllers (VLB and PCI) to get better performance for systems with 32-bit bus.
    ; This step is optional since the controllers use slowest possible settings by default if they are not initialized.

    pop     ax
    push    ax
    cmp     al, [di+LARGEST_DPT_SIZE+DPT.bIdevarsOffset]    ; We check if next DPT is for the same IDE controller.
    je      SHORT .SkipInitializationUntilNextDrive         ; If it is, we skip the initialization.
    call    AdvAtaInit_InitializeControllerForDPTinDSDI     ; Done after drive init so drives are first set to advanced PIO mode, then the controller
.SkipInitializationUntilNextDrive:
.SkipControllerInitSinceError:
%endif  ; MODULE_ADVANCED_ATA

    pop     ax
    pop     cx
    jnc     .Done
    or      ah, (RET_HD_RESETFAIL << 1) | 1     ; OR in Reset Failed error code and CF, will SHR into position later
.Done:
    stc                                         ; From IterateAllDPTs perspective, the DPT is never found (continue iteration)
    ret


;--------------------------------------------------------------------
; AHDh_WaitUntilDriveMotorHasReachedFullSpeed
;   Parameters:
;       DS:DI:  Ptr to DPT
;   Returns:
;       AH:     Int 13h return status
;       CF:     0 if successful, 1 if error
;   Corrupts registers:
;       AL, BX, CX, DX
;--------------------------------------------------------------------
AHDh_WaitUntilDriveMotorHasReachedFullSpeed:
%ifdef MODULE_SERIAL
    test    BYTE [di+DPT.bFlagsHigh], FLGH_DPT_SERIAL_DEVICE
    jz      SHORT .WaitSinceRealHardDisk
    ret
.WaitSinceRealHardDisk:
%endif

    mov     bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_MOTOR_STARTUP, FLG_STATUS_DRDY)
    jmp     IdeWait_PollStatusFlagInBLwithTimeoutInBH