Context Navigation

source: xtideuniversalbios/trunk/XTIDE_Universal_BIOS/Src/Device/IDE/IdeTransfer.asm@ 410

Visit:

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

Changes to XTIDE Universal BIOS:

Fast XTIDE support should now be up to date.

File size: 12.4 KB

Rev	Line
[150]	1	; Project name : XTIDE Universal BIOS
	2	; Description : IDE Device transfer functions.
	3
[376]	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
[150]	20	; Structure containing variables for PIO transfer functions.
	21	; This struct must not be larger than IDEPACK without INTPACK.
	22	struc PIOVARS
[363]	23	.wDataPort resb 2 ; 0, IDE Data Port
	24	.fnXfer resb 2 ; 2, Offset to transfer function
	25	.wSectorsInBlock resb 2 ; 4, Block size in sectors
	26	.bSectorsLeft resb 1 ; 6, Sectors left to transfer
[218]	27	resb 1 ; 7, IDEPACK.bDeviceControl
[363]	28	.bSectorsDone resb 1 ; 8, Number of sectors xferred
[150]	29	endstruc
	30
	31
	32	; Section containing code
	33	SECTION .text
	34
	35	;--------------------------------------------------------------------
	36	; IdeTransfer_StartWithCommandInAL
	37	; Parameters:
	38	; AL: IDE command that was used to start the transfer
[171]	39	; (all PIO read and write commands including Identify Device)
[218]	40	; ES:SI: Ptr to normalized data buffer
[150]	41	; DS:DI: Ptr to DPT (in RAMVARS segment)
	42	; SS:BP: Ptr to IDEPACK
	43	; Returns:
	44	; AH: INT 13h Error Code
[218]	45	; CX: Number of successfully transferred sectors
[150]	46	; CF: Cleared if success, Set if error
	47	; Corrupts registers:
[218]	48	; AL, BX, DX, SI, ES
[150]	49	;--------------------------------------------------------------------
	50	ALIGN JUMP_ALIGN
	51	IdeTransfer_StartWithCommandInAL:
[157]	52	; Are we reading or writing?
[171]	53	test al, 16 ; Bit 4 is cleared on all the read commands but set on 3 of the 4 write commands
[242]	54	mov ah, [bp+IDEPACK.bSectorCount]
	55	jnz SHORT WriteToDrive
[171]	56	cmp al, COMMAND_WRITE_MULTIPLE
[242]	57	je SHORT WriteToDrive
	58	; Fall to ReadFromDrive
[150]	59
	60	;--------------------------------------------------------------------
[242]	61	; ReadFromDrive
[150]	62	; Parameters:
[242]	63	; AH: Number of sectors to transfer (1...128)
	64	; ES:SI: Normalized ptr to buffer to receive data
[150]	65	; DS:DI: Ptr to DPT (in RAMVARS segment)
	66	; SS:BP: Ptr to PIOVARS
	67	; Returns:
[242]	68	; DS:DI: Ptr to DPT (in RAMVARS segment)
[150]	69	; AH: BIOS Error code
[218]	70	; CX: Number of successfully transferred sectors
[294]	71	; CF: 0 if transfer successful
[150]	72	; 1 if any error
	73	; Corrupts registers:
[218]	74	; AL, BX, DX, SI, ES
[150]	75	;--------------------------------------------------------------------
[242]	76	ReadFromDrive:
	77	; Prepare to read data to ESSI
	78	mov bx, g_rgfnPioRead
	79	call InitializePiovarsInSSBPwithSectorCountInAH
	80
	81	; Wait until drive is ready to transfer
	82	call IdeWait_IRQorDRQ ; Wait until ready to transfer
[218]	83	jc SHORT ReturnWithTransferErrorInAH
[242]	84	xchg si, di ; ES:DI now points buffer
[218]	85
[363]	86	mov cx, [bp+PIOVARS.wSectorsInBlock] ; Max 128
[242]	87
[150]	88	ALIGN JUMP_ALIGN
[242]	89	.ReadNextBlockFromDrive:
[150]	90	mov dx, [bp+PIOVARS.wDataPort]
[363]	91	cmp [bp+PIOVARS.bSectorsLeft], cl
[242]	92	jbe SHORT .ReadLastBlockFromDrive
[218]	93	call [bp+PIOVARS.fnXfer]
[169]	94
[218]	95	; Wait until ready for next block and check for errors
[242]	96	xchg di, si ; DS:DI now points DPT
[218]	97	call IdeWait_IRQorDRQ ; Wait until ready to transfer
	98	jc SHORT ReturnWithTransferErrorInAH
