source: xtideuniversalbios/trunk/XTIDE_Universal_BIOS/Src/Handlers/Int13h/AH0h_HReset.asm@ 520

; Project name  :   XTIDE Universal BIOS
; Description   :   Int 13h function AH=0h, Disk Controller 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=0h, Disk Controller Reset.
;
; Note: We handle all AH=0h calls, even for drives handled by other
; BIOSes!
;
; AH0h_HandlerForDiskControllerReset
;   Parameters:
;       DL:     Translated Drive number (ignored so all drives are reset)
;               If bit 7 is set all hard disks and floppy disks reset.
;       DS:DI:  Ptr to DPT (or Null if foreign drive)
;       SS:BP:  Ptr to IDEPACK
;   Returns with INTPACK:
;       AH:     Int 13h return status (from drive requested in DL)
;       CF:     0 if successful, 1 if error
;--------------------------------------------------------------------
AH0h_HandlerForDiskControllerReset:
    ; Reset foreign Floppy and Hard Drives (those handled by other BIOSes)
    eMOVZX  bx, dl                                      ; Copy requested drive to BL and zero BH to assume no errors

    xor     ah, ah                                      ; Disk Controller Reset
    call    Int13h_CallPreviousInt13hHandler            ; Reset floppy drives only or floppy drives and foreign hard disks
    call    BackupErrorCodeFromTheRequestedDriveToBH

%ifdef MODULE_SERIAL_FLOPPY
;
; "Reset" emulated serial floppy drives, if any.  There is nothing to actually do for this reset,
; but record the proper error return code if one of these floppy drives is the drive requested.
;
    call    RamVars_UnpackFlopCntAndFirstToAL
    cbw                                                 ; Clears AH (there are flop drives) or ffh (there are not)
                                                        ; Either AH has success code (flop drives are present)
                                                        ; or it doesn't matter because we won't match drive ffh

    cwd                                                 ; clears DX (there are flop drives) or ffffh (there are not)

    adc     dl, al                                      ; second drive (CF set) if present
                                                        ; If no drive is present, this will result in ffh which
                                                        ; won't match a drive
    call    BackupErrorCodeFromTheRequestedDriveToBH
    mov     dl, al                                      ; We may end up doing the first drive twice (if there is
    call    BackupErrorCodeFromTheRequestedDriveToBH    ; only one drive), but doing it again is not harmful.
%endif
    test    bl, bl                                      ; If we were called with a floppy disk, then we are done,
    jns     SHORT .SkipHardDiskReset                    ; don't do hard disks.

    ; Resetting our hard disks will modify dl and bl to be idevars offset based instead of drive number based,
    ; such that this call must be the last in the list of reset routines called.
    ;
    ; This needs to happen after ResetForeignDrives, as that call may have set the error code for 80h,
    ; and we need to override that value if we are xlate'd into 80h with one of our drives.
    ;
    call    ResetHardDisksHandledByOurBIOS

.SkipHardDiskReset:
    mov     ah, bh
    jmp     Int13h_ReturnFromHandlerAfterStoringErrorCodeFromAH


;--------------------------------------------------------------------
; BackupErrorCodeFromTheRequestedDriveToBH
;   Parameters:
;       AH:     Error code from the last resetted drive
;       DL:     Drive last resetted
;       BL:     Requested drive (DL when entering AH=00h)
;   Returns:
;       BH:     Backuped error code
;   Corrupts registers:
;       Nothing
;--------------------------------------------------------------------
BackupErrorCodeFromTheRequestedDriveToBH:
    cmp     dl, bl              ; Requested drive?
    eCMOVE  bh, ah
    ret



; This defines what is called when resetting our drives at the end of drive detection.
AH0h_ResetAllOurHardDisksAtTheEndOfDriveInitialization equ ResetHardDisksHandledByOurBIOS.ErrorCodeNotUsed

