source: xtideuniversalbios/trunk/XTIDE_Universal_BIOS/Src/Device/IDE/IdeCommand.asm @ 473

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

Changes to XTIDE Universal BIOS:

  • Large changes to prepare full XT-CF support (DMA not yet implemented and memory mapped transfers are not working).
File size: 8.8 KB
Line 
1; Project name  :   XTIDE Universal BIOS
2; Description   :   IDE Device Command functions.
3
4;
5; XTIDE Universal BIOS and Associated Tools
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.
12;
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
16; GNU General Public License for more details.
17; Visit http://www.gnu.org/licenses/old-licenses/gpl-2.0.html
18;
19
20; Section containing code
21SECTION .text
22
23;--------------------------------------------------------------------
24; IdeCommand_ResetMasterAndSlaveController
25;   Parameters:
26;       DS:DI:  Ptr to DPT (in RAMVARS segment)
27;   Returns:
28;       AH:     INT 13h Error Code
29;       CF:     Cleared if success, Set if error
30;   Corrupts registers:
31;       AL, BX, CX, DX
32;--------------------------------------------------------------------
33IdeCommand_ResetMasterAndSlaveController:
34    ; HSR0: Set_SRST
35    call    AccessDPT_GetDeviceControlByteToAL
36    or      al, FLG_DEVCONTROL_SRST | FLG_DEVCONTROL_nIEN   ; Set Reset bit
37    OUTPUT_AL_TO_IDE_CONTROL_BLOCK_REGISTER     DEVICE_CONTROL_REGISTER_out
38    mov     ax, HSR0_RESET_WAIT_US
39    call    Timer_DelayMicrosecondsFromAX
40
41    ; HSR1: Clear_wait
42    call    AccessDPT_GetDeviceControlByteToAL
43    or      al, FLG_DEVCONTROL_nIEN
44    and     al, ~FLG_DEVCONTROL_SRST                        ; Clear reset bit
45    OUTPUT_AL_TO_IDE_CONTROL_BLOCK_REGISTER     DEVICE_CONTROL_REGISTER_out
46    mov     ax, HSR1_RESET_WAIT_US
47    call    Timer_DelayMicrosecondsFromAX
48
49    ; HSR2: Check_status
50    mov     bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_MAXIMUM, FLG_STATUS_BSY)
51    jmp     IdeWait_PollStatusFlagInBLwithTimeoutInBH
52
53
54;--------------------------------------------------------------------
55; IdeCommand_IdentifyDeviceToBufferInESSIwithDriveSelectByteInBH
56;   Parameters:
57;       BH:     Drive Select byte for Drive and Head Select Register
58;       DX:     Autodetected port for XT-CF
59;       DS:     Segment to RAMVARS
60;       ES:SI:  Ptr to buffer to receive 512-byte IDE Information
61;       CS:BP:  Ptr to IDEVARS
62;   Returns:
63;       AH:     INT 13h Error Code
64;       CF:     Cleared if success, Set if error
65;   Corrupts registers:
66;       AL, BX, CX, DX, SI, DI, ES
67;--------------------------------------------------------------------
68IdeCommand_IdentifyDeviceToBufferInESSIwithDriveSelectByteInBH:
69    ; Create fake DPT to be able to use Device.asm functions
70    call    FindDPT_ForNewDriveToDSDI
71    eMOVZX  ax, bh
72    mov     [di+DPT.wFlags], ax
73    call    CreateDPT_StoreIdevarsOffsetAndBasePortFromCSBPtoDPTinDSDI
74    call    IdeDPT_StoreDeviceTypeToDPTinDSDIfromIdevarsInCSBP
75    mov     BYTE [di+DPT_ATA.bBlockSize], 1 ; Block = 1 sector
76
77    ; Wait until drive motors have reached full speed
78    cmp     bp, BYTE ROMVARS.ideVars0   ; First controller?
79    jne     SHORT .SkipLongWaitSinceDriveIsNotPrimaryMaster
80    test    bh, FLG_DRVNHEAD_DRV        ; Wait already done for Master
81    jnz     SHORT .SkipLongWaitSinceDriveIsNotPrimaryMaster
82    call    AHDh_WaitUntilDriveMotorHasReachedFullSpeed
83.SkipLongWaitSinceDriveIsNotPrimaryMaster:
84
85    ; Create IDEPACK without INTPACK
86    push    bp
87    call    Idepack_FakeToSSBP
88
89%ifdef MODULE_8BIT_IDE
90    ; We set XT-CF to 8-bit PIO mode for Identify Device command.
91    ; Correct XT-CF mode is later set on AH=09h (after all drives are detected).
92    call    AccessDPT_IsThisDeviceXTCF
93    jne     SHORT .SkipXTCFmodeChange
94
95    xor     al, al                      ; XTCF_8BIT_PIO_MODE
96    push    si
97    call    AH1Eh_ChangeXTCFmodeBasedOnControlRegisterInAL
98    pop     si
99    jc      SHORT .FailedToSet8bitMode
100.SkipXTCFmodeChange:
101%endif ; MODULE_8BIT_IDE
102
103    ; Prepare to output Identify Device command
104    mov     dl, 1                       ; Sector count (required by IdeTransfer.asm)
105    mov     al, COMMAND_IDENTIFY_DEVICE
106    mov     bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_DRQ, FLG_STATUS_DRQ)
107    call    Idepack_StoreNonExtParametersAndIssueCommandFromAL
108
109    ; Clean stack and return
110.FailedToSet8bitMode:
111    lea     sp, [bp+SIZE_OF_IDEPACK_WITHOUT_INTPACK]    ; This assumes BP hasn't changed between Idepack_FakeToSSBP and here
112    pop     bp
113    ret
114
115
116;--------------------------------------------------------------------
117; IdeCommand_OutputWithParameters
118;   Parameters:
119;       BH:     System timer ticks for timeout
120;       BL:     IDE Status Register bit to poll after command
121;       ES:SI:  Ptr to buffer (for data transfer commands)
122;       DS:DI:  Ptr to DPT (in RAMVARS segment)
123;       SS:BP:  Ptr to IDEPACK
124;   Returns:
125;       AH:     INT 13h Error Code
126;       CX:     Number of successfully transferred sectors (for transfer commands)
127;       CF:     Cleared if success, Set if error
128;   Corrupts registers:
129;       AL, BX, (CX), DX, (ES:SI for data transfer commands)
130;--------------------------------------------------------------------
131ALIGN JUMP_ALIGN
132IdeCommand_OutputWithParameters:
133    push    bx                      ; Store status register bits to poll
134
135    ; Select Master or Slave drive and output head number or LBA28 top bits
136    call    IdeCommand_SelectDrive
137    jc      SHORT .DriveNotReady
138
139    ; Output Device Control Byte to enable or disable interrupts
140    mov     al, [bp+IDEPACK.bDeviceControl]
141%ifdef MODULE_IRQ
142    test    al, FLG_DEVCONTROL_nIEN ; Interrupts disabled?
143    jnz     SHORT .DoNotSetInterruptInServiceFlag
144
145    ; Clear Task Flag and set Interrupt In-Service Flag
146    or      BYTE [di+DPT.bFlagsHigh], FLGH_DPT_INTERRUPT_IN_SERVICE
147    push    ds
148    LOAD_BDA_SEGMENT_TO ds, dx, !   ; Also zero DX
149    mov     [BDA.bHDTaskFlg], dl
150    pop     ds
151.DoNotSetInterruptInServiceFlag:
152%endif
153    OUTPUT_AL_TO_IDE_CONTROL_BLOCK_REGISTER     DEVICE_CONTROL_REGISTER_out
154
155    ; Output Feature Number
156    mov     al, [bp+IDEPACK.bFeatures]
157    OUTPUT_AL_TO_IDE_REGISTER   FEATURES_REGISTER_out
158
159    ; Output Sector Address High (only used by LBA48)
160%ifdef MODULE_EBIOS
161    eMOVZX  ax, [bp+IDEPACK.bLbaLowExt]     ; Zero sector count
162    mov     cx, [bp+IDEPACK.wLbaMiddleAndHighExt]
163    call    OutputSectorCountAndAddress
164%endif
165
166    ; Output Sector Address Low
167    mov     ax, [bp+IDEPACK.wSectorCountAndLbaLow]
168    mov     cx, [bp+IDEPACK.wLbaMiddleAndHigh]
169    call    OutputSectorCountAndAddress
170
171    ; Output command
172    mov     al, [bp+IDEPACK.bCommand]
173    OUTPUT_AL_TO_IDE_REGISTER   COMMAND_REGISTER_out
174
175    ; Wait until command completed
176    pop     bx                              ; Pop status and timeout for polling
177    cmp     bl, FLG_STATUS_DRQ              ; Data transfer started?
178    jne     SHORT .WaitUntilNonTransferCommandCompletes
179%ifdef MODULE_8BIT_IDE
180    cmp     BYTE [di+DPT_ATA.bDevice], DEVICE_8BIT_XTCF_DMA
181    je      SHORT 0 ; IdeDma_StartTransferWithCommandInAL
182    ja      SHORT JrIdeTransfer_StartWithCommandInAL    ; DEVICE_8BIT_XTCF_MEMMAP or DEVICE_8BIT_JRIDE_ISA
183%endif
184    jmp     IdeTransfer_StartWithCommandInAL
185
186.WaitUntilNonTransferCommandCompletes:
187%ifdef MODULE_IRQ
188    test    BYTE [bp+IDEPACK.bDeviceControl], FLG_DEVCONTROL_nIEN
189    jz      SHORT .PollStatusFlagInsteadOfWaitIrq
190    jmp     IdeWait_IRQorStatusFlagInBLwithTimeoutInBH
191.PollStatusFlagInsteadOfWaitIrq:
192%endif
193    jmp     IdeWait_PollStatusFlagInBLwithTimeoutInBH
194
195.DriveNotReady:
196    pop     bx                          ; Clean stack
197    ret
198
199
200;--------------------------------------------------------------------
201; IdeCommand_SelectDrive
202;   Parameters:
203;       DS:DI:  Ptr to DPT (in RAMVARS segment)
204;       SS:BP:  Ptr to IDEPACK
205;   Returns:
206;       AH:     INT 13h Error Code
207;       CF:     Cleared if success, Set if error
208;   Corrupts registers:
209;       AL, BX, CX, DX
210;--------------------------------------------------------------------
211ALIGN JUMP_ALIGN
212IdeCommand_SelectDrive:
213    ; We use different timeout value when detecting drives.
214    ; This prevents unnecessary long delays when drive is not present.
215    mov     cx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_DRDY, FLG_STATUS_DRDY)
216    cmp     WORD [RAMVARS.wDrvDetectSignature], RAMVARS_DRV_DETECT_SIGNATURE
217    eCMOVE  ch, TIMEOUT_SELECT_DRIVE_DURING_DRIVE_DETECTION
218
219    ; Select Master or Slave Drive
220    mov     al, [bp+IDEPACK.bDrvAndHead]
221    OUTPUT_AL_TO_IDE_REGISTER   DRIVE_AND_HEAD_SELECT_REGISTER
222    mov     bx, cx
223    call    IdeWait_PollStatusFlagInBLwithTimeoutInBH
224
225    ; Ignore errors from IDE Error Register (set by previous command)
226    cmp     ah, RET_HD_TIMEOUT
227    je      SHORT .FailedToSelectDrive
228    xor     ax, ax                  ; Always success unless timeout
229    ret
230.FailedToSelectDrive:
231    stc
232    ret
233
234
235;--------------------------------------------------------------------
236; OutputSectorCountAndAddress
237;   Parameters:
238;       AH:     LBA low bits (Sector Number)
239;       AL:     Sector Count
240;       CL:     LBA middle bits (Cylinder Number low)
241;       CH:     LBA high bits (Cylinder Number high)
242;       DS:DI:  Ptr to DPT (in RAMVARS segment)
243;   Returns:
244;       Nothing
245;   Corrupts registers:
246;       AL, BX, DX
247;--------------------------------------------------------------------
248ALIGN JUMP_ALIGN
249OutputSectorCountAndAddress:
250    OUTPUT_AL_TO_IDE_REGISTER   SECTOR_COUNT_REGISTER
251
252    mov     al, ah
253    OUTPUT_AL_TO_IDE_REGISTER   LBA_LOW_REGISTER
254
255    mov     al, cl
256    OUTPUT_AL_TO_IDE_REGISTER   LBA_MIDDLE_REGISTER
257
258    mov     al, ch
259    OUTPUT_AL_TO_IDE_REGISTER   LBA_HIGH_REGISTER
260    ret
Note: See TracBrowser for help on using the repository browser.