[242]	99	xchg si, di ; ES:DI now points buffer
[169]	100
[363]	101	; Increment number of successfully read sectors
	102	mov cx, [bp+PIOVARS.wSectorsInBlock]
	103	sub [bp+PIOVARS.bSectorsLeft], cl
	104	add [bp+PIOVARS.bSectorsDone], cl
[242]	105	jmp SHORT .ReadNextBlockFromDrive
[150]	106
	107	ALIGN JUMP_ALIGN
[242]	108	.ReadLastBlockFromDrive:
[363]	109	mov cl, [bp+PIOVARS.bSectorsLeft] ; CH is already zero
[150]	110	call [bp+PIOVARS.fnXfer] ; Transfer possibly partial block
	111
[242]	112	; Check for errors in last block
	113	mov di, si ; DS:DI now points DPT
	114	CheckErrorsAfterTransferringLastBlock:
	115	mov bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_DRQ, FLG_STATUS_DRDY)
	116	call IdeWait_PollStatusFlagInBLwithTimeoutInBH
[150]	117
[242]	118	; Return number of successfully read sectors
	119	ReturnWithTransferErrorInAH:
[370]	120	%ifdef USE_386
	121	movzx cx, [bp+PIOVARS.bSectorsDone]
	122	%else
[363]	123	mov cl, [bp+PIOVARS.bSectorsDone]
	124	mov ch, 0 ; Preserve CF
[370]	125	%endif
[242]	126	ret
	127
	128
[150]	129	;--------------------------------------------------------------------
[242]	130	; WriteToDrive
[150]	131	; Parameters:
[242]	132	; AH: Number of sectors to transfer (1...128)
	133	; DS:DI: Ptr to DPT (in RAMVARS segment)
	134	; ES:SI: Normalized ptr to buffer containing data
[150]	135	; SS:BP: Ptr to PIOVARS
	136	; Returns:
	137	; AH: BIOS Error code
[218]	138	; CX: Number of successfully transferred sectors
[294]	139	; CF: 0 if transfer successful
[150]	140	; 1 if any error
	141	; Corrupts registers:
[218]	142	; AL, BX, DX, SI, ES
[150]	143	;--------------------------------------------------------------------
	144	ALIGN JUMP_ALIGN
[242]	145	WriteToDrive:
	146	; Prepare to write data from ESSI
	147	mov bx, g_rgfnPioWrite
	148	call InitializePiovarsInSSBPwithSectorCountInAH
	149
	150	; Always poll when writing first block (IRQs are generated for following blocks)
	151	mov bx, TIMEOUT_AND_STATUS_TO_WAIT(TIMEOUT_DRQ, FLG_STATUS_DRQ)
	152	call IdeWait_PollStatusFlagInBLwithTimeoutInBH
[218]	153	jc SHORT ReturnWithTransferErrorInAH
[150]	154
[363]	155	mov cx, [bp+PIOVARS.wSectorsInBlock] ; Max 128
[242]	156
[218]	157	ALIGN JUMP_ALIGN
[242]	158	.WriteNextBlockToDrive:
[150]	159	mov dx, [bp+PIOVARS.wDataPort]
[363]	160	cmp [bp+PIOVARS.bSectorsLeft], cl
[242]	161	jbe SHORT .WriteLastBlockToDrive
[218]	162	call [bp+PIOVARS.fnXfer]
[169]	163
[218]	164	; Wait until ready for next block and check for errors
	165	call IdeWait_IRQorDRQ ; Wait until ready to transfer
	166	jc SHORT ReturnWithTransferErrorInAH
[150]	167
[363]	168	; Increment number of successfully written sectors
	169	mov cx, [bp+PIOVARS.wSectorsInBlock]
	170	sub [bp+PIOVARS.bSectorsLeft], cl
	171	add [bp+PIOVARS.bSectorsDone], cl