;--------------------------------------------------------------------
; ResetHardDisksHandledByOurBIOS
;   Parameters:
;       BL:     Requested drive (DL when entering AH=00h)
;       DS:DI:  Ptr to DPT for requested drive
;               If DPT pointer is not available, or error result in BH won't be used anyway,
;               enter through .ErrorCodeNotUsed.
;       SS:BP:  Ptr to IDEPACK
;   Returns:
;       BH:     Error code from requested drive (if available)
;   Corrupts registers:
;       AX, BX, CX, DX, SI, DI
;--------------------------------------------------------------------
ResetHardDisksHandledByOurBIOS:
    xor     bl, bl                                      ; Assume Null IdevarsOffset for now, assuming foreign drive
    test    di, di
    jz      SHORT .ErrorCodeNotUsed
    mov     bl, [di+DPT.bIdevarsOffset]                 ; replace drive number with Idevars pointer for cmp with dl
.ErrorCodeNotUsed:

    mov     si, ControllerResetForDPTinDSDI
    call    .CallSIforEveryController                   ; Reset all drives to power on settings
    mov     si, ControllerInitForMasterOrSingleDPTinDSDI
    ; Fall to .CallSIforEveryController                 ; Initialize all controllers (Master and Slave drives)

.CallSIforEveryController:                              ; BH will be garbage on exit if this entry point is used,
                                                        ; but reset of all drives will still happen

    mov     dl, ROMVARS.ideVars0                        ; starting Idevars offset

    ; Get count of ALL Idevars structures, not just the ones that are configured.  This may seem odd,
    ; but it catches the .ideVarsSerialAuto structure, which would not be scanned if the count from
    ; RamVars_GetIdeControllerCountToCX was used.  Unused controllers won't make a difference, since no DPT
    ; will point to them.  Performance isn't an issue, as this is a reset operation.
    ;
    mov     cx, NUMBER_OF_IDEVARS

.loop:
    push    si
    call    FindDPT_ForIdevarsOffsetInDL                ; look for the first drive on this controller, if any
    pop     si
    jc      SHORT .notFound

    push    bx
    push    cx
    push    dx
    call    si                                          ; Reset Master AND Slave or initialize Master OR Slave drive
    pop     dx
    pop     cx
    pop     bx
    call    BackupErrorCodeFromTheRequestedDriveToBH    ; save error code if same controller as drive from entry

.notFound:
    add     dl, IDEVARS_size                            ; move Idevars pointer forward
    loop    .loop
    ret


;--------------------------------------------------------------------
; ControllerResetForDPTinDSDI
;   Parameters:
;       DS:DI:  Ptr to DPT for drive to reset (resets both Master and Slave drive)
;       SS:BP:  Ptr to IDEPACK
;   Returns:
;       AH:     Int 13h return status
;   Corrupts registers:
;       AL, BX, CX, DX
;--------------------------------------------------------------------
ControllerResetForDPTinDSDI:
%ifdef MODULE_IRQ
    call    Interrupts_UnmaskInterruptControllerForDriveInDSDI
%endif
%ifdef MODULE_ADVANCED_ATA
    call    Device_ResetMasterAndSlaveController
    jmp     AdvAtaInit_InitializeControllerForDPTinDSDI
%else
    jmp     Device_ResetMasterAndSlaveController
%endif


;--------------------------------------------------------------------
; ControllerInitForMasterOrSingleDPTinDSDI
;   Parameters:
;       DS:DI:  Ptr to DPT for Master or Single Drive (initializes both Master and Slave drive)
;       SS:BP:  Ptr to IDEPACK
;   Returns:
;       AH:     Int 13h return status
;   Corrupts registers:
;       AL, BX, CX, DX
;--------------------------------------------------------------------
ControllerInitForMasterOrSingleDPTinDSDI:
    call    AH9h_InitializeDriveForUse          ; Init Master or Single drive
    push    ax                                  ; Store error code

    eMOVZX  ax, BYTE [di+DPT.bIdevarsOffset]    ; Clear AH
    add     di, BYTE LARGEST_DPT_SIZE           ; Slave drive or next controller
    cmp     [di+DPT.bIdevarsOffset], al
    jne     SHORT .NoSlaveDrivePresent

    call    AH9h_InitializeDriveForUse          ; Init Slave drive
.NoSlaveDrivePresent:
    pop     bx
    MAX_U   ah, bh                              ; Return error code from either drive
    ret