From: Alan Cox <alan@linux.intel.com>
Date: Thu, 4 Jun 2015 18:43:09 +0000 (+0100)
Subject: dragon-nx-32: Glennside style latching IDE data transfer routines
X-Git-Url: https://git.ndcode.org/public/gitweb.cgi?a=commitdiff_plain;h=ed7f016d5b0306280c00733a727b9202fcfad498;p=FUZIX.git

dragon-nx-32: Glennside style latching IDE data transfer routines
---

diff --git a/Kernel/platform-dragon-nx32/ide.s b/Kernel/platform-dragon-nx32/ide.s
new file mode 100644
index 00000000..f9fec54f
--- /dev/null
+++ b/Kernel/platform-dragon-nx32/ide.s
@@ -0,0 +1,61 @@
+;
+;	Glennside style IDE block transfer logic
+;
+
+	.module dragonide
+
+	.globl _devide_read_data
+	.globl _devide_write_data
+
+	.globl _blk_op
+
+        include "kernel.def"
+        include "../kernel09.def"
+
+	.area .common
+
+;
+;	Standad mapping for Glennside style IDE
+;
+;
+;	Not yet supporting swap
+;
+_devide_read_data:
+	pshs y,dp
+	lda #0xFF
+	tfr a,dp
+	lda _blk_op + 2
+	beq rdk
+	jsr map_process_always
+rdk:	ldx _blk_op
+	leay 512,x
+	sty endp
+readword:
+	lda <IDEDATA
+	ldb <IDEDATA_L		; latched
+	std ,x++
+	cmpx endp
+	bne readword
+	jsr map_kernel
+	puls y,dp,pc
+
+_devide_write_data:
+	pshs y,dp
+	lda #0xFF
+	tfr a,dp
+	lda _blk_op + 2
+	beq wdk
+	jsr map_process_always
+wdk:	ldx _blk_op
+	leay 512,x
+	sty endp
+writeword:
+	ldd ,x++
+	stb <IDEDATA_L
+	sta <IDEDATA
+	cmpx endp
+	bne writeword
+	jsr map_kernel
+	puls y,dp,pc
+
+endp:	.dw 0