[242]	172	jmp SHORT .WriteNextBlockToDrive
[169]	173
[150]	174	ALIGN JUMP_ALIGN
[242]	175	.WriteLastBlockToDrive:
[363]	176	mov cl, [bp+PIOVARS.bSectorsLeft] ; CH is already zero
[242]	177	%ifdef USE_186
	178	push CheckErrorsAfterTransferringLastBlock
	179	jmp [bp+PIOVARS.fnXfer] ; Transfer possibly partial block
	180	%else
[150]	181	call [bp+PIOVARS.fnXfer] ; Transfer possibly partial block
[242]	182	jmp SHORT CheckErrorsAfterTransferringLastBlock
	183	%endif
[218]	184
[150]	185
	186	;--------------------------------------------------------------------
[218]	187	; InitializePiovarsInSSBPwithSectorCountInAH
[150]	188	; Parameters:
[218]	189	; AH: Number of sectors to transfer (1...128)
[150]	190	; BX: Offset to transfer function lookup table
	191	; DS:DI: Ptr to DPT (in RAMVARS segment)
[169]	192	; SS:BP: Ptr to PIOVARS
[167]	193	; Returns:
[169]	194	; Nothing
[150]	195	; Corrupts registers:
[242]	196	; AX, BX, DX
[150]	197	;--------------------------------------------------------------------
	198	ALIGN JUMP_ALIGN
[218]	199	InitializePiovarsInSSBPwithSectorCountInAH:
	200	; Store sizes
[363]	201	mov [bp+PIOVARS.bSectorsLeft], ah
[370]	202	eMOVZX ax, [di+DPT_ATA.bBlockSize]
[363]	203	mov [bp+PIOVARS.wSectorsInBlock], ax
	204	mov [bp+PIOVARS.bSectorsDone], ah ; Zero
[150]	205
	206	; Get transfer function based on bus type
[158]	207	xchg ax, bx ; Lookup table offset to AX
[242]	208	mov bl, [di+DPT.bIdevarsOffset] ; CS:BX now points to IDEVARS
[150]	209	mov dx, [cs:bx+IDEVARS.wPort] ; Load IDE Data port address
[400]	210	mov bl, [di+DPT_ATA.bDevice]
[150]	211	add bx, ax
[363]	212
[242]	213	mov [bp+PIOVARS.wDataPort], dx
[150]	214	mov ax, [cs:bx] ; Load offset to transfer function
	215	mov [bp+PIOVARS.fnXfer], ax
	216	ret
	217
	218
	219	;--------------------------------------------------------------------
[361]	220	; ReadBlockFromXtideRev1 XTIDE rev 1
	221	; ReadBlockFromXtideRev2 XTIDE rev 2 or rev 1 with swapped A0 and A3 (chuck-mod)
	222	; ReadBlockFrom16bitDataPort Normal 16-bit IDE
	223	; ReadBlockFrom32bitDataPort VLB/PCI 32-bit IDE
[150]	224	; Parameters:
[363]	225	; CX: Block size in 512 byte sectors
[150]	226	; DX: IDE Data port address
[242]	227	; ES:DI: Normalized ptr to buffer to receive data
[150]	228	; Returns:
	229	; Nothing
	230	; Corrupts registers:
	231	; AX, BX, CX
	232	;--------------------------------------------------------------------
[400]	233	%ifdef MODULE_8BIT_IDE
	234
[150]	235	ALIGN JUMP_ALIGN
[361]	236	ReadBlockFromXtideRev1:
[363]	237	UNROLL_SECTORS_IN_CX_TO_QWORDS
[370]	238	mov bl, 8 ; Bit mask for toggling data low/high reg
[150]	239	ALIGN JUMP_ALIGN
	240	.InswLoop:
[152]	241	XTIDE_INSW
	242	XTIDE_INSW
	243	XTIDE_INSW
	244	XTIDE_INSW
[150]	245	loop .InswLoop
	246	ret
	247
[361]	248	;--------------------------------------------------------------------
	249	%ifndef USE_186 ; 8086/8088 compatible WORD read
