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

Last change on this file since 612 was 612, checked in by krille_n_, 3 years ago

Changes:

  • BIOSDRVS builds again (broken since r609). Also removed the last remnants of RESERVE_DIAGNOSTIC_CYLINDER from BIOSDRVS that I missed in r606.
  • Put in a limit on the P-CHS cylinder count in an attempt to improve compatibility with some CF cards that violates the ATA specification. The limit applies only to the BIOS. BIOSDRVS will continue to show the true cylinder count since we might want to add code later to warn the user when encountering incompatible drives like these.
  • Optimized the bug fix in r611.
  • Updated the copyright notices in XTIDECFG and BIOSDRVS.
File size: 10.2 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-2013 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:   ; Unused entrypoint OK
34    ; HSR0: Set_SRST
35; Used to be:
36;   call    AccessDPT_GetDeviceControlByteToAL
37;   or      al, FLG_DEVCONTROL_SRST | FLG_DEVCONTROL_nIEN   ; Set Reset bit
38; Is now:
39    mov     al, FLG_DEVCONTROL_SRST | FLG_DEVCONTROL_nIEN
40; ---
41    OUTPUT_AL_TO_IDE_CONTROL_BLOCK_REGISTER     DEVICE_CONTROL_REGISTER_out
42    mov     ax, HSR0_RESET_WAIT_US
43    call    Timer_DelayMicrosecondsFromAX
44
45    ; HSR1: Clear_wait
46; Used to be:
47;   call    AccessDPT_GetDeviceControlByteToAL
48;   or      al, FLG_DEVCONTROL_nIEN
49;   and     al, ~FLG_DEVCONTROL_SRST                        ; Clear reset bit
50; Is now:
51    mov     al, FLG_DEVCONTROL_nIEN
52; ---
53    OUTPUT_AL_TO_IDE_CONTROL_BLOCK_REGISTER     DEVICE_CONTROL_REGISTER_out
54    mov     ax, HSR1_RESET_WAIT_US
55    call    Timer_DelayMicrosecondsFromAX
56
57    ; HSR2: Check_status
58    mov     bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_MAXIMUM, FLG_STATUS_BSY)
59    jmp     IdeWait_PollStatusFlagInBLwithTimeoutInBH
60
61; *FIXME* AccessDPT_GetDeviceControlByteToAL currently always returns with
62; AL cleared (0) or with only bit 1 set (FLG_DEVCONTROL_nIEN = 2).
63; The commented away instructions above sets FLG_DEVCONTROL_nIEN anyway
64; making the call to AccessDPT_GetDeviceControlByteToAL redundant.
65; I have left this code as is since I don't know if it's a mistake
66; (from all the way back to r150) or if it's coded this way in anticipation
67; of some future changes to AccessDPT_GetDeviceControlByteToAL.
68
69;--------------------------------------------------------------------
70; IdeCommand_IdentifyDeviceToBufferInESSIwithDriveSelectByteInBH
71;   Parameters:
72;       BH:     Drive Select byte for Drive and Head Select Register
73;       DX:     Autodetected port for XT-CF
74;       DS:     Segment to RAMVARS
75;       ES:SI:  Ptr to buffer to receive 512-byte IDE Information
76;       CS:BP:  Ptr to IDEVARS
77;   Returns:
78;       AH:     INT 13h Error Code
79;       CF:     Cleared if success, Set if error
80;   Corrupts registers:
81;       AL, BX, CX, DX, SI, DI, ES
82;--------------------------------------------------------------------
83IdeCommand_IdentifyDeviceToBufferInESSIwithDriveSelectByteInBH:     ; Unused entrypoint OK
84    ; Create fake DPT to be able to use Device.asm functions
85    call    FindDPT_ForNewDriveToDSDI
86    eMOVZX  ax, bh
87    mov     [di+DPT.wFlags], ax
88    call    CreateDPT_StoreIdevarsOffsetAndBasePortFromCSBPtoDPTinDSDI
89    call    IdeDPT_StoreDeviceTypeToDPTinDSDIfromIdevarsInCSBP
90    mov     BYTE [di+DPT_ATA.bBlockSize], 1 ; Block = 1 sector
91
92    ; Wait until drive motors have reached full speed
93    cmp     bp, BYTE ROMVARS.ideVars0   ; First controller?
94    jne     SHORT .SkipLongWaitSinceDriveIsNotPrimaryMaster
95    test    bh, FLG_DRVNHEAD_DRV        ; Wait already done for Master
96    jnz     SHORT .SkipLongWaitSinceDriveIsNotPrimaryMaster
97    mov     bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_MOTOR_STARTUP, FLG_STATUS_BSY)
98    call    IdeWait_PollStatusFlagInBLwithTimeoutInBH
99.SkipLongWaitSinceDriveIsNotPrimaryMaster:
100
101    ; Create IDEPACK without INTPACK
102    push    bp
103    call    Idepack_FakeToSSBP
104
105%ifdef MODULE_8BIT_IDE
106    push    si
107
108    ; Enable 8-bit PIO for DEVICE_8BIT_ATA (no need to verify device type here)
109    call    AH9h_Enable8bitModeForDevice8bitAta
110
111    ; Set XT-CF mode. No need to check here if device is XT-CF or not.
112%ifdef MODULE_8BIT_IDE_ADVANCED
113    call    AH1Eh_GetCurrentXTCFmodeToAX    ; Reads from DPT_ATA.bDevice that we just stored
114    call    AH9h_SetModeFromALtoXTCF        ; Enables/disables 8-bit mode when necessary
115%endif ; MODULE_8BIT_IDE_ADVANCED
116    pop     si
117%endif ; MODULE_8BIT_IDE
118
119    ; Prepare to output Identify Device command
120    mov     dl, 1                       ; Sector count (required by IdeTransfer.asm)
121    mov     al, COMMAND_IDENTIFY_DEVICE
122    mov     bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_DRQ, FLG_STATUS_DRQ)
123    call    Idepack_StoreNonExtParametersAndIssueCommandFromAL
124
125    ; Clean stack and return
126    lea     sp, [bp+SIZE_OF_IDEPACK_WITHOUT_INTPACK]    ; This assumes BP hasn't changed between Idepack_FakeToSSBP and here
127    pop     bp
128    ret
129
130
131;--------------------------------------------------------------------
132; IdeCommand_OutputWithParameters
133;   Parameters:
134;       BH:     System timer ticks for timeout
135;       BL:     IDE Status Register bit to poll after command
136;       ES:SI:  Ptr to buffer (for data transfer commands)
137;       DS:DI:  Ptr to DPT (in RAMVARS segment)
138;       SS:BP:  Ptr to IDEPACK
139;   Returns:
140;       AH:     INT 13h Error Code
141;       CX:     Number of successfully transferred sectors (for transfer commands)
142;       CF:     Cleared if success, Set if error
143;   Corrupts registers:
144;       AL, BX, (CX), DX, (ES:SI for data transfer commands)
145;--------------------------------------------------------------------
146ALIGN JUMP_ALIGN
147IdeCommand_OutputWithParameters:    ; Unused entrypoint OK
148    push    bx                      ; Store status register bits to poll
149
150    ; Select Master or Slave drive and output head number or LBA28 top bits
151    call    IdeCommand_SelectDrive
152    jc      SHORT .DriveNotReady
153
154    ; Output Device Control Byte to enable or disable interrupts
155    mov     al, [bp+IDEPACK.bDeviceControl]
156%ifdef MODULE_IRQ
157    test    al, FLG_DEVCONTROL_nIEN ; Interrupts disabled?
158    jnz     SHORT .DoNotSetInterruptInServiceFlag
159
160    ; Clear Task Flag and set Interrupt In-Service Flag
161    push    ds
162    LOAD_BDA_SEGMENT_TO ds, dx
163    mov     BYTE [BDA.bHDTaskFlg], 1    ; Will be adjusted to zero later
164    pop     ds
165.DoNotSetInterruptInServiceFlag:
166%endif
167    OUTPUT_AL_TO_IDE_CONTROL_BLOCK_REGISTER     DEVICE_CONTROL_REGISTER_out
168
169    ; Output Feature Number
170    mov     al, [bp+IDEPACK.bFeatures]
171    OUTPUT_AL_TO_IDE_REGISTER   FEATURES_REGISTER_out
172
173    ; Output Sector Address High (only used by LBA48)
174%ifdef MODULE_EBIOS
175    mov     ah, [bp+IDEPACK.bLbaLowExt]
176    xor     al, al                          ; Zero sector count
177    mov     cx, [bp+IDEPACK.wLbaMiddleAndHighExt]
178    call    OutputSectorCountAndAddress
179%endif
180
181    ; Output Sector Address Low
182    mov     ax, [bp+IDEPACK.wSectorCountAndLbaLow]
183    mov     cx, [bp+IDEPACK.wLbaMiddleAndHigh]
184    call    OutputSectorCountAndAddress
185
186    ; Output command
187    mov     al, [bp+IDEPACK.bCommand]
188    OUTPUT_AL_TO_IDE_REGISTER   COMMAND_REGISTER_out
189
190    ; Wait until command completed
191    pop     bx                              ; Pop status and timeout for polling
192    cmp     bl, FLG_STATUS_DRQ              ; Data transfer started?
193    jne     SHORT .WaitUntilNonTransferCommandCompletes
194%ifdef MODULE_8BIT_IDE_ADVANCED
195    cmp     BYTE [di+DPT_ATA.bDevice], DEVICE_8BIT_JRIDE_ISA
196    jae     SHORT JrIdeTransfer_StartWithCommandInAL    ; DEVICE_8BIT_JRIDE_ISA or DEVICE_8BIT_ADP50L
197%endif
198    jmp     IdeTransfer_StartWithCommandInAL
199
200.WaitUntilNonTransferCommandCompletes:
201%ifdef MODULE_IRQ
202    test    BYTE [bp+IDEPACK.bDeviceControl], FLG_DEVCONTROL_nIEN
203%ifdef USE_386
204    jnz     IdeWait_IRQorStatusFlagInBLwithTimeoutInBH
205%else
206    jz      SHORT .PollStatusFlagInsteadOfWaitIrq
207    jmp     IdeWait_IRQorStatusFlagInBLwithTimeoutInBH
208.PollStatusFlagInsteadOfWaitIrq:
209%endif
210%endif ; MODULE_IRQ
211    jmp     IdeWait_PollStatusFlagInBLwithTimeoutInBH
212
213.DriveNotReady:
214    pop     bx                          ; Clean stack
215    ret
216
217
218;--------------------------------------------------------------------
219; IdeCommand_SelectDrive
220;   Parameters:
221;       DS:DI:  Ptr to DPT (in RAMVARS segment)
222;       SS:BP:  Ptr to IDEPACK
223;   Returns:
224;       AH:     INT 13h Error Code
225;       CF:     Cleared if success, Set if error
226;   Corrupts registers:
227;       AL, BX, CX, DX
228;--------------------------------------------------------------------
229ALIGN JUMP_ALIGN
230IdeCommand_SelectDrive:
231    ; We use different timeout value when detecting drives.
232    ; This prevents unnecessary long delays when drive is not present.
233    mov     cx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_DRDY, FLG_STATUS_DRDY)
234    cmp     WORD [RAMVARS.wDrvDetectSignature], RAMVARS_DRV_DETECT_SIGNATURE
235    eCMOVE  ch, TIMEOUT_SELECT_DRIVE_DURING_DRIVE_DETECTION
236
237    ; Select Master or Slave Drive
238    mov     al, [bp+IDEPACK.bDrvAndHead]
239    OUTPUT_AL_TO_IDE_REGISTER   DRIVE_AND_HEAD_SELECT_REGISTER
240    mov     bx, cx
241    call    IdeWait_PollStatusFlagInBLwithTimeoutInBH
242
243    ; Output again to make sure head bits are set. They were lost if the device
244    ; was busy when we first output drive select (although it shouldn't be busy
245    ; since we have waited error result after previous command). Some low power
246    ; drives (CF cards, 1.8" HDDs etc) have some internal sleep modes that
247    ; might cause trouble? Normal HDDs seem to work fine.
248    ;
249    ; Now commented away since this fix was not necessary. Let's keep it here
250    ; if some drive someday has problems crossing 8GB
251    ;mov        al, [bp+IDEPACK.bDrvAndHead]
252    ;OUTPUT_AL_TO_IDE_REGISTER  DRIVE_AND_HEAD_SELECT_REGISTER
253
254    ; Ignore errors from IDE Error Register (set by previous command)
255    cmp     ah, RET_HD_TIMEOUT
256    je      SHORT .FailedToSelectDrive
257    xor     ax, ax                  ; Always success unless timeout
258    ret
259.FailedToSelectDrive:
260    stc
261    ret
262
263
264;--------------------------------------------------------------------
265; OutputSectorCountAndAddress
266;   Parameters:
267;       AH:     LBA low bits (Sector Number)
268;       AL:     Sector Count
269;       CL:     LBA middle bits (Cylinder Number low)
270;       CH:     LBA high bits (Cylinder Number high)
271;       DS:DI:  Ptr to DPT (in RAMVARS segment)
272;   Returns:
273;       Nothing
274;   Corrupts registers:
275;       AL, BX, DX
276;--------------------------------------------------------------------
277ALIGN JUMP_ALIGN
278OutputSectorCountAndAddress:
279    OUTPUT_AL_TO_IDE_REGISTER   SECTOR_COUNT_REGISTER
280
281    mov     al, ah
282    OUTPUT_AL_TO_IDE_REGISTER   LBA_LOW_REGISTER
283
284    mov     al, cl
285    OUTPUT_AL_TO_IDE_REGISTER   LBA_MIDDLE_REGISTER
286
287    mov     al, ch
288    OUTPUT_AL_TO_IDE_REGISTER   LBA_HIGH_REGISTER
289    ret
Note: See TracBrowser for help on using the repository browser.