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

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

Changes to XTIDE Universal BIOS:

  • More JR-IDE/ISA fixes.
File size: 7.4 KB
Line 
1; Project name : XTIDE Universal BIOS
2; Description : IDE Device Command functions.
3
4; Section containing code
5SECTION .text
6
7;--------------------------------------------------------------------
8; IdeCommand_ResetMasterAndSlaveController
9; Parameters:
10; DS:DI: Ptr to DPT (in RAMVARS segment)
11; Returns:
12; AH: INT 13h Error Code
13; CF: Cleared if success, Set if error
14; Corrupts registers:
15; AL, BX, CX, DX
16;--------------------------------------------------------------------
17IDEDEVICE%+Command_ResetMasterAndSlaveController:
18 ; HSR0: Set_SRST
19 call AccessDPT_GetDeviceControlByteToAL
20 or al, FLG_DEVCONTROL_SRST | FLG_DEVCONTROL_nIEN ; Set Reset bit
21 OUTPUT_AL_TO_IDE_CONTROL_BLOCK_REGISTER DEVICE_CONTROL_REGISTER_out
22 mov ax, HSR0_RESET_WAIT_US
23 call Timer_DelayMicrosecondsFromAX
24
25 ; HSR1: Clear_wait
26 call AccessDPT_GetDeviceControlByteToAL
27 or al, FLG_DEVCONTROL_nIEN
28 and al, ~FLG_DEVCONTROL_SRST ; Clear reset bit
29 OUTPUT_AL_TO_IDE_CONTROL_BLOCK_REGISTER DEVICE_CONTROL_REGISTER_out
30 mov ax, HSR1_RESET_WAIT_US
31 call Timer_DelayMicrosecondsFromAX
32
33 ; HSR2: Check_status
34 mov bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_MOTOR_STARTUP, FLG_STATUS_BSY)
35 jmp IDEDEVICE%+Wait_PollStatusFlagInBLwithTimeoutInBH
36
37
38;--------------------------------------------------------------------
39; IdeCommand_IdentifyDeviceToBufferInESSIwithDriveSelectByteInBH
40; Parameters:
41; BH: Drive Select byte for Drive and Head Select Register
42; DS: Segment to RAMVARS
43; ES:SI: Ptr to buffer to receive 512-byte IDE Information
44; CS:BP: Ptr to IDEVARS
45; Returns:
46; AH: INT 13h Error Code
47; CF: Cleared if success, Set if error
48; Corrupts registers:
49; AL, BL, CX, DX, SI, DI, ES
50;--------------------------------------------------------------------
51IDEDEVICE%+Command_IdentifyDeviceToBufferInESSIwithDriveSelectByteInBH:
52 ; Create fake DPT to be able to use Device.asm functions
53 call FindDPT_ForNewDriveToDSDI
54 eMOVZX ax, bh
55 mov [di+DPT.wFlags], ax
56 mov [di+DPT.bIdevarsOffset], bp
57 mov BYTE [di+DPT_ATA.bSetBlock], 1 ; Block = 1 sector
58%ifdef ASSEMBLE_SHARED_IDE_DEVICE_FUNCTIONS
59 call IdeDPT_StoreReversedAddressLinesFlagIfNecessary
60%endif
61
62 ; Wait until drive motors have reached max speed
63 cmp bp, BYTE ROMVARS.ideVars0
64 jne SHORT .SkipLongWaitSinceDriveIsNotPrimaryMaster
65 test al, FLG_DRVNHEAD_DRV
66 jnz SHORT .SkipLongWaitSinceDriveIsNotPrimaryMaster
67 mov bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_MOTOR_STARTUP, FLG_STATUS_BSY)
68 call IDEDEVICE%+Wait_PollStatusFlagInBLwithTimeoutInBH
69.SkipLongWaitSinceDriveIsNotPrimaryMaster:
70
71 ; Create IDEPACK without INTPACK
72 push bp
73 call Idepack_FakeToSSBP
74
75 ; Prepare to output Identify Device command
76 mov dl, 1 ; Sector count (required by IdeTransfer.asm)
77 mov al, COMMAND_IDENTIFY_DEVICE
78 mov bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_IDENTIFY_DEVICE, FLG_STATUS_DRQ)
79 call Idepack_StoreNonExtParametersAndIssueCommandFromAL
80
81 ; Clean stack and return
82 lea sp, [bp+EXTRA_BYTES_FOR_INTPACK] ; This assumes BP hasn't changed between Idepack_FakeToSSBP and here
83 pop bp
84 ret
85
86
87;--------------------------------------------------------------------
88; IdeCommand_OutputWithParameters
89; Parameters:
90; BH: System timer ticks for timeout
91; BL: IDE Status Register bit to poll after command
92; ES:SI: Ptr to buffer (for data transfer commands)
93; DS:DI: Ptr to DPT (in RAMVARS segment)
94; SS:BP: Ptr to IDEPACK
95; Returns:
96; AH: INT 13h Error Code
97; CX: Number of successfully transferred sectors (for transfer commands)
98; CF: Cleared if success, Set if error
99; Corrupts registers:
100; AL, BX, (CX), DX, (ES:SI for data transfer commands)
101;--------------------------------------------------------------------
102ALIGN JUMP_ALIGN
103IDEDEVICE%+Command_OutputWithParameters:
104 push bx ; Store status register bits to poll
105
106 ; Select Master or Slave drive and output head number or LBA28 top bits
107 call IDEDEVICE%+Command_SelectDrive
108 jc SHORT .DriveNotReady
109
110 ; Output Device Control Byte to enable or disable interrupts
111 mov al, [bp+IDEPACK.bDeviceControl]
112%ifdef ASSEMBLE_SHARED_IDE_DEVICE_FUNCTIONS ; JR-IDE/ISA
113 test al, FLG_DEVCONTROL_nIEN ; Interrupts disabled?
114 jnz SHORT .DoNotSetInterruptInServiceFlag
115
116 ; Clear Task Flag and set Interrupt In-Service Flag
117 or BYTE [di+DPT.bFlagsHigh], FLGH_DPT_INTERRUPT_IN_SERVICE
118 push ds
119 LOAD_BDA_SEGMENT_TO ds, dx, ! ; Also zero DX
120 mov [BDA.bHDTaskFlg], dl
121 pop ds
122.DoNotSetInterruptInServiceFlag:
123%endif
124 OUTPUT_AL_TO_IDE_CONTROL_BLOCK_REGISTER DEVICE_CONTROL_REGISTER_out
125
126 ; Output Feature Number
127 mov al, [bp+IDEPACK.bFeatures]
128 OUTPUT_AL_TO_IDE_REGISTER FEATURES_REGISTER_out
129
130 ; Output Sector Address High (only used by LBA48)
131 eMOVZX ax, BYTE [bp+IDEPACK.bLbaLowExt]
132 mov cx, [bp+IDEPACK.wLbaMiddleAndHighExt]
133 call IDEDEVICE%+OutputSectorCountAndAddress
134
135 ; Output Sector Address Low
136 mov ax, [bp+IDEPACK.wSectorCountAndLbaLow]
137 mov cx, [bp+IDEPACK.wLbaMiddleAndHigh]
138 call IDEDEVICE%+OutputSectorCountAndAddress
139
140 ; Output command
141 mov al, [bp+IDEPACK.bCommand]
142 OUTPUT_AL_TO_IDE_REGISTER COMMAND_REGISTER_out
143
144 ; Wait until command completed
145 pop bx ; Pop status and timeout for polling
146 cmp bl, FLG_STATUS_DRQ ; Data transfer started?
147 je SHORT IDEDEVICE%+Transfer_StartWithCommandInAL
148 test BYTE [bp+IDEPACK.bDeviceControl], FLG_DEVCONTROL_nIEN
149 jz SHORT .WaitForIrqOrRdy
150 jmp IDEDEVICE%+Wait_PollStatusFlagInBLwithTimeoutInBH
151
152ALIGN JUMP_ALIGN
153.WaitForIrqOrRdy:
154 jmp IDEDEVICE%+Wait_IRQorStatusFlagInBLwithTimeoutInBH
155
156.DriveNotReady:
157 pop bx ; Clean stack
158IDEDEVICE%+ReturnSinceTimeoutWhenPollingBusy:
159 ret
160
161
162;--------------------------------------------------------------------
163; IdeCommand_SelectDrive
164; Parameters:
165; DS:DI: Ptr to DPT (in RAMVARS segment)
166; SS:BP: Ptr to IDEPACK
167; Returns:
168; AH: INT 13h Error Code
169; CF: Cleared if success, Set if error
170; Corrupts registers:
171; AL, BX, CX, DX
172;--------------------------------------------------------------------
173ALIGN JUMP_ALIGN
174IDEDEVICE%+Command_SelectDrive:
175 ; Wait until neither Master or Slave Drive is busy
176 mov bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_BSY, FLG_STATUS_BSY)
177 cmp BYTE [bp+IDEPACK.bCommand], COMMAND_IDENTIFY_DEVICE
178 eCMOVE bh, TIMEOUT_IDENTIFY_DEVICE
179 call IDEDEVICE%+Wait_PollStatusFlagInBLwithTimeoutInBH
180 jc SHORT IDEDEVICE%+ReturnSinceTimeoutWhenPollingBusy
181
182 ; Select Master or Slave Drive
183 mov al, [bp+IDEPACK.bDrvAndHead]
184 OUTPUT_AL_TO_IDE_REGISTER DRIVE_AND_HEAD_SELECT_REGISTER
185 mov bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_DRDY, FLG_STATUS_DRDY)
186 cmp BYTE [bp+IDEPACK.bCommand], COMMAND_IDENTIFY_DEVICE
187 eCMOVE bh, TIMEOUT_IDENTIFY_DEVICE
188 jmp IDEDEVICE%+Wait_PollStatusFlagInBLwithTimeoutInBH
189
190
191;--------------------------------------------------------------------
192; OutputSectorCountAndAddress
193; Parameters:
194; AH: LBA low bits (Sector Number)
195; AL: Sector Count
196; CL: LBA middle bits (Cylinder Number low)
197; CH: LBA high bits (Cylinder Number high)
198; DS:DI: Ptr to DPT (in RAMVARS segment)
199; Returns:
200; Nothing
201; Corrupts registers:
202; AL, BX, DX
203;--------------------------------------------------------------------
204ALIGN JUMP_ALIGN
205IDEDEVICE%+OutputSectorCountAndAddress:
206 OUTPUT_AL_TO_IDE_REGISTER SECTOR_COUNT_REGISTER
207
208 mov al, ah
209 OUTPUT_AL_TO_IDE_REGISTER LBA_LOW_REGISTER
210
211 mov al, cl
212 OUTPUT_AL_TO_IDE_REGISTER LBA_MIDDLE_REGISTER
213
214 mov al, ch
215 JUMP_TO_OUTPUT_AL_TO_IDE_REGISTER LBA_HIGH_REGISTER
Note: See TracBrowser for help on using the repository browser.