Changeset 150 in xtideuniversalbios for trunk/XTIDE_Universal_BIOS/Src/Handlers/Int13h/AH24h_HSetBlocks.asm

Timestamp:

Apr 29, 2011, 7:04:13 PM (14 years ago)

Author:

Tomi Tilli

google:author:

aitotat

Message:

Changes to XTIDE Universal BIOS:

• Redesigned Disk Parameter Tables.
• Code generalizations for supporting non-IDE devices in the future.

File:

• trunk/XTIDE_Universal_BIOS/Src/Handlers/Int13h/AH24h_HSetBlocks.asm (modified) (4 diffs)

trunk/XTIDE_Universal_BIOS/Src/Handlers/Int13h/AH24h_HSetBlocks.asm

@@ -13 +13 @@
 ;       DL:     Translated Drive number
 ;       DS:DI:  Ptr to DPT (in RAMVARS segment)
-;       SS:BP:  Ptr to INTPACK
-;   Parameters on INTPACK in SS:BP:
+;       SS:BP:  Ptr to IDEPACK
+;   Parameters on INTPACK:
 ;       AL:     Number of Sectors per Block (1, 2, 4, 8, 16, 32, 64 or 128)
-;   Returns with INTPACK in SS:BP:
+;   Returns with INTPACK:
 ;       AH:     Int 13h return status
 ;       CF:     0 if succesfull, 1 if error
@@ -22 +22 @@
 ALIGN JUMP_ALIGN
 AH24h_HandlerForSetMultipleBlocks:
+    test    WORD [di+DPT.wFlags], FLG_DPT_BLOCK_MODE_SUPPORTED
+    jnz     SHORT .TryToSetBlockMode
+    stc
+    mov     ah, RET_HD_INVALID
+    jmp     Int13h_ReturnFromHandlerAfterStoringErrorCodeFromAH
+
+ALIGN JUMP_ALIGN
+.TryToSetBlockMode:
 %ifndef USE_186
     call    AH24h_SetBlockSize
@@ -32 +40 @@
 
 ;--------------------------------------------------------------------
-; Sets block size for block mode transfers.
-;
 ; AH24h_SetBlockSize
 ;   Parameters:
 ;       AL:     Number of Sectors per Block (1, 2, 4, 8, 16, 32, 64 or 128)
 ;       DS:DI:  Ptr to DPT (in RAMVARS segment)
+;       SS:BP:  Ptr to IDEPACK
 ;   Returns:
 ;       AH:     Int 13h return status
@@ -46 +53 @@
 ALIGN JUMP_ALIGN
 AH24h_SetBlockSize:
-    ; Select Master or Slave and wait until ready
-    mov     bl, al                              ; Backup block size
-    call    HDrvSel_SelectDriveAndDisableIRQ    ; Select drive and wait until ready
-    jc      SHORT .ReturnWithErrorCodeInAH      ; Return if error
-
-    ; Output block size and command
-    mov     al, bl                              ; Restore block size to AL
-    mov     ah, HCMD_SET_MUL                    ; Load command to AH
-    mov     dx, [RAMVARS.wIdeBase]              ; Load base port address
-    add     dx, BYTE REG_IDE_CNT
-    call    HCommand_OutputSectorCountAndCommand
-    call    HStatus_WaitBsyDefTime              ; Wait until drive not busy
+    MIN_U   al, MAX_SUPPORTED_BLOCK_SIZE_IN_SECTORS
+    push    ax
+    xchg    dx, ax          ; DL = Block size (Sector Count Register)
+    mov     al, COMMAND_SET_MULTIPLE_MODE
+    mov     bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_DRDY, FLG_STATUS_DRDY)
+    call    Idepack_StoreNonExtParametersAndIssueCommandFromAL
+    pop     bx
     jc      SHORT .DisableBlockMode
 
     ; Store new block size to DPT and return
-    mov     [di+DPT.bSetBlock], bl              ; Store new block size
-    xor     ah, ah                              ; Zero AH and CF since success
+    mov     [di+DPT_ATA.bSetBlock], bl              ; Store new block size
     ret
 .DisableBlockMode:
-    mov     BYTE [di+DPT.bSetBlock], 1          ; Disable block mode
-.ReturnWithErrorCodeInAH:
+    mov     BYTE [di+DPT_ATA.bSetBlock], 1          ; Disable block mode
     ret