[150]	250	ALIGN JUMP_ALIGN
[361]	251	ReadBlockFromXtideRev2:
[363]	252	UNROLL_SECTORS_IN_CX_TO_QWORDS
[152]	253	ALIGN JUMP_ALIGN
	254	.ReadNextQword:
	255	in ax, dx ; Read 1st WORD
	256	stosw ; Store 1st WORD to [ES:DI]
	257	in ax, dx
	258	stosw ; 2nd
	259	in ax, dx
	260	stosw ; 3rd
	261	in ax, dx
	262	stosw ; 4th
	263	loop .ReadNextQword
	264	ret
	265	%endif
[150]	266
[400]	267	%endif ; MODULE_8BIT_IDE
	268
[361]	269	;--------------------------------------------------------------------
[401]	270	%ifdef USE_186
[152]	271	ALIGN JUMP_ALIGN
[361]	272	ReadBlockFrom16bitDataPort:
[363]	273	xchg cl, ch ; Sectors to WORDs
[152]	274	rep
	275	db 6Dh ; INSW (we want this in XT build)
	276	ret
[401]	277	%endif
[152]	278
[361]	279	;--------------------------------------------------------------------
[401]	280	%ifdef USE_AT
[152]	281	ALIGN JUMP_ALIGN
[361]	282	ReadBlockFrom32bitDataPort:
[363]	283	db 0C1h ; SHL
	284	db 0E1h ; CX
	285	db 7 ; 7 (Sectors to DWORDs)
[152]	286	rep
	287	db 66h ; Override operand size to 32-bit
	288	db 6Dh ; INSW/INSD
	289	ret
[401]	290	%endif
[152]	291
	292
[150]	293	;--------------------------------------------------------------------
[361]	294	; WriteBlockToXtideRev1 XTIDE rev 1
	295	; WriteBlockToXtideRev2 XTIDE rev 2 or rev 1 with swapped A0 and A3 (chuck-mod)
	296	; WriteBlockToFastXtide Fast XTIDE (CPLD v2 project)
	297	; WriteBlockTo16bitDataPort Normal 16-bit IDE
	298	; WriteBlockTo32bitDataPort VLB/PCI 32-bit IDE
[150]	299	; Parameters:
[363]	300	; CX: Block size in 512-byte sectors
[150]	301	; DX: IDE Data port address
	302	; ES:SI: Normalized ptr to buffer containing data
	303	; Returns:
	304	; Nothing
	305	; Corrupts registers:
	306	; AX, CX
	307	;--------------------------------------------------------------------
[400]	308	%ifdef MODULE_8BIT_IDE
	309
[150]	310	ALIGN JUMP_ALIGN
[361]	311	WriteBlockToXtideRev1:
[150]	312	push ds
	313	push bx
[363]	314	UNROLL_SECTORS_IN_CX_TO_QWORDS
[370]	315	mov bl, 8 ; Bit mask for toggling data low/high reg
[152]	316	push es ; Copy ES...
	317	pop ds ; ...to DS
[150]	318	ALIGN JUMP_ALIGN
	319	.OutswLoop:
[152]	320	XTIDE_OUTSW
	321	XTIDE_OUTSW
	322	XTIDE_OUTSW
	323	XTIDE_OUTSW
[150]	324	loop .OutswLoop
	325	pop bx
	326	pop ds
	327	ret
	328
[361]	329	;--------------------------------------------------------------------
[150]	330	ALIGN JUMP_ALIGN
[361]	331	WriteBlockToXtideRev2:
[363]	332	UNROLL_SECTORS_IN_CX_TO_QWORDS
[152]	333	push ds
	334	push es ; Copy ES...
	335	pop ds ; ...to DS
	336	ALIGN JUMP_ALIGN
	337	.WriteNextQword:
	338	XTIDE_MOD_OUTSW
	339	XTIDE_MOD_OUTSW
	340	XTIDE_MOD_OUTSW
	341	XTIDE_MOD_OUTSW
	342	loop .WriteNextQword
	343	pop ds
	344	ret
