source: xtideuniversalbios/trunk/XTIDE_Universal_BIOS/Src/Device/IDE/JrIdeTransfer.asm@ 476

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

Changes to XTIDE Universal BIOS:

  • Memory Mapped Transfers now work again.
File size: 9.5 KB
Line 
1; Project name : XTIDE Universal BIOS
2; Description : Memory mapped IDE Device transfer 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; Structure containing variables for PIO transfer functions.
21; This struct must not be larger than IDEPACK without INTPACK.
22struc MEMPIOVARS ; Must not be larger than 9 bytes! See IDEPACK in RamVars.inc.
23 .wSectorsInBlock resb 2 ; 0-1, Block size in sectors
24 .fpDPT resb 4 ; 2-5, Far pointer to DPT
25 .bSectorsLeft resb 1 ; 6, Sectors left to transfer
26 resb 1 ; 7, IDEPACK.bDeviceControl
27 .bSectorsDone resb 1 ; 8, Number of sectors xferred
28endstruc
29
30SECTOR_ACCESS_WINDOW_SIZE EQU 512 ; 512 bytes
31
32
33; Section containing code
34SECTION .text
35
36;--------------------------------------------------------------------
37; JrIdeTransfer_StartWithCommandInAL
38; Parameters:
39; AL: IDE command that was used to start the transfer
40; (all PIO read and write commands including Identify Device)
41; ES:SI: Ptr to normalized data buffer
42; DS:DI: Ptr to DPT (in RAMVARS segment)
43; SS:BP: Ptr to IDEPACK
44; Returns:
45; AH: INT 13h Error Code
46; CX: Number of successfully transferred sectors
47; CF: Cleared if success, Set if error
48; Corrupts registers:
49; AL, BX, DX, SI, ES
50;--------------------------------------------------------------------
51ALIGN JUMP_ALIGN
52JrIdeTransfer_StartWithCommandInAL:
53 ; Initialize MEMPIOVARS
54 xchg cx, ax ; IDE command to CL
55 xor ax, ax
56 mov [bp+MEMPIOVARS.bSectorsDone], al
57 mov al, [bp+IDEPACK.bSectorCount]
58 mov [bp+MEMPIOVARS.bSectorsLeft], al
59 mov al, [di+DPT_ATA.bBlockSize]
60 mov [bp+MEMPIOVARS.wSectorsInBlock], ax
61 mov [bp+MEMPIOVARS.fpDPT], di
62 mov [bp+MEMPIOVARS.fpDPT+2], ds
63
64 ; Get far pointer to Sector Access Window
65 mov dx, [di+DPT.wBasePort]
66 cmp BYTE [di+DPT_ATA.bDevice], DEVICE_8BIT_JRIDE_ISA
67 jne SHORT .GetSectorAccessWindowForXTCF
68
69 ; Get Sector Access Window for JR-IDE/ISA
70 mov di, JRIDE_SECTOR_ACCESS_WINDOW_OFFSET
71 mov ds, dx ; Segment for JR-IDE/ISA
72 jmp SHORT .SectorAccessWindowLoadedToDSDI
73
74.GetSectorAccessWindowForXTCF:
75 xor di, di
76 add dl, XTCF_CONTROL_REGISTER
77 in al, dx ; Read high byte for Sector Access Window segment
78 xchg ah, al
79 mov ds, ax
80
81 ; Are we reading or writing?
82.SectorAccessWindowLoadedToDSDI:
83 test cl, 16 ; Bit 4 is cleared on all the read commands but set on 3 of the 4 write commands
84 jnz SHORT WriteToSectorAccessWindow
85 cmp cl, COMMAND_WRITE_MULTIPLE
86 je SHORT WriteToSectorAccessWindow
87 ; Fall to ReadFromSectorAccessWindow
88
89;--------------------------------------------------------------------
90; ReadFromSectorAccessWindow
91; Parameters:
92; DS:DI: Ptr to Sector Access Window
93; ES:SI: Normalized ptr to buffer to receive data
94; SS:BP: Ptr to MEMPIOVARS
95; Returns:
96; DS:DI: Ptr to DPT (in RAMVARS segment)
97; AH: BIOS Error code
98; CX: Number of successfully transferred sectors
99; CF: 0 if transfer successful
100; 1 if any error
101; Corrupts registers:
102; AL, BX, DX, SI
103;--------------------------------------------------------------------
104ReadFromSectorAccessWindow:
105 xchg si, di ; DS:SI = source, ES:DI = Destination
106 call WaitUntilReadyToTransferNextBlock
107 jc SHORT ReturnWithMemoryIOtransferErrorInAH
108
109 mov cx, [bp+MEMPIOVARS.wSectorsInBlock] ; Clears CH
110 cmp [bp+MEMPIOVARS.bSectorsLeft], cl
111 jbe SHORT .ReadLastBlockFromDrive
112
113ALIGN JUMP_ALIGN
114.ReadNextBlockFromDrive:
115 call ReadSingleBlockFromSectorAccessWindowInDSSItoESDI
116 call WaitUntilReadyToTransferNextBlock
117 jc SHORT ReturnWithMemoryIOtransferErrorInAH
118
119 ; Update number of successfully read sectors and sectors left to transfer.
120 ; We cannot use SUB instruction as a comparison since it will not
121 ; work in this situation:
122 ; Before SUB we have 2 full blocks left to transfer. SUB command
123 ; then compares 2 full blocks against one full block and updates
124 ; sectors left to one full block and jumps to .ReadNextBlockFromDrive,
125 ; since we have one full block left to transfer. After it has been
126 ; transferred, there will be a wait for next block but DRQ is never
127 ; set since all is transferred! Then we get timeout error.
128 mov cx, [bp+MEMPIOVARS.wSectorsInBlock]
129 sub [bp+MEMPIOVARS.bSectorsLeft], cl
130 add [bp+MEMPIOVARS.bSectorsDone], cl
131 cmp [bp+MEMPIOVARS.bSectorsLeft], cl
132 ja SHORT .ReadNextBlockFromDrive
133
134ALIGN JUMP_ALIGN
135.ReadLastBlockFromDrive:
136 mov cl, [bp+MEMPIOVARS.bSectorsLeft]
137 push cx
138 call ReadSingleBlockFromSectorAccessWindowInDSSItoESDI
139
140 ; Check for errors in last block
141CheckErrorsAfterTransferringLastMemoryMappedBlock:
142 lds di, [bp+MEMPIOVARS.fpDPT] ; DPT now in DS:DI
143 mov bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_DRQ, FLG_STATUS_BSY)
144 call IdeWait_PollStatusFlagInBLwithTimeoutInBH
145 pop cx ; [bp+MEMPIOVARS.bSectorsLeft]
146 jc SHORT ReturnWithMemoryIOtransferErrorInAH
147
148 ; All sectors successfully transferred
149 add cl, [bp+MEMPIOVARS.bSectorsDone] ; Never sets CF
150 ret
151
152 ; Return number of successfully transferred sectors
153ReturnWithMemoryIOtransferErrorInAH:
154 lds di, [bp+MEMPIOVARS.fpDPT] ; DPT now in DS:DI
155%ifdef USE_386
156 movzx cx, BYTE [bp+MEMPIOVARS.bSectorsDone]
157%else
158 mov ch, 0 ; Preserve CF
159 mov cl, [bp+MEMPIOVARS.bSectorsDone]
160%endif
161 ret
162
163
164;--------------------------------------------------------------------
165; WriteToSectorAccessWindow
166; Parameters:
167; DS:DI: Ptr to Sector Access Window
168; ES:SI: Normalized ptr to buffer containing data
169; SS:BP: Ptr to MEMPIOVARS
170; Returns:
171; DS:DI: Ptr to DPT (in RAMVARS segment)
172; AH: BIOS Error code
173; CX: Number of successfully transferred sectors
174; CF: 0 if transfer successful
175; 1 if any error
176; Corrupts registers:
177; AL, BX, DX, SI, ES
178;--------------------------------------------------------------------
179ALIGN JUMP_ALIGN
180WriteToSectorAccessWindow:
181 push es
182 push ds
183 pop es ; ES:DI = Sector Access Window (destination)
184 pop ds ; DS:SI = Ptr to source buffer
185
186 ; Always poll when writing first block (IRQs are generated for following blocks)
187 call WaitUntilReadyToTransferNextBlock
188 jc SHORT ReturnWithMemoryIOtransferErrorInAH
189
190 mov cx, [bp+MEMPIOVARS.wSectorsInBlock]
191 cmp [bp+MEMPIOVARS.bSectorsLeft], cl
192 jbe SHORT .WriteLastBlockToDrive
193
194ALIGN JUMP_ALIGN
195.WriteNextBlockToDrive:
196 call WriteSingleBlockFromDSSIToSectorAccessWindowInESDI
197 call WaitUntilReadyToTransferNextBlock
198 jc SHORT ReturnWithMemoryIOtransferErrorInAH
199
200 ; Increment number of successfully written WORDs
201 mov cx, [bp+MEMPIOVARS.wSectorsInBlock]
202 sub [bp+MEMPIOVARS.bSectorsLeft], cl
203 add [bp+MEMPIOVARS.bSectorsDone], cl
204 cmp [bp+MEMPIOVARS.bSectorsLeft], cl
205 ja SHORT .WriteNextBlockToDrive
206
207ALIGN JUMP_ALIGN
208.WriteLastBlockToDrive:
209 mov cl, [bp+MEMPIOVARS.bSectorsLeft]
210 push cx
211 ePUSH_T bx, CheckErrorsAfterTransferringLastMemoryMappedBlock
212 ; Fall to WriteSingleBlockFromDSSIToSectorAccessWindowInESDI
213
214;--------------------------------------------------------------------
215; WriteSingleBlockFromDSSIToSectorAccessWindowInESDI
216; Parameters:
217; CX: Number of sectors in block
218; DS:SI: Normalized ptr to source buffer
219; ES:DI: Ptr to Sector Access Window
220; Returns:
221; CX, DX: Zero
222; SI: Updated
223; Corrupts registers:
224; BX
225;--------------------------------------------------------------------
226ALIGN JUMP_ALIGN
227WriteSingleBlockFromDSSIToSectorAccessWindowInESDI:
228 mov bx, di
229 mov dx, cx
230 xor cl, cl
231ALIGN JUMP_ALIGN
232.WriteNextSector:
233 mov ch, SECTOR_ACCESS_WINDOW_SIZE >> 9
234 rep movsw
235 mov di, bx ; Reset for next sector
236 dec dx
237 jnz SHORT .WriteNextSector
238 ret
239
240
241;--------------------------------------------------------------------
242; ReadSingleBlockFromSectorAccessWindowInDSSItoESDI
243; Parameters:
244; CX Number of sectors in full block or sectors in last partial block
245; ES:DI: Normalized ptr to buffer to receive data (destination)
246; DS:SI: Ptr to Sector Access Window (source)
247; Returns:
248; CX, DX: Zero
249; DI: Updated
250; Corrupts registers:
251; BX
252;--------------------------------------------------------------------
253ALIGN JUMP_ALIGN
254ReadSingleBlockFromSectorAccessWindowInDSSItoESDI:
255 mov bx, si
256 mov dx, cx
257 xor cl, cl
258ALIGN JUMP_ALIGN
259.ReadNextSector:
260 mov ch, SECTOR_ACCESS_WINDOW_SIZE >> 9
261 rep movsw
262 mov si, bx ; Reset for next sector
263 dec dx
264 jnz SHORT .ReadNextSector
265 ret
266
267
268;--------------------------------------------------------------------
269; WaitUntilReadyToTransferNextBlock
270; Parameters:
271; SS:BP: Ptr to MEMPIOVARS
272; Returns:
273; AH: INT 13h Error Code
274; CF: Cleared if success, Set if error
275; Corrupts registers:
276; AL, BX, CX, DX
277;--------------------------------------------------------------------
278ALIGN JUMP_ALIGN
279WaitUntilReadyToTransferNextBlock:
280 push ds
281 push di
282 lds di, [bp+MEMPIOVARS.fpDPT] ; DPT now in DS:DI
283 call IdeWait_IRQorDRQ ; Always polls
284 pop di
285 pop ds
286 ret
287
288
289%if SECTOR_ACCESS_WINDOW_SIZE <> 512
290 %error "SECTOR_ACCESS_WINDOW_SIZE is no longer equal to 512. JrIdeTransfer.asm needs changes."
291%endif
Note: See TracBrowser for help on using the repository browser.