[150]	345
[361]	346	;--------------------------------------------------------------------
[152]	347	ALIGN JUMP_ALIGN
[361]	348	WriteBlockToFastXtide:
[363]	349	UNROLL_SECTORS_IN_CX_TO_QWORDS
[361]	350	push ds
	351	push es
	352	pop ds
[402]	353	or dl, (1<<4) ; Writes need A4 set
[361]	354	ALIGN JUMP_ALIGN
	355	.ReadNextQword:
	356	lodsw ; Load 1st WORD from [DS:SI]
	357	out dx, ax ; Write 1st WORD
	358	lodsw
	359	out dx, ax ; 2nd
	360	lodsw
	361	out dx, ax ; 3rd
	362	lodsw
	363	out dx, ax ; 4th
	364	loop .ReadNextQword
	365	pop ds
	366	ret
	367
[400]	368	%endif ; MODULE_8BIT_IDE
	369
[361]	370	;--------------------------------------------------------------------
[402]	371	%ifdef USE_AT
[361]	372	ALIGN JUMP_ALIGN
	373	WriteBlockTo16bitDataPort:
[363]	374	xchg cl, ch ; Sectors to WORDs
[223]	375	es ; Source is ES segment
[152]	376	rep
[155]	377	db 6Fh ; OUTSW (we want this in XT build)
[152]	378	ret
	379
[361]	380	;--------------------------------------------------------------------
[152]	381	ALIGN JUMP_ALIGN
[361]	382	WriteBlockTo32bitDataPort:
[363]	383	db 0C1h ; SHL
	384	db 0E1h ; CX
	385	db 7 ; 7 (Sectors to DWORDs)
[223]	386	es ; Source is ES segment
[152]	387	rep
	388	db 66h ; Override operand size to 32-bit
	389	db 6Fh ; OUTSW/OUTSD
	390	ret
[401]	391	%endif
[152]	392
	393
[361]	394
[150]	395	; Lookup tables to get transfer function based on bus type
	396	ALIGN WORD_ALIGN
	397	g_rgfnPioRead:
[400]	398	%ifdef MODULE_8BIT_IDE
[401]	399	dw 0 ; 0, DEVICE_8BIT_JRIDE_ISA
[400]	400	%ifdef USE_186
[401]	401	dw ReadBlockFrom16bitDataPort ; 1, DEVICE_FAST_XTIDE
	402	dw ReadBlockFrom16bitDataPort ; 2, DEVICE_8BIT_XTIDE_REV2
[400]	403	%else
[401]	404	dw ReadBlockFromXtideRev2 ; 1, DEVICE_FAST_XTIDE
	405	dw ReadBlockFromXtideRev2 ; 2, DEVICE_8BIT_XTIDE_REV2
[400]	406	%endif
[401]	407	dw ReadBlockFromXtideRev1 ; 3, DEVICE_XTIDE_REV1
[400]	408
[152]	409	%else
[400]	410	times COUNT_OF_8BIT_IDE_DEVICES dw 0
[152]	411	%endif
[401]	412	%ifdef USE_AT
	413	dw ReadBlockFrom16bitDataPort ; 4, DEVICE_16BIT_ATA
	414	dw ReadBlockFrom32bitDataPort ; 5, DEVICE_32BIT_ATA
	415	%endif
[152]	416
[400]	417
[150]	418	g_rgfnPioWrite:
[400]	419	%ifdef MODULE_8BIT_IDE
[401]	420	dw 0 ; 0, DEVICE_8BIT_JRIDE_ISA
	421	dw WriteBlockToFastXtide ; 1, DEVICE_FAST_XTIDE
	422	dw WriteBlockToXtideRev2 ; 2, DEVICE_XTIDE_REV2
	423	dw WriteBlockToXtideRev1 ; 3, DEVICE_XTIDE_REV1
[400]	424
[361]	425	%else
[400]	426	times COUNT_OF_8BIT_IDE_DEVICES dw 0
[361]	427	%endif
[401]	428	%ifdef USE_AT
	429	dw WriteBlockTo16bitDataPort ; 4, DEVICE_16BIT_ATA
	430	dw WriteBlockTo32bitDataPort ; 5, DEVICE_32BIT_ATA
	431	%endif

Note: See TracBrowser for help on using the repository browser.

Download in other formats: