[PATCH] m68k patches for 2.6.30

public inbox for linux-kernel@vger.kernel.org
 help / color / mirror / Atom feed

* [PATCH] m68k patches for 2.6.30
@ 2009-03-01  9:21 Geert Uytterhoeven
  2009-03-01  9:21 ` [PATCH 1/6] m68k: Add install target Geert Uytterhoeven
  0 siblings, 1 reply; 9+ messages in thread
From: Geert Uytterhoeven @ 2009-03-01  9:21 UTC (permalink / raw)
  To: linux-m68k; +Cc: linux-kernel

Here are the m68k patches I have queued up for 2.6.30:
    [1/6] m68k: Add install target
    [2/6] m68k: mac - Add a new entry in mac_model to identify the floppy
                controller type.
    [3/6] m68k: mac - Add SWIM floppy support
    [4/6] MAINTAINERS: Replace dead link to m68k CVS repository by link to new
                       git repository
    [5/6] m68k: section mismatch fixes: DMAsound for Atari
    [6/6] m68k: section mismatch fixes: Atari SCSI

They're also available on my for-2.6.30 branch (which may be rebased):

    http://git.kernel.org/?p=linux/kernel/git/geert/linux-m68k.git;a=shortlog;h=for-2.6.30

If anything is missing, please let me know.

Thanks for reviewing!

Gr{oetje,eeting}s,

                                                Geert

--
Geert Uytterhoeven -- There's lots of Linux beyond ia32 -- geert@linux-m68k.org

In personal conversations with technical people, I call myself a hacker. But
when I'm talking to journalists I just say "programmer" or something like that.
                                                            -- Linus Torvalds

^ permalink raw reply	[flat|nested] 9+ messages in thread

* [PATCH 1/6] m68k: Add install target
  2009-03-01  9:21 [PATCH] m68k patches for 2.6.30 Geert Uytterhoeven
@ 2009-03-01  9:21 ` Geert Uytterhoeven
  2009-03-01  9:21   ` [PATCH 2/6] m68k: mac - Add a new entry in mac_model to identify the floppy controller type Geert Uytterhoeven
  0 siblings, 1 reply; 9+ messages in thread
From: Geert Uytterhoeven @ 2009-03-01  9:21 UTC (permalink / raw)
  To: linux-m68k; +Cc: linux-kernel, Laurent Vivier, Geert Uytterhoeven

From: Laurent Vivier <Laurent@lvivier.info>

This patch enables the use of "make install" on m68k architecture
to copy kernel to /boot.

Signed-off-by: Laurent Vivier <Laurent@lvivier.info>
Signed-off-by: Geert Uytterhoeven <geert@linux-m68k.org>
---
 arch/m68k/Makefile   |    3 ++
 arch/m68k/install.sh |   52 ++++++++++++++++++++++++++++++++++++++++++++++++++
 2 files changed, 55 insertions(+), 0 deletions(-)
 create mode 100644 arch/m68k/install.sh

diff --git a/arch/m68k/Makefile b/arch/m68k/Makefile
index 8133dbc..570d85c 100644
--- a/arch/m68k/Makefile
+++ b/arch/m68k/Makefile
@@ -117,3 +117,6 @@ endif
 
 archclean:
 	rm -f vmlinux.gz vmlinux.bz2
+
+install:
+	sh $(srctree)/arch/m68k/install.sh $(KERNELRELEASE) vmlinux.gz System.map "$(INSTALL_PATH)"
diff --git a/arch/m68k/install.sh b/arch/m68k/install.sh
new file mode 100644
index 0000000..9c6bae6
--- /dev/null
+++ b/arch/m68k/install.sh
@@ -0,0 +1,52 @@
+#!/bin/sh
+#
+# This file is subject to the terms and conditions of the GNU General Public
+# License.  See the file "COPYING" in the main directory of this archive
+# for more details.
+#
+# Copyright (C) 1995 by Linus Torvalds
+#
+# Adapted from code in arch/i386/boot/Makefile by H. Peter Anvin
+#
+# "make install" script for m68k architecture
+#
+# Arguments:
+#   $1 - kernel version
+#   $2 - kernel image file
+#   $3 - kernel map file
+#   $4 - default install path (blank if root directory)
+#
+
+verify () {
+	if [ ! -f "$1" ]; then
+		echo ""                                                   1>&2
+		echo " *** Missing file: $1"                              1>&2
+		echo ' *** You need to run "make" before "make install".' 1>&2
+		echo ""                                                   1>&2
+		exit 1
+	fi
+}
+
+# Make sure the files actually exist
+verify "$2"
+verify "$3"
+
+# User may have a custom install script
+
+if [ -x ~/bin/${CROSS_COMPILE}installkernel ]; then exec ~/bin/${CROSS_COMPILE}installkernel "$@"; fi
+if [ -x /sbin/${CROSS_COMPILE}installkernel ]; then exec /sbin/${CROSS_COMPILE}installkernel "$@"; fi
+
+# Default install - same as make zlilo
+
+if [ -f $4/vmlinuz ]; then
+	mv $4/vmlinuz $4/vmlinuz.old
+fi
+
+if [ -f $4/System.map ]; then
+	mv $4/System.map $4/System.old
+fi
+
+cat $2 > $4/vmlinuz
+cp $3 $4/System.map
+
+sync
-- 
1.6.1.3


^ permalink raw reply related	[flat|nested] 9+ messages in thread

* [PATCH 2/6] m68k: mac - Add a new entry in mac_model to identify the floppy controller type.
  2009-03-01  9:21 ` [PATCH 1/6] m68k: Add install target Geert Uytterhoeven
@ 2009-03-01  9:21   ` Geert Uytterhoeven
  2009-03-01  9:21     ` [PATCH 3/6] m68k: mac - Add SWIM floppy support Geert Uytterhoeven
  0 siblings, 1 reply; 9+ messages in thread
From: Geert Uytterhoeven @ 2009-03-01  9:21 UTC (permalink / raw)
  To: linux-m68k; +Cc: linux-kernel, Laurent Vivier, Geert Uytterhoeven

From: Laurent Vivier <Laurent@lvivier.info>

This patch adds a field "floppy_type" which can take the following values:

MAC_FLOPPY_IWM for an IWM based mac
MAC_FLOPPY_SWIM_ADDR1 for a SWIM based mac with controller at VIA1 + 0x1E000
MAC_FLOPPY_SWIM_ADDR2 for a SWIM based mac with controller at VIA1 + 0x16000
MAC_FLOPPY_IOP for an IOP based mac
MAC_FLOPPY_AV for an AV based mac

Signed-off-by: Laurent Vivier <Laurent@lvivier.info>
Signed-off-by: Geert Uytterhoeven <geert@linux-m68k.org>
---
 arch/m68k/include/asm/macintosh.h |    7 ++
 arch/m68k/mac/config.c            |  163 +++++++++++++++++++++++++------------
 2 files changed, 116 insertions(+), 54 deletions(-)

diff --git a/arch/m68k/include/asm/macintosh.h b/arch/m68k/include/asm/macintosh.h
index 05309f7..50db359 100644
--- a/arch/m68k/include/asm/macintosh.h
+++ b/arch/m68k/include/asm/macintosh.h
@@ -34,6 +34,7 @@ struct mac_model
 	char scc_type;
 	char ether_type;
 	char nubus_type;
+	char floppy_type;
 };
 
 #define MAC_ADB_NONE		0
@@ -71,6 +72,12 @@ struct mac_model
 #define MAC_NO_NUBUS		0
 #define MAC_NUBUS		1
 
+#define MAC_FLOPPY_IWM		0
+#define MAC_FLOPPY_SWIM_ADDR1	1
+#define MAC_FLOPPY_SWIM_ADDR2	2
+#define MAC_FLOPPY_SWIM_IOP	3
+#define MAC_FLOPPY_AV		4
+
 /*
  *	Gestalt numbers
  */
diff --git a/arch/m68k/mac/config.c b/arch/m68k/mac/config.c
index 98b6bcf..3a1c0b2 100644
--- a/arch/m68k/mac/config.c
+++ b/arch/m68k/mac/config.c
@@ -224,7 +224,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_II,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type	= MAC_FLOPPY_IWM
 	},
 
 	/*
@@ -239,7 +240,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_II,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type	= MAC_FLOPPY_IWM
 	}, {
 		.ident		= MAC_MODEL_IIX,
 		.name		= "IIx",
@@ -247,7 +249,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_II,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type	= MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_IICX,
 		.name		= "IIcx",
@@ -255,7 +258,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_II,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_SE30,
 		.name		= "SE/30",
@@ -263,7 +267,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_II,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	},
 
 	/*
@@ -280,7 +285,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_IIFX,
 		.name		= "IIfx",
@@ -288,7 +294,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_IOP,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_IOP
 	}, {
 		.ident		= MAC_MODEL_IISI,
 		.name		= "IIsi",
@@ -296,7 +303,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_IIVI,
 		.name		= "IIvi",
@@ -304,7 +312,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_IIVX,
 		.name		= "IIvx",
@@ -312,7 +321,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	},
 
 	/*
@@ -326,7 +336,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_CCL,
 		.name		= "Color Classic",
@@ -334,7 +345,9 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS},
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
+	},
 
 	/*
 	 *	Some Mac LC machines. Basically the same as the IIci, ADB like IIsi
@@ -347,7 +360,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_LCII,
 		.name		= "LC II",
@@ -355,7 +369,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_LCIII,
 		.name		= "LC III",
@@ -363,7 +378,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	},
 
 	/*
@@ -383,7 +399,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_QUADRA,
 		.scsi_type	= MAC_SCSI_QUADRA,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type	= MAC_FLOPPY_SWIM_ADDR1
 	}, {
 		.ident		= MAC_MODEL_Q605_ACC,
 		.name		= "Quadra 605",
@@ -391,7 +408,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_QUADRA,
 		.scsi_type	= MAC_SCSI_QUADRA,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type	= MAC_FLOPPY_SWIM_ADDR1
 	}, {
 		.ident		= MAC_MODEL_Q610,
 		.name		= "Quadra 610",
@@ -400,7 +418,8 @@ static struct mac_model mac_data_table[] = {
 		.scsi_type	= MAC_SCSI_QUADRA,
 		.scc_type	= MAC_SCC_QUADRA,
 		.ether_type	= MAC_ETHER_SONIC,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type	= MAC_FLOPPY_SWIM_ADDR1
 	}, {
 		.ident		= MAC_MODEL_Q630,
 		.name		= "Quadra 630",
@@ -410,7 +429,8 @@ static struct mac_model mac_data_table[] = {
 		.ide_type	= MAC_IDE_QUADRA,
 		.scc_type	= MAC_SCC_QUADRA,
 		.ether_type	= MAC_ETHER_SONIC,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type	= MAC_FLOPPY_SWIM_ADDR1
 	}, {
 		.ident		= MAC_MODEL_Q650,
 		.name		= "Quadra 650",
@@ -419,7 +439,8 @@ static struct mac_model mac_data_table[] = {
 		.scsi_type	= MAC_SCSI_QUADRA,
 		.scc_type	= MAC_SCC_QUADRA,
 		.ether_type	= MAC_ETHER_SONIC,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type	= MAC_FLOPPY_SWIM_ADDR1
 	},
 	/*	The Q700 does have a NS Sonic */
 	{
@@ -430,7 +451,8 @@ static struct mac_model mac_data_table[] = {
 		.scsi_type	= MAC_SCSI_QUADRA2,
 		.scc_type	= MAC_SCC_QUADRA,
 		.ether_type	= MAC_ETHER_SONIC,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type	= MAC_FLOPPY_SWIM_ADDR1
 	}, {
 		.ident		= MAC_MODEL_Q800,
 		.name		= "Quadra 800",
@@ -439,7 +461,8 @@ static struct mac_model mac_data_table[] = {
 		.scsi_type	= MAC_SCSI_QUADRA,
 		.scc_type	= MAC_SCC_QUADRA,
 		.ether_type	= MAC_ETHER_SONIC,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type	= MAC_FLOPPY_SWIM_ADDR1
 	}, {
 		.ident		= MAC_MODEL_Q840,
 		.name		= "Quadra 840AV",
@@ -448,7 +471,8 @@ static struct mac_model mac_data_table[] = {
 		.scsi_type	= MAC_SCSI_QUADRA3,
 		.scc_type	= MAC_SCC_PSC,
 		.ether_type	= MAC_ETHER_MACE,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_AV
 	}, {
 		.ident		= MAC_MODEL_Q900,
 		.name		= "Quadra 900",
@@ -457,7 +481,8 @@ static struct mac_model mac_data_table[] = {
 		.scsi_type	= MAC_SCSI_QUADRA2,
 		.scc_type	= MAC_SCC_IOP,
 		.ether_type	= MAC_ETHER_SONIC,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_IOP
 	}, {
 		.ident		= MAC_MODEL_Q950,
 		.name		= "Quadra 950",
@@ -466,7 +491,8 @@ static struct mac_model mac_data_table[] = {
 		.scsi_type	= MAC_SCSI_QUADRA2,
 		.scc_type	= MAC_SCC_IOP,
 		.ether_type	= MAC_ETHER_SONIC,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_IOP
 	},
 
 	/*
@@ -480,7 +506,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_P475,
 		.name		=  "Performa 475",
@@ -488,7 +515,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_QUADRA,
 		.scsi_type	= MAC_SCSI_QUADRA,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type	= MAC_FLOPPY_SWIM_ADDR1
 	}, {
 		.ident		= MAC_MODEL_P475F,
 		.name		=  "Performa 475",
@@ -496,7 +524,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_QUADRA,
 		.scsi_type	= MAC_SCSI_QUADRA,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type	= MAC_FLOPPY_SWIM_ADDR1
 	}, {
 		.ident		= MAC_MODEL_P520,
 		.name		=  "Performa 520",
@@ -504,7 +533,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_P550,
 		.name		=  "Performa 550",
@@ -512,7 +542,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	},
 	/* These have the comm slot, and therefore the possibility of SONIC ethernet */
 	{
@@ -523,7 +554,8 @@ static struct mac_model mac_data_table[] = {
 		.scsi_type	= MAC_SCSI_QUADRA,
 		.scc_type	= MAC_SCC_II,
 		.ether_type	= MAC_ETHER_SONIC,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type	= MAC_FLOPPY_SWIM_ADDR1
 	}, {
 		.ident		= MAC_MODEL_P588,
 		.name		= "Performa 588",
@@ -533,7 +565,8 @@ static struct mac_model mac_data_table[] = {
 		.ide_type	= MAC_IDE_QUADRA,
 		.scc_type	= MAC_SCC_II,
 		.ether_type	= MAC_ETHER_SONIC,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type	= MAC_FLOPPY_SWIM_ADDR1
 	}, {
 		.ident		= MAC_MODEL_TV,
 		.name		= "TV",
@@ -541,7 +574,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_QUADRA,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_P600,
 		.name		= "Performa 600",
@@ -549,7 +583,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_II,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	},
 
 	/*
@@ -565,7 +600,8 @@ static struct mac_model mac_data_table[] = {
 		.scsi_type	= MAC_SCSI_QUADRA,
 		.scc_type	= MAC_SCC_QUADRA,
 		.ether_type	= MAC_ETHER_SONIC,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR1
 	}, {
 		.ident		= MAC_MODEL_C650,
 		.name		= "Centris 650",
@@ -574,7 +610,8 @@ static struct mac_model mac_data_table[] = {
 		.scsi_type	= MAC_SCSI_QUADRA,
 		.scc_type	= MAC_SCC_QUADRA,
 		.ether_type	= MAC_ETHER_SONIC,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR1
 	}, {
 		.ident		= MAC_MODEL_C660,
 		.name		= "Centris 660AV",
@@ -583,7 +620,8 @@ static struct mac_model mac_data_table[] = {
 		.scsi_type	= MAC_SCSI_QUADRA3,
 		.scc_type	= MAC_SCC_PSC,
 		.ether_type	= MAC_ETHER_MACE,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_AV
 	},
 
 	/*
@@ -599,7 +637,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_QUADRA,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_PB145,
 		.name		= "PowerBook 145",
@@ -607,7 +646,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_QUADRA,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_PB150,
 		.name		= "PowerBook 150",
@@ -616,7 +656,8 @@ static struct mac_model mac_data_table[] = {
 		.scsi_type	= MAC_SCSI_OLD,
 		.ide_type	= MAC_IDE_PB,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_PB160,
 		.name		= "PowerBook 160",
@@ -624,7 +665,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_QUADRA,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_PB165,
 		.name		= "PowerBook 165",
@@ -632,7 +674,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_QUADRA,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_PB165C,
 		.name		= "PowerBook 165c",
@@ -640,7 +683,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_QUADRA,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_PB170,
 		.name		= "PowerBook 170",
@@ -648,7 +692,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_QUADRA,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_PB180,
 		.name		= "PowerBook 180",
@@ -656,7 +701,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_QUADRA,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_PB180C,
 		.name		= "PowerBook 180c",
@@ -664,7 +710,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_QUADRA,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_PB190,
 		.name		= "PowerBook 190",
@@ -673,7 +720,8 @@ static struct mac_model mac_data_table[] = {
 		.scsi_type	= MAC_SCSI_OLD,
 		.ide_type	= MAC_IDE_BABOON,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_PB520,
 		.name		= "PowerBook 520",
@@ -682,7 +730,8 @@ static struct mac_model mac_data_table[] = {
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_QUADRA,
 		.ether_type	= MAC_ETHER_SONIC,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	},
 
 	/*
@@ -702,7 +751,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_PB230,
 		.name		= "PowerBook Duo 230",
@@ -710,7 +760,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_PB250,
 		.name		= "PowerBook Duo 250",
@@ -718,7 +769,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_PB270C,
 		.name		= "PowerBook Duo 270c",
@@ -726,7 +778,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_PB280,
 		.name		= "PowerBook Duo 280",
@@ -734,7 +787,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	}, {
 		.ident		= MAC_MODEL_PB280C,
 		.name		= "PowerBook Duo 280c",
@@ -742,7 +796,8 @@ static struct mac_model mac_data_table[] = {
 		.via_type	= MAC_VIA_IIci,
 		.scsi_type	= MAC_SCSI_OLD,
 		.scc_type	= MAC_SCC_QUADRA,
-		.nubus_type	= MAC_NUBUS
+		.nubus_type	= MAC_NUBUS,
+		.floppy_type    = MAC_FLOPPY_SWIM_ADDR2
 	},
 
 	/*
-- 
1.6.1.3


^ permalink raw reply related	[flat|nested] 9+ messages in thread

* [PATCH 3/6] m68k: mac - Add SWIM floppy support
  2009-03-01  9:21   ` [PATCH 2/6] m68k: mac - Add a new entry in mac_model to identify the floppy controller type Geert Uytterhoeven
@ 2009-03-01  9:21     ` Geert Uytterhoeven
  2009-03-01  9:21       ` [PATCH 4/6] MAINTAINERS: Replace dead link to m68k CVS repository by link to new git repository Geert Uytterhoeven
  2009-03-25 14:55       ` [PATCH 3/6] m68k: mac - Add SWIM floppy support Geert Uytterhoeven
  0 siblings, 2 replies; 9+ messages in thread
From: Geert Uytterhoeven @ 2009-03-01  9:21 UTC (permalink / raw)
  To: linux-m68k
  Cc: linux-kernel, Laurent Vivier, Laurent Vivier, Geert Uytterhoeven,
	Jens Axboe

From: Laurent Vivier <laurent@lvivier.info>

It allows to read data from a floppy, but not to write to, and to eject the
floppy (useful on our Mac without eject button).

Signed-off-by: Laurent Vivier <Laurent@lvivier.info>
Signed-off-by: Geert Uytterhoeven <geert@linux-m68k.org>
Cc: Jens Axboe <axboe@kernel.dk>
---
 arch/m68k/mac/config.c   |   44 ++
 arch/m68k/mac/via.c      |    9 +
 drivers/block/Kconfig    |    7 +
 drivers/block/Makefile   |    3 +
 drivers/block/swim.c     |  995 ++++++++++++++++++++++++++++++++++++++++++++++
 drivers/block/swim_asm.S |  247 ++++++++++++
 6 files changed, 1305 insertions(+), 0 deletions(-)
 create mode 100644 drivers/block/swim.c
 create mode 100644 drivers/block/swim_asm.S

diff --git a/arch/m68k/mac/config.c b/arch/m68k/mac/config.c
index 3a1c0b2..be01798 100644
--- a/arch/m68k/mac/config.c
+++ b/arch/m68k/mac/config.c
@@ -22,6 +22,7 @@
 /* keyb */
 #include <linux/init.h>
 #include <linux/vt_kern.h>
+#include <linux/platform_device.h>
 
 #define BOOTINFO_COMPAT_1_0
 #include <asm/setup.h>
@@ -43,6 +44,10 @@
 #include <asm/mac_oss.h>
 #include <asm/mac_psc.h>
 
+/* platform device info */
+
+#define SWIM_IO_SIZE 0x2000	/* SWIM IO resource size */
+
 /* Mac bootinfo struct */
 
 struct mac_booter_data mac_bi_data;
@@ -870,3 +875,42 @@ static void mac_get_model(char *str)
 	strcpy(str, "Macintosh ");
 	strcat(str, macintosh_config->name);
 }
+
+static struct resource swim_resources[1];
+
+static struct platform_device swim_device = {
+	.name		= "swim",
+	.id		= -1,
+	.num_resources	= ARRAY_SIZE(swim_resources),
+	.resource	= swim_resources,
+};
+
+static struct platform_device *mac_platform_devices[] __initdata = {
+	&swim_device
+};
+
+int __init mac_platform_init(void)
+{
+	u8 *swim_base;
+
+	switch (macintosh_config->floppy_type) {
+	case MAC_FLOPPY_SWIM_ADDR1:
+		swim_base = (u8 *)(VIA1_BASE + 0x1E000);
+		break;
+	case MAC_FLOPPY_SWIM_ADDR2:
+		swim_base = (u8 *)(VIA1_BASE + 0x16000);
+		break;
+	default:
+		return 0;
+	}
+
+	swim_resources[0].name = "swim-regs";
+	swim_resources[0].start = (resource_size_t)swim_base;
+	swim_resources[0].end = (resource_size_t)(swim_base + SWIM_IO_SIZE);
+	swim_resources[0].flags = IORESOURCE_MEM;
+
+	return platform_add_devices(mac_platform_devices,
+				    ARRAY_SIZE(mac_platform_devices));
+}
+
+arch_initcall(mac_platform_init);
diff --git a/arch/m68k/mac/via.c b/arch/m68k/mac/via.c
index 7d97ba5..11bce3c 100644
--- a/arch/m68k/mac/via.c
+++ b/arch/m68k/mac/via.c
@@ -645,3 +645,12 @@ int via_irq_pending(int irq)
 	}
 	return 0;
 }
+
+void via1_set_head(int head)
+{
+	if (head == 0)
+		via1[vBufA] &= ~VIA1A_vHeadSel;
+	else
+		via1[vBufA] |= VIA1A_vHeadSel;
+}
+EXPORT_SYMBOL(via1_set_head);
diff --git a/drivers/block/Kconfig b/drivers/block/Kconfig
index 0344a8a..e7b8aa0 100644
--- a/drivers/block/Kconfig
+++ b/drivers/block/Kconfig
@@ -45,6 +45,13 @@ config MAC_FLOPPY
 	  If you have a SWIM-3 (Super Woz Integrated Machine 3; from Apple)
 	  floppy controller, say Y here. Most commonly found in PowerMacs.
 
+config BLK_DEV_SWIM
+	tristate "Support for SWIM Macintosh floppy"
+	depends on M68K && MAC
+	help
+	  You should select this option if you want floppy support
+	  and you don't have a II, IIfx, Q900, Q950 or AV series.
+
 config AMIGA_Z2RAM
 	tristate "Amiga Zorro II ramdisk support"
 	depends on ZORRO
diff --git a/drivers/block/Makefile b/drivers/block/Makefile
index 204332b..b32b7f9 100644
--- a/drivers/block/Makefile
+++ b/drivers/block/Makefile
@@ -6,6 +6,7 @@
 # 
 
 obj-$(CONFIG_MAC_FLOPPY)	+= swim3.o
+obj-$(CONFIG_BLK_DEV_SWIM)	+= swim_mod.o
 obj-$(CONFIG_BLK_DEV_FD)	+= floppy.o
 obj-$(CONFIG_AMIGA_FLOPPY)	+= amiflop.o
 obj-$(CONFIG_PS3_DISK)		+= ps3disk.o
@@ -32,3 +33,5 @@ obj-$(CONFIG_BLK_DEV_UB)	+= ub.o
 obj-$(CONFIG_BLK_DEV_HD)	+= hd.o
 
 obj-$(CONFIG_XEN_BLKDEV_FRONTEND)	+= xen-blkfront.o
+
+swim_mod-objs	:= swim.o swim_asm.o
diff --git a/drivers/block/swim.c b/drivers/block/swim.c
new file mode 100644
index 0000000..d22cc38
--- /dev/null
+++ b/drivers/block/swim.c
@@ -0,0 +1,995 @@
+/*
+ * Driver for SWIM (Sander Woz Integrated Machine) floppy controller
+ *
+ * Copyright (C) 2004,2008 Laurent Vivier <Laurent@lvivier.info>
+ *
+ * based on Alastair Bridgewater SWIM analysis, 2001
+ * based on SWIM3 driver (c) Paul Mackerras, 1996
+ * based on netBSD IWM driver (c) 1997, 1998 Hauke Fath.
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * as published by the Free Software Foundation; either version
+ * 2 of the License, or (at your option) any later version.
+ *
+ * 2004-08-21 (lv) - Initial implementation
+ * 2008-10-30 (lv) - Port to 2.6
+ */
+
+#include <linux/module.h>
+#include <linux/fd.h>
+#include <linux/blkdev.h>
+#include <linux/hdreg.h>
+#include <linux/kernel.h>
+#include <linux/delay.h>
+#include <linux/platform_device.h>
+
+#include <asm/macintosh.h>
+#include <asm/mac_via.h>
+
+#define CARDNAME "swim"
+
+struct sector_header {
+	unsigned char side;
+	unsigned char track;
+	unsigned char sector;
+	unsigned char size;
+	unsigned char crc0;
+	unsigned char crc1;
+} __attribute__((packed));
+
+#define DRIVER_VERSION "Version 0.2 (2008-10-30)"
+
+#define REG(x)	unsigned char x, x ## _pad[0x200 - 1];
+
+struct swim {
+	REG(write_data)
+	REG(write_mark)
+	REG(write_CRC)
+	REG(write_parameter)
+	REG(write_phase)
+	REG(write_setup)
+	REG(write_mode0)
+	REG(write_mode1)
+
+	REG(read_data)
+	REG(read_mark)
+	REG(read_error)
+	REG(read_parameter)
+	REG(read_phase)
+	REG(read_setup)
+	REG(read_status)
+	REG(read_handshake)
+} __attribute__((packed));
+
+#define swim_write(base, reg, v) 	out_8(&(base)->write_##reg, (v))
+#define swim_read(base, reg)		in_8(&(base)->read_##reg)
+
+/* IWM registers */
+
+struct iwm {
+	REG(ph0L)
+	REG(ph0H)
+	REG(ph1L)
+	REG(ph1H)
+	REG(ph2L)
+	REG(ph2H)
+	REG(ph3L)
+	REG(ph3H)
+	REG(mtrOff)
+	REG(mtrOn)
+	REG(intDrive)
+	REG(extDrive)
+	REG(q6L)
+	REG(q6H)
+	REG(q7L)
+	REG(q7H)
+} __attribute__((packed));
+
+#define iwm_write(base, reg, v) 	out_8(&(base)->reg, (v))
+#define iwm_read(base, reg)		in_8(&(base)->reg)
+
+/* bits in phase register */
+
+#define SEEK_POSITIVE	0x070
+#define SEEK_NEGATIVE	0x074
+#define STEP		0x071
+#define MOTOR_ON	0x072
+#define MOTOR_OFF	0x076
+#define INDEX		0x073
+#define EJECT		0x077
+#define SETMFM		0x171
+#define SETGCR		0x175
+
+#define RELAX		0x033
+#define LSTRB		0x008
+
+#define CA_MASK		0x077
+
+/* Select values for swim_select and swim_readbit */
+
+#define READ_DATA_0	0x074
+#define TWOMEG_DRIVE	0x075
+#define SINGLE_SIDED	0x076
+#define DRIVE_PRESENT	0x077
+#define DISK_IN		0x170
+#define WRITE_PROT	0x171
+#define TRACK_ZERO	0x172
+#define TACHO		0x173
+#define READ_DATA_1	0x174
+#define MFM_MODE	0x175
+#define SEEK_COMPLETE	0x176
+#define ONEMEG_MEDIA	0x177
+
+/* Bits in handshake register */
+
+#define MARK_BYTE	0x01
+#define CRC_ZERO	0x02
+#define RDDATA		0x04
+#define SENSE		0x08
+#define MOTEN		0x10
+#define ERROR		0x20
+#define DAT2BYTE	0x40
+#define DAT1BYTE	0x80
+
+/* bits in setup register */
+
+#define S_INV_WDATA	0x01
+#define S_3_5_SELECT	0x02
+#define S_GCR		0x04
+#define S_FCLK_DIV2	0x08
+#define S_ERROR_CORR	0x10
+#define S_IBM_DRIVE	0x20
+#define S_GCR_WRITE	0x40
+#define S_TIMEOUT	0x80
+
+/* bits in mode register */
+
+#define CLFIFO		0x01
+#define ENBL1		0x02
+#define ENBL2		0x04
+#define ACTION		0x08
+#define WRITE_MODE	0x10
+#define HEDSEL		0x20
+#define MOTON		0x80
+
+/*----------------------------------------------------------------------------*/
+
+enum drive_location {
+	INTERNAL_DRIVE = 0x02,
+	EXTERNAL_DRIVE = 0x04,
+};
+
+enum media_type {
+	DD_MEDIA,
+	HD_MEDIA,
+};
+
+struct floppy_state {
+
+	/* physical properties */
+
+	enum drive_location location;	/* internal or external drive */
+	int		 head_number;	/* single- or double-sided drive */
+
+	/* media */
+
+	int		 disk_in;
+	int		 ejected;
+	enum media_type	 type;
+	int		 write_protected;
+
+	int		 total_secs;
+	int		 secpercyl;
+	int		 secpertrack;
+
+	/* in-use information */
+
+	int		track;
+	int		ref_count;
+
+	struct gendisk *disk;
+
+	/* parent controller */
+
+	struct swim_priv *swd;
+};
+
+enum motor_action {
+	OFF,
+	ON,
+};
+
+enum head {
+	LOWER_HEAD = 0,
+	UPPER_HEAD = 1,
+};
+
+#define FD_MAX_UNIT	2
+
+struct swim_priv {
+	struct swim __iomem *base;
+	spinlock_t lock;
+	struct request_queue *queue;
+	int floppy_count;
+	struct floppy_state unit[FD_MAX_UNIT];
+};
+
+extern int swim_read_sector_header(struct swim __iomem *base,
+				   struct sector_header *header);
+extern int swim_read_sector_data(struct swim __iomem *base,
+				 unsigned char *data);
+
+static inline void set_swim_mode(struct swim __iomem *base, int enable)
+{
+	struct iwm __iomem *iwm_base;
+	unsigned long flags;
+
+	if (!enable) {
+		swim_write(base, mode0, 0xf8);
+		return;
+	}
+
+	iwm_base = (struct iwm __iomem *)base;
+	local_irq_save(flags);
+
+	iwm_read(iwm_base, q7L);
+	iwm_read(iwm_base, mtrOff);
+	iwm_read(iwm_base, q6H);
+
+	iwm_write(iwm_base, q7H, 0x57);
+	iwm_write(iwm_base, q7H, 0x17);
+	iwm_write(iwm_base, q7H, 0x57);
+	iwm_write(iwm_base, q7H, 0x57);
+
+	local_irq_restore(flags);
+}
+
+static inline int get_swim_mode(struct swim __iomem *base)
+{
+	unsigned long flags;
+
+	local_irq_save(flags);
+
+	swim_write(base, phase, 0xf5);
+	if (swim_read(base, phase) != 0xf5)
+		goto is_iwm;
+	swim_write(base, phase, 0xf6);
+	if (swim_read(base, phase) != 0xf6)
+		goto is_iwm;
+	swim_write(base, phase, 0xf7);
+	if (swim_read(base, phase) != 0xf7)
+		goto is_iwm;
+	local_irq_restore(flags);
+	return 1;
+is_iwm:
+	local_irq_restore(flags);
+	return 0;
+}
+
+static inline void swim_select(struct swim __iomem *base, int sel)
+{
+	swim_write(base, phase, RELAX);
+
+	via1_set_head(sel & 0x100);
+
+	swim_write(base, phase, sel & CA_MASK);
+}
+
+static inline void swim_action(struct swim __iomem *base, int action)
+{
+	unsigned long flags;
+
+	local_irq_save(flags);
+
+	swim_select(base, action);
+	udelay(1);
+	swim_write(base, phase, (LSTRB<<4) | LSTRB);
+	udelay(1);
+	swim_write(base, phase, (LSTRB<<4) | ((~LSTRB) & 0x0F));
+	udelay(1);
+
+	local_irq_restore(flags);
+}
+
+static inline int swim_readbit(struct swim __iomem *base, int bit)
+{
+	int stat;
+
+	swim_select(base, bit);
+
+	udelay(10);
+
+	stat = swim_read(base, handshake);
+
+	return (stat & SENSE) == 0;
+}
+
+static inline void swim_drive(struct swim __iomem *base,
+			      enum drive_location location)
+{
+	if (location == INTERNAL_DRIVE) {
+		swim_write(base, mode0, EXTERNAL_DRIVE); /* clear drive 1 bit */
+		swim_write(base, mode1, INTERNAL_DRIVE); /* set drive 0 bit */
+	} else if (location == EXTERNAL_DRIVE) {
+		swim_write(base, mode0, INTERNAL_DRIVE); /* clear drive 0 bit */
+		swim_write(base, mode1, EXTERNAL_DRIVE); /* set drive 1 bit */
+	}
+}
+
+static inline void swim_motor(struct swim __iomem *base,
+			      enum motor_action action)
+{
+	if (action == ON) {
+		int i;
+
+		swim_action(base, MOTOR_ON);
+
+		for (i = 0; i < 2*HZ; i++) {
+			swim_select(base, RELAX);
+			if (swim_readbit(base, MOTOR_ON))
+				break;
+			current->state = TASK_INTERRUPTIBLE;
+			schedule_timeout(1);
+		}
+	} else if (action == OFF) {
+		swim_action(base, MOTOR_OFF);
+		swim_select(base, RELAX);
+	}
+}
+
+static inline void swim_eject(struct swim __iomem *base)
+{
+	int i;
+
+	swim_action(base, EJECT);
+
+	for (i = 0; i < 2*HZ; i++) {
+		swim_select(base, RELAX);
+		if (!swim_readbit(base, DISK_IN))
+			break;
+		current->state = TASK_INTERRUPTIBLE;
+		schedule_timeout(1);
+	}
+	swim_select(base, RELAX);
+}
+
+static inline void swim_head(struct swim __iomem *base, enum head head)
+{
+	/* wait drive is ready */
+
+	if (head == UPPER_HEAD)
+		swim_select(base, READ_DATA_1);
+	else if (head == LOWER_HEAD)
+		swim_select(base, READ_DATA_0);
+}
+
+static inline int swim_step(struct swim __iomem *base)
+{
+	int wait;
+
+	swim_action(base, STEP);
+
+	for (wait = 0; wait < HZ; wait++) {
+
+		current->state = TASK_INTERRUPTIBLE;
+		schedule_timeout(1);
+
+		swim_select(base, RELAX);
+		if (!swim_readbit(base, STEP))
+			return 0;
+	}
+	return -1;
+}
+
+static inline int swim_track00(struct swim __iomem *base)
+{
+	int try;
+
+	swim_action(base, SEEK_NEGATIVE);
+
+	for (try = 0; try < 100; try++) {
+
+		swim_select(base, RELAX);
+		if (swim_readbit(base, TRACK_ZERO))
+			break;
+
+		if (swim_step(base))
+			return -1;
+	}
+
+	if (swim_readbit(base, TRACK_ZERO))
+		return 0;
+
+	return -1;
+}
+
+static inline int swim_seek(struct swim __iomem *base, int step)
+{
+	if (step == 0)
+		return 0;
+
+	if (step < 0) {
+		swim_action(base, SEEK_NEGATIVE);
+		step = -step;
+	} else
+		swim_action(base, SEEK_POSITIVE);
+
+	for ( ; step > 0; step--) {
+		if (swim_step(base))
+			return -1;
+	}
+
+	return 0;
+}
+
+static inline int swim_track(struct floppy_state *fs,  int track)
+{
+	struct swim __iomem *base = fs->swd->base;
+	int ret;
+
+	ret = swim_seek(base, track - fs->track);
+
+	if (ret == 0)
+		fs->track = track;
+	else {
+		swim_track00(base);
+		fs->track = 0;
+	}
+
+	return ret;
+}
+
+static int floppy_eject(struct floppy_state *fs)
+{
+	struct swim __iomem *base = fs->swd->base;
+
+	swim_drive(base, fs->location);
+	swim_motor(base, OFF);
+	swim_eject(base);
+
+	fs->disk_in = 0;
+	fs->ejected = 1;
+
+	return 0;
+}
+
+static inline int swim_read_sector(struct floppy_state *fs,
+				   int side, int track,
+				   int sector, unsigned char *buffer)
+{
+	struct swim __iomem *base = fs->swd->base;
+	unsigned long flags;
+	struct sector_header header;
+	int ret = -1;
+	short i;
+
+	swim_track(fs, track);
+
+	swim_write(base, mode1, MOTON);
+	swim_head(base, side);
+	swim_write(base, mode0, side);
+
+	local_irq_save(flags);
+	for (i = 0; i < 36; i++) {
+		ret = swim_read_sector_header(base, &header);
+		if (!ret && (header.sector == sector)) {
+			/* found */
+
+			ret = swim_read_sector_data(base, buffer);
+			break;
+		}
+	}
+	local_irq_restore(flags);
+
+	swim_write(base, mode0, MOTON);
+
+	if ((header.side != side)  || (header.track != track) ||
+	     (header.sector != sector))
+		return 0;
+
+	return ret;
+}
+
+static int floppy_read_sectors(struct floppy_state *fs,
+			       int req_sector, int sectors_nb,
+			       unsigned char *buffer)
+{
+	struct swim __iomem *base = fs->swd->base;
+	int ret;
+	int side, track, sector;
+	int i, try;
+
+
+	swim_drive(base, fs->location);
+	for (i = req_sector; i < req_sector + sectors_nb; i++) {
+		int x;
+		track = i / fs->secpercyl;
+		x = i % fs->secpercyl;
+		side = x / fs->secpertrack;
+		sector = x % fs->secpertrack + 1;
+
+		try = 5;
+		do {
+			ret = swim_read_sector(fs, side, track, sector,
+						buffer);
+			if (try-- == 0)
+				return -1;
+		} while (ret != 512);
+
+		buffer += ret;
+	}
+
+	return 0;
+}
+
+static void redo_fd_request(struct request_queue *q)
+{
+	struct request *req;
+	struct floppy_state *fs;
+
+	while ((req = elv_next_request(q))) {
+
+		fs = req->rq_disk->private_data;
+		if (req->sector < 0 || req->sector >= fs->total_secs) {
+			end_request(req, 0);
+			continue;
+		}
+		if (req->current_nr_sectors == 0) {
+			end_request(req, 1);
+			continue;
+		}
+		if (!fs->disk_in) {
+			end_request(req, 0);
+			continue;
+		}
+		if (rq_data_dir(req) == WRITE) {
+			if (fs->write_protected) {
+				end_request(req, 0);
+				continue;
+			}
+		}
+		switch (rq_data_dir(req)) {
+		case WRITE:
+			/* NOT IMPLEMENTED */
+			end_request(req, 0);
+			break;
+		case READ:
+			if (floppy_read_sectors(fs, req->sector,
+						req->current_nr_sectors,
+						req->buffer)) {
+				end_request(req, 0);
+				continue;
+			}
+			req->nr_sectors -= req->current_nr_sectors;
+			req->sector += req->current_nr_sectors;
+			req->buffer += req->current_nr_sectors * 512;
+			end_request(req, 1);
+			break;
+		}
+	}
+}
+
+static void do_fd_request(struct request_queue *q)
+{
+	redo_fd_request(q);
+}
+
+static struct floppy_struct floppy_type[4] = {
+	{    0,  0, 0,  0, 0, 0x00, 0x00, 0x00, 0x00, NULL }, /* no testing   */
+	{  720,  9, 1, 80, 0, 0x2A, 0x02, 0xDF, 0x50, NULL }, /* 360KB SS 3.5"*/
+	{ 1440,  9, 2, 80, 0, 0x2A, 0x02, 0xDF, 0x50, NULL }, /* 720KB 3.5"   */
+	{ 2880, 18, 2, 80, 0, 0x1B, 0x00, 0xCF, 0x6C, NULL }, /* 1.44MB 3.5"  */
+};
+
+static int get_floppy_geometry(struct floppy_state *fs, int type,
+			       struct floppy_struct **g)
+{
+	if (type >= ARRAY_SIZE(floppy_type))
+		return -EINVAL;
+
+	if (type)
+		*g = &floppy_type[type];
+	else if (fs->type == HD_MEDIA) /* High-Density media */
+		*g = &floppy_type[3];
+	else if (fs->head_number == 2) /* double-sided */
+		*g = &floppy_type[2];
+	else
+		*g = &floppy_type[1];
+
+	return 0;
+}
+
+static void setup_medium(struct floppy_state *fs)
+{
+	struct swim __iomem *base = fs->swd->base;
+
+	if (swim_readbit(base, DISK_IN)) {
+		struct floppy_struct *g;
+		fs->disk_in = 1;
+		fs->write_protected = swim_readbit(base, WRITE_PROT);
+		fs->type = swim_readbit(base, ONEMEG_MEDIA);
+
+		if (swim_track00(base))
+			printk(KERN_ERR
+				"SWIM: cannot move floppy head to track 0\n");
+
+		swim_track00(base);
+
+		get_floppy_geometry(fs, 0, &g);
+		fs->total_secs = g->size;
+		fs->secpercyl = g->head * g->sect;
+		fs->secpertrack = g->sect;
+		fs->track = 0;
+	} else {
+		fs->disk_in = 0;
+	}
+}
+
+static int floppy_open(struct block_device *bdev, fmode_t mode)
+{
+	struct floppy_state *fs = bdev->bd_disk->private_data;
+	struct swim __iomem *base = fs->swd->base;
+	int err;
+
+	if (fs->ref_count == -1 || (fs->ref_count && mode & FMODE_EXCL))
+		return -EBUSY;
+
+	if (mode & FMODE_EXCL)
+		fs->ref_count = -1;
+	else
+		fs->ref_count++;
+
+	swim_write(base, setup, S_IBM_DRIVE  | S_FCLK_DIV2);
+	udelay(10);
+	swim_drive(base, INTERNAL_DRIVE);
+	swim_motor(base, ON);
+	swim_action(base, SETMFM);
+	if (fs->ejected)
+		setup_medium(fs);
+	if (!fs->disk_in) {
+		err = -ENXIO;
+		goto out;
+	}
+
+	if (mode & FMODE_NDELAY)
+		return 0;
+
+	if (mode & (FMODE_READ|FMODE_WRITE)) {
+		check_disk_change(bdev);
+		if ((mode & FMODE_WRITE) && fs->write_protected) {
+			err = -EROFS;
+			goto out;
+		}
+	}
+	return 0;
+out:
+	if (fs->ref_count < 0)
+		fs->ref_count = 0;
+	else if (fs->ref_count > 0)
+		--fs->ref_count;
+
+	if (fs->ref_count == 0)
+		swim_motor(base, OFF);
+	return err;
+}
+
+static int floppy_release(struct gendisk *disk, fmode_t mode)
+{
+	struct floppy_state *fs = disk->private_data;
+	struct swim __iomem *base = fs->swd->base;
+
+	if (fs->ref_count < 0)
+		fs->ref_count = 0;
+	else if (fs->ref_count > 0)
+		--fs->ref_count;
+
+	if (fs->ref_count == 0)
+		swim_motor(base, OFF);
+
+	return 0;
+}
+
+static int floppy_ioctl(struct block_device *bdev, fmode_t mode,
+			unsigned int cmd, unsigned long param)
+{
+	struct floppy_state *fs = bdev->bd_disk->private_data;
+	int err;
+
+	if ((cmd & 0x80) && !capable(CAP_SYS_ADMIN))
+			return -EPERM;
+
+	switch (cmd) {
+	case FDEJECT:
+		if (fs->ref_count != 1)
+			return -EBUSY;
+		err = floppy_eject(fs);
+		return err;
+
+	case FDGETPRM:
+		if (copy_to_user((void __user *) param, (void *) &floppy_type,
+				 sizeof(struct floppy_struct)))
+			return -EFAULT;
+		break;
+
+	default:
+		printk(KERN_DEBUG "SWIM floppy_ioctl: unknown cmd %d\n",
+		       cmd);
+		return -ENOSYS;
+	}
+	return 0;
+}
+
+static int floppy_getgeo(struct block_device *bdev, struct hd_geometry *geo)
+{
+	struct floppy_state *fs = bdev->bd_disk->private_data;
+	struct floppy_struct *g;
+	int ret;
+
+	ret = get_floppy_geometry(fs, 0, &g);
+	if (ret)
+		return ret;
+
+	geo->heads = g->head;
+	geo->sectors = g->sect;
+	geo->cylinders = g->track;
+
+	return 0;
+}
+
+static int floppy_check_change(struct gendisk *disk)
+{
+	struct floppy_state *fs = disk->private_data;
+
+	return fs->ejected;
+}
+
+static int floppy_revalidate(struct gendisk *disk)
+{
+	struct floppy_state *fs = disk->private_data;
+	struct swim __iomem *base = fs->swd->base;
+
+	swim_drive(base, fs->location);
+
+	if (fs->ejected)
+		setup_medium(fs);
+
+	if (!fs->disk_in)
+		swim_motor(base, OFF);
+	else
+		fs->ejected = 0;
+
+	return !fs->disk_in;
+}
+
+static struct block_device_operations floppy_fops = {
+	.owner		 = THIS_MODULE,
+	.open		 = floppy_open,
+	.release	 = floppy_release,
+	.locked_ioctl	 = floppy_ioctl,
+	.getgeo		 = floppy_getgeo,
+	.media_changed	 = floppy_check_change,
+	.revalidate_disk = floppy_revalidate,
+};
+
+static struct kobject *floppy_find(dev_t dev, int *part, void *data)
+{
+	struct swim_priv *swd = data;
+	int drive = (*part & 3);
+
+	if (drive > swd->floppy_count)
+		return NULL;
+
+	*part = 0;
+	return get_disk(swd->unit[drive].disk);
+}
+
+static int __devinit swim_add_floppy(struct swim_priv *swd,
+				     enum drive_location location)
+{
+	struct floppy_state *fs = &swd->unit[swd->floppy_count];
+	struct swim __iomem *base = swd->base;
+
+	fs->location = location;
+
+	swim_drive(base, location);
+
+	swim_motor(base, OFF);
+
+	if (swim_readbit(base, SINGLE_SIDED))
+		fs->head_number = 1;
+	else
+		fs->head_number = 2;
+	fs->ref_count = 0;
+	fs->ejected = 1;
+
+	swd->floppy_count++;
+
+	return 0;
+}
+
+static int __devinit swim_floppy_init(struct swim_priv *swd)
+{
+	int err;
+	int drive;
+	struct swim __iomem *base = swd->base;
+
+	/* scan floppy drives */
+
+	swim_drive(base, INTERNAL_DRIVE);
+	if (swim_readbit(base, DRIVE_PRESENT))
+		swim_add_floppy(swd, INTERNAL_DRIVE);
+	swim_drive(base, EXTERNAL_DRIVE);
+	if (swim_readbit(base, DRIVE_PRESENT))
+		swim_add_floppy(swd, EXTERNAL_DRIVE);
+
+	/* register floppy drives */
+
+	err = register_blkdev(FLOPPY_MAJOR, "fd");
+	if (err) {
+		printk(KERN_ERR "Unable to get major %d for SWIM floppy\n",
+		       FLOPPY_MAJOR);
+		return -EBUSY;
+	}
+
+	for (drive = 0; drive < swd->floppy_count; drive++) {
+		swd->unit[drive].disk = alloc_disk(1);
+		if (swd->unit[drive].disk == NULL) {
+			err = -ENOMEM;
+			goto exit_put_disks;
+		}
+		swd->unit[drive].swd = swd;
+	}
+
+	swd->queue = blk_init_queue(do_fd_request, &swd->lock);
+	if (!swd->queue) {
+		err = -ENOMEM;
+		goto exit_put_disks;
+	}
+
+	for (drive = 0; drive < swd->floppy_count; drive++) {
+		swd->unit[drive].disk->flags = GENHD_FL_REMOVABLE;
+		swd->unit[drive].disk->major = FLOPPY_MAJOR;
+		swd->unit[drive].disk->first_minor = drive;
+		sprintf(swd->unit[drive].disk->disk_name, "fd%d", drive);
+		swd->unit[drive].disk->fops = &floppy_fops;
+		swd->unit[drive].disk->private_data = &swd->unit[drive];
+		swd->unit[drive].disk->queue = swd->queue;
+		set_capacity(swd->unit[drive].disk, 2880);
+		add_disk(swd->unit[drive].disk);
+	}
+
+	blk_register_region(MKDEV(FLOPPY_MAJOR, 0), 256, THIS_MODULE,
+			    floppy_find, NULL, swd);
+
+	return 0;
+
+exit_put_disks:
+	unregister_blkdev(FLOPPY_MAJOR, "fd");
+	while (drive--)
+		put_disk(swd->unit[drive].disk);
+	return err;
+}
+
+static int __devinit swim_probe(struct platform_device *dev)
+{
+	struct resource *res;
+	struct swim __iomem *swim_base;
+	struct swim_priv *swd;
+	int ret;
+
+	res = platform_get_resource_byname(dev, IORESOURCE_MEM, "swim-regs");
+	if (!res) {
+		ret = -ENODEV;
+		goto out;
+	}
+
+	if (!request_mem_region(res->start, resource_size(res), CARDNAME)) {
+		ret = -EBUSY;
+		goto out;
+	}
+
+	swim_base = ioremap(res->start, resource_size(res));
+	if (!swim_base) {
+		return -ENOMEM;
+		goto out_release_io;
+	}
+
+	/* probe device */
+
+	set_swim_mode(swim_base, 1);
+	if (!get_swim_mode(swim_base)) {
+		printk(KERN_INFO "SWIM device not found !\n");
+		ret = -ENODEV;
+		goto out_iounmap;
+	}
+
+	/* set platform driver data */
+
+	swd = kzalloc(sizeof(struct swim_priv), GFP_KERNEL);
+	if (!swd) {
+		ret = -ENOMEM;
+		goto out_iounmap;
+	}
+	platform_set_drvdata(dev, swd);
+
+	swd->base = swim_base;
+
+	ret = swim_floppy_init(swd);
+	if (ret)
+		goto out_kfree;
+
+	return 0;
+
+out_kfree:
+	platform_set_drvdata(dev, NULL);
+	kfree(swd);
+out_iounmap:
+	iounmap(swim_base);
+out_release_io:
+	release_mem_region(res->start, resource_size(res));
+out:
+	return ret;
+}
+
+static int __devexit swim_remove(struct platform_device *dev)
+{
+	struct swim_priv *swd = platform_get_drvdata(dev);
+	int drive;
+	struct resource *res;
+
+	blk_unregister_region(MKDEV(FLOPPY_MAJOR, 0), 256);
+
+	for (drive = 0; drive < swd->floppy_count; drive++) {
+		del_gendisk(swd->unit[drive].disk);
+		put_disk(swd->unit[drive].disk);
+	}
+
+	unregister_blkdev(FLOPPY_MAJOR, "fd");
+
+	blk_cleanup_queue(swd->queue);
+
+	/* eject floppies */
+
+	for (drive = 0; drive < swd->floppy_count; drive++)
+		floppy_eject(&swd->unit[drive]);
+
+	iounmap(swd->base);
+
+	res = platform_get_resource_byname(dev, IORESOURCE_MEM, "swim-regs");
+	if (res)
+		release_mem_region(res->start, resource_size(res));
+
+	platform_set_drvdata(dev, NULL);
+	kfree(swd);
+
+	return 0;
+}
+
+static struct platform_driver swim_driver = {
+	.probe  = swim_probe,
+	.remove = __devexit_p(swim_remove),
+	.driver   = {
+		.name	= CARDNAME,
+		.owner	= THIS_MODULE,
+	},
+};
+
+static int __init swim_init(void)
+{
+	printk(KERN_INFO "SWIM floppy driver %s\n", DRIVER_VERSION);
+
+	return platform_driver_register(&swim_driver);
+}
+module_init(swim_init);
+
+static void __exit swim_exit(void)
+{
+	platform_driver_unregister(&swim_driver);
+}
+module_exit(swim_exit);
+
+MODULE_DESCRIPTION("Driver for SWIM floppy controller");
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("Laurent Vivier <laurent@lvivier.info>");
+MODULE_ALIAS_BLOCKDEV_MAJOR(FLOPPY_MAJOR);
diff --git a/drivers/block/swim_asm.S b/drivers/block/swim_asm.S
new file mode 100644
index 0000000..c966820
--- /dev/null
+++ b/drivers/block/swim_asm.S
@@ -0,0 +1,247 @@
+/*
+ * low-level functions for the SWIM floppy controller
+ *
+ * needs assembly language because is very timing dependent
+ * this controller exists only on macintosh 680x0 based
+ *
+ * Copyright (C) 2004,2008 Laurent Vivier <Laurent@lvivier.info>
+ *
+ * based on Alastair Bridgewater SWIM analysis, 2001
+ * based on netBSD IWM driver (c) 1997, 1998 Hauke Fath.
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * as published by the Free Software Foundation; either version
+ * 2 of the License, or (at your option) any later version.
+ *
+ * 2004-08-21 (lv) - Initial implementation
+ * 2008-11-05 (lv) - add get_swim_mode
+ */
+
+	.equ	write_data,	0x0000
+	.equ	write_mark,	0x0200
+	.equ	write_CRC,	0x0400
+	.equ	write_parameter,0x0600
+	.equ	write_phase,	0x0800
+	.equ	write_setup,	0x0a00
+	.equ	write_mode0,	0x0c00
+	.equ	write_mode1,	0x0e00
+	.equ	read_data,	0x1000
+	.equ	read_mark,	0x1200
+	.equ	read_error,	0x1400
+	.equ	read_parameter,	0x1600
+	.equ	read_phase,	0x1800
+	.equ	read_setup,	0x1a00
+	.equ	read_status,	0x1c00
+	.equ	read_handshake,	0x1e00
+
+	.equ	o_side, 0
+	.equ	o_track, 1
+	.equ	o_sector, 2
+	.equ	o_size, 3
+	.equ	o_crc0, 4
+	.equ	o_crc1, 5
+
+	.equ	seek_time, 30000
+	.equ	max_retry, 40
+	.equ	sector_size, 512
+
+	.global swim_read_sector_header
+swim_read_sector_header:
+	link	%a6, #0
+	moveml	%d1-%d5/%a0-%a4,%sp@-
+	movel	%a6@(0x0c), %a4
+	bsr	mfm_read_addrmark
+	moveml	%sp@+, %d1-%d5/%a0-%a4
+	unlk	%a6
+	rts
+
+sector_address_mark:
+	.byte	0xa1, 0xa1, 0xa1, 0xfe
+sector_data_mark:
+	.byte	0xa1, 0xa1, 0xa1, 0xfb
+
+mfm_read_addrmark:
+	movel	%a6@(0x08), %a3
+	lea	%a3@(read_handshake), %a2
+	lea	%a3@(read_mark), %a3
+	moveq	#-1, %d0
+	movew	#seek_time, %d2
+
+wait_header_init:
+	tstb	%a3@(read_error - read_mark)
+	moveb	#0x18, %a3@(write_mode0 - read_mark)
+	moveb	#0x01, %a3@(write_mode1 - read_mark)
+	moveb	#0x01, %a3@(write_mode0 - read_mark)
+	tstb	%a3@(read_error - read_mark)
+	moveb	#0x08, %a3@(write_mode1 - read_mark)
+
+	lea	sector_address_mark, %a0
+	moveq	#3, %d1
+
+wait_addr_mark_byte:
+
+	tstb	%a2@
+	dbmi	%d2, wait_addr_mark_byte
+	bpl	header_exit
+
+	moveb	%a3@, %d3
+	cmpb	%a0@+, %d3
+	dbne	%d1, wait_addr_mark_byte
+	bne	wait_header_init
+
+	moveq	#max_retry, %d2
+
+amark0:	tstb	%a2@
+	dbmi	%d2, amark0
+	bpl	signal_nonyb
+
+	moveb	%a3@, %a4@(o_track)
+
+	moveq	#max_retry, %d2
+
+amark1:	tstb	%a2@
+	dbmi	%d2, amark1
+	bpl	signal_nonyb
+
+	moveb	%a3@, %a4@(o_side)
+
+	moveq	#max_retry, %d2
+
+amark2:	tstb	%a2@
+	dbmi	%d2, amark2
+	bpl	signal_nonyb
+
+	moveb	%a3@, %a4@(o_sector)
+
+	moveq	#max_retry, %d2
+
+amark3:	tstb	%a2@
+	dbmi	%d2, amark3
+	bpl	signal_nonyb
+
+	moveb	%a3@, %a4@(o_size)
+
+	moveq	#max_retry, %d2
+
+crc0:	tstb	%a2@
+	dbmi	%d2, crc0
+	bpl	signal_nonyb
+
+	moveb	%a3@, %a4@(o_crc0)
+
+	moveq	#max_retry, %d2
+
+crc1:	tstb	%a2@
+	dbmi	%d2, crc1
+	bpl	signal_nonyb
+
+	moveb	%a3@, %a4@(o_crc1)
+
+	tstb	%a3@(read_error - read_mark)
+
+header_exit:
+	moveq	#0, %d0
+	moveb	#0x18, %a3@(write_mode0 - read_mark)
+	rts
+signal_nonyb:
+	moveq	#-1, %d0
+	moveb	#0x18, %a3@(write_mode0 - read_mark)
+	rts
+
+	.global swim_read_sector_data
+swim_read_sector_data:
+	link	%a6, #0
+	moveml	%d1-%d5/%a0-%a5,%sp@-
+	movel	%a6@(0x0c), %a4
+	bsr	mfm_read_data
+	moveml	%sp@+, %d1-%d5/%a0-%a5
+	unlk	%a6
+	rts
+
+mfm_read_data:
+	movel	%a6@(0x08), %a3
+	lea	%a3@(read_handshake), %a2
+	lea	%a3@(read_data), %a5
+	lea	%a3@(read_mark), %a3
+	movew	#seek_time, %d2
+
+wait_data_init:
+	tstb	%a3@(read_error - read_mark)
+	moveb	#0x18, %a3@(write_mode0 - read_mark)
+	moveb	#0x01, %a3@(write_mode1 - read_mark)
+	moveb	#0x01, %a3@(write_mode0 - read_mark)
+	tstb	%a3@(read_error - read_mark)
+	moveb	#0x08, %a3@(write_mode1 - read_mark)
+
+	lea	sector_data_mark, %a0
+	moveq	#3, %d1
+
+	/* wait data address mark */
+
+wait_data_mark_byte:
+
+	tstb	%a2@
+	dbmi	%d2, wait_data_mark_byte
+	bpl	data_exit
+
+	moveb	%a3@, %d3
+	cmpb	%a0@+, %d3
+	dbne	%d1, wait_data_mark_byte
+	bne	wait_data_init
+
+	/* read data */
+
+	tstb	%a3@(read_error - read_mark)
+
+	movel	#sector_size-1, %d4		/* sector size */
+read_new_data:
+	movew	#max_retry, %d2
+read_data_loop:
+	moveb	%a2@, %d5
+	andb	#0xc0, %d5
+	dbne	%d2, read_data_loop
+	beq	data_exit
+	moveb	%a5@, %a4@+
+	andb	#0x40, %d5
+	dbne	%d4, read_new_data
+	beq	exit_loop
+	moveb	%a5@, %a4@+
+	dbra	%d4, read_new_data
+exit_loop:
+
+	/* read CRC */
+
+	movew	#max_retry, %d2
+data_crc0:
+
+	tstb	%a2@
+	dbmi	%d2, data_crc0
+	bpl	data_exit
+
+	moveb	%a3@, %d5
+
+	moveq	#max_retry, %d2
+
+data_crc1:
+
+	tstb	%a2@
+	dbmi	%d2, data_crc1
+	bpl	data_exit
+
+	moveb	%a3@, %d5
+
+	tstb	%a3@(read_error - read_mark)
+
+	moveb	#0x18, %a3@(write_mode0 - read_mark)
+
+	/* return number of bytes read */
+
+	movel	#sector_size, %d0
+	addw	#1, %d4
+	subl	%d4, %d0
+	rts
+data_exit:
+	moveb	#0x18, %a3@(write_mode0 - read_mark)
+	moveq	#-1, %d0
+	rts
-- 
1.6.1.3


^ permalink raw reply related	[flat|nested] 9+ messages in thread

* [PATCH 4/6] MAINTAINERS: Replace dead link to m68k CVS repository by link to new git repository
  2009-03-01  9:21     ` [PATCH 3/6] m68k: mac - Add SWIM floppy support Geert Uytterhoeven
@ 2009-03-01  9:21       ` Geert Uytterhoeven
  2009-03-01  9:21         ` [PATCH 5/6] m68k: section mismatch fixes: DMAsound for Atari Geert Uytterhoeven
  2009-03-25 14:55       ` [PATCH 3/6] m68k: mac - Add SWIM floppy support Geert Uytterhoeven
  1 sibling, 1 reply; 9+ messages in thread
From: Geert Uytterhoeven @ 2009-03-01  9:21 UTC (permalink / raw)
  To: linux-m68k; +Cc: linux-kernel, Geert Uytterhoeven

CVS is dead, long live git!

Signed-off-by: Geert Uytterhoeven <geert@linux-m68k.org>
---
 MAINTAINERS |    2 +-
 1 files changed, 1 insertions(+), 1 deletions(-)

diff --git a/MAINTAINERS b/MAINTAINERS
index 59fd2d1..5e7f1db 100644
--- a/MAINTAINERS
+++ b/MAINTAINERS
@@ -2834,7 +2834,7 @@ P:	Roman Zippel
 M:	zippel@linux-m68k.org
 L:	linux-m68k@lists.linux-m68k.org
 W:	http://www.linux-m68k.org/
-W:	http://linux-m68k-cvs.ubb.ca/
+T:	git git.kernel.org/pub/scm/linux/kernel/git/geert/linux-m68k.git
 S:	Maintained
 
 M68K ON APPLE MACINTOSH
-- 
1.6.1.3


^ permalink raw reply related	[flat|nested] 9+ messages in thread

* [PATCH 5/6] m68k: section mismatch fixes: DMAsound for Atari
  2009-03-01  9:21       ` [PATCH 4/6] MAINTAINERS: Replace dead link to m68k CVS repository by link to new git repository Geert Uytterhoeven
@ 2009-03-01  9:21         ` Geert Uytterhoeven
  2009-03-01  9:21           ` [PATCH 6/6] m68k: section mismatch fixes: Atari SCSI Geert Uytterhoeven
  0 siblings, 1 reply; 9+ messages in thread
From: Geert Uytterhoeven @ 2009-03-01  9:21 UTC (permalink / raw)
  To: linux-m68k
  Cc: linux-kernel, Michael Schmitz, Michael Schmitz,
	Geert Uytterhoeven, Jaroslav Kysela

From: Michael Schmitz <schmitz@biophys.uni-duesseldorf.de>

add __initdata to driver presets struct

Signed-off-By: Michael Schmitz <schmitz@debian.org>
Signed-off-by: Geert Uytterhoeven <geert@linux-m68k.org>
Cc: Jaroslav Kysela <perex@perex.cz>
---
 sound/oss/dmasound/dmasound_atari.c |    4 ++--
 1 files changed, 2 insertions(+), 2 deletions(-)

diff --git a/sound/oss/dmasound/dmasound_atari.c b/sound/oss/dmasound/dmasound_atari.c
index 38931f2..1f47741 100644
--- a/sound/oss/dmasound/dmasound_atari.c
+++ b/sound/oss/dmasound/dmasound_atari.c
@@ -1524,7 +1524,7 @@ static SETTINGS def_soft = {
 	.speed	= 8000
 } ;
 
-static MACHINE machTT = {
+static __initdata MACHINE machTT = {
 	.name		= "Atari",
 	.name2		= "TT",
 	.owner		= THIS_MODULE,
@@ -1553,7 +1553,7 @@ static MACHINE machTT = {
 	.capabilities	=  DSP_CAP_BATCH	/* As per SNDCTL_DSP_GETCAPS */
 };
 
-static MACHINE machFalcon = {
+static __initdata MACHINE machFalcon = {
 	.name		= "Atari",
 	.name2		= "FALCON",
 	.dma_alloc	= AtaAlloc,
-- 
1.6.1.3


^ permalink raw reply related	[flat|nested] 9+ messages in thread

* [PATCH 6/6] m68k: section mismatch fixes: Atari SCSI
  2009-03-01  9:21         ` [PATCH 5/6] m68k: section mismatch fixes: DMAsound for Atari Geert Uytterhoeven
@ 2009-03-01  9:21           ` Geert Uytterhoeven
  0 siblings, 0 replies; 9+ messages in thread
From: Geert Uytterhoeven @ 2009-03-01  9:21 UTC (permalink / raw)
  To: linux-m68k
  Cc: linux-kernel, Michael Schmitz, Michael Schmitz,
	Geert Uytterhoeven, James E.J. Bottomley

From: Michael Schmitz <schmitz@biophys.uni-duesseldorf.de>

add __init annotations to probe routines

Signed-off-by: Michael Schmitz <schmitz@debian.org>
Signed-off-by: Geert Uytterhoeven <geert@linux-m68k.org>
Cc: James E.J. Bottomley <James.Bottomley@HansenPartnership.com>
---
 drivers/scsi/atari_NCR5380.c |    2 +-
 drivers/scsi/atari_scsi.c    |    2 +-
 2 files changed, 2 insertions(+), 2 deletions(-)

diff --git a/drivers/scsi/atari_NCR5380.c b/drivers/scsi/atari_NCR5380.c
index 93b61f1..0471f88 100644
--- a/drivers/scsi/atari_NCR5380.c
+++ b/drivers/scsi/atari_NCR5380.c
@@ -844,7 +844,7 @@ static char *lprint_Scsi_Cmnd(Scsi_Cmnd *cmd, char *pos, char *buffer, int lengt
  *
  */
 
-static int NCR5380_init(struct Scsi_Host *instance, int flags)
+static int __init NCR5380_init(struct Scsi_Host *instance, int flags)
 {
 	int i;
 	SETUP_HOSTDATA(instance);
diff --git a/drivers/scsi/atari_scsi.c b/drivers/scsi/atari_scsi.c
index 21fe07f..ad7a23a 100644
--- a/drivers/scsi/atari_scsi.c
+++ b/drivers/scsi/atari_scsi.c
@@ -589,7 +589,7 @@ int atari_queue_command(Scsi_Cmnd *cmd, void (*done)(Scsi_Cmnd *))
 #endif
 
 
-int atari_scsi_detect(struct scsi_host_template *host)
+int __init atari_scsi_detect(struct scsi_host_template *host)
 {
 	static int called = 0;
 	struct Scsi_Host *instance;
-- 
1.6.1.3


^ permalink raw reply related	[flat|nested] 9+ messages in thread

* Re: [PATCH 3/6] m68k: mac - Add SWIM floppy support
  2009-03-01  9:21     ` [PATCH 3/6] m68k: mac - Add SWIM floppy support Geert Uytterhoeven
  2009-03-01  9:21       ` [PATCH 4/6] MAINTAINERS: Replace dead link to m68k CVS repository by link to new git repository Geert Uytterhoeven
@ 2009-03-25 14:55       ` Geert Uytterhoeven
  2009-03-25 15:28         ` Jens Axboe
  1 sibling, 1 reply; 9+ messages in thread
From: Geert Uytterhoeven @ 2009-03-25 14:55 UTC (permalink / raw)
  To: Jens Axboe; +Cc: linux-kernel, Laurent Vivier, linux-m68k

[-- Warning: decoded text below may be mangled, UTF-8 assumed --]
[-- Attachment #1: Type: text/plain; charset=UTF-8, Size: 44412 bytes --]

Hi Jens,
Is this OK for you to go in through the m68k tree?
Thanks!
On Sun, Mar 1, 2009 at 10:21, Geert Uytterhoeven <geert@linux-m68k.org> wrote:> From: Laurent Vivier <laurent@lvivier.info>>> It allows to read data from a floppy, but not to write to, and to eject the> floppy (useful on our Mac without eject button).>> Signed-off-by: Laurent Vivier <Laurent@lvivier.info>> Signed-off-by: Geert Uytterhoeven <geert@linux-m68k.org>> Cc: Jens Axboe <axboe@kernel.dk>> ---> Â arch/m68k/mac/config.c Â  | Â  44 ++> Â arch/m68k/mac/via.c Â  Â  Â | Â  Â 9 +> Â drivers/block/Kconfig Â  Â | Â  Â 7 +> Â drivers/block/Makefile Â  | Â  Â 3 +> Â drivers/block/swim.c Â  Â  | Â 995 ++++++++++++++++++++++++++++++++++++++++++++++> Â drivers/block/swim_asm.S | Â 247 ++++++++++++> Â 6 files changed, 1305 insertions(+), 0 deletions(-)> Â create mode 100644 drivers/block/swim.c> Â create mode 100644 drivers/block/swim_asm.S>> diff --git a/arch/m68k/mac/config.c b/arch/m68k/mac/config.c> index 3a1c0b2..be01798 100644> --- a/arch/m68k/mac/config.c> +++ b/arch/m68k/mac/config.c> @@ -22,6 +22,7 @@> Â /* keyb */> Â #include <linux/init.h>> Â #include <linux/vt_kern.h>> +#include <linux/platform_device.h>>> Â #define BOOTINFO_COMPAT_1_0> Â #include <asm/setup.h>> @@ -43,6 +44,10 @@> Â #include <asm/mac_oss.h>> Â #include <asm/mac_psc.h>>> +/* platform device info */> +> +#define SWIM_IO_SIZE 0x2000 Â  Â /* SWIM IO resource size */> +> Â /* Mac bootinfo struct */>> Â struct mac_booter_data mac_bi_data;> @@ -870,3 +875,42 @@ static void mac_get_model(char *str)> Â  Â  Â  Â strcpy(str, "Macintosh ");> Â  Â  Â  Â strcat(str, macintosh_config->name);> Â }> +> +static struct resource swim_resources[1];> +> +static struct platform_device swim_device = {> + Â  Â  Â  .name Â  Â  Â  Â  Â  = "swim",> + Â  Â  Â  .id Â  Â  Â  Â  Â  Â  = -1,> + Â  Â  Â  .num_resources Â = ARRAY_SIZE(swim_resources),> + Â  Â  Â  .resource Â  Â  Â  = swim_resources,> +};> +> +static struct platform_device *mac_platform_devices[] __initdata = {> + Â  Â  Â  &swim_device> +};> +> +int __init mac_platform_init(void)> +{> + Â  Â  Â  u8 *swim_base;> +> + Â  Â  Â  switch (macintosh_config->floppy_type) {> + Â  Â  Â  case MAC_FLOPPY_SWIM_ADDR1:> + Â  Â  Â  Â  Â  Â  Â  swim_base = (u8 *)(VIA1_BASE + 0x1E000);> + Â  Â  Â  Â  Â  Â  Â  break;> + Â  Â  Â  case MAC_FLOPPY_SWIM_ADDR2:> + Â  Â  Â  Â  Â  Â  Â  swim_base = (u8 *)(VIA1_BASE + 0x16000);> + Â  Â  Â  Â  Â  Â  Â  break;> + Â  Â  Â  default:> + Â  Â  Â  Â  Â  Â  Â  return 0;> + Â  Â  Â  }> +> + Â  Â  Â  swim_resources[0].name = "swim-regs";> + Â  Â  Â  swim_resources[0].start = (resource_size_t)swim_base;> + Â  Â  Â  swim_resources[0].end = (resource_size_t)(swim_base + SWIM_IO_SIZE);> + Â  Â  Â  swim_resources[0].flags = IORESOURCE_MEM;> +> + Â  Â  Â  return platform_add_devices(mac_platform_devices,> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  ARRAY_SIZE(mac_platform_devices));> +}> +> +arch_initcall(mac_platform_init);> diff --git a/arch/m68k/mac/via.c b/arch/m68k/mac/via.c> index 7d97ba5..11bce3c 100644> --- a/arch/m68k/mac/via.c> +++ b/arch/m68k/mac/via.c> @@ -645,3 +645,12 @@ int via_irq_pending(int irq)> Â  Â  Â  Â }> Â  Â  Â  Â return 0;> Â }> +> +void via1_set_head(int head)> +{> + Â  Â  Â  if (head == 0)> + Â  Â  Â  Â  Â  Â  Â  via1[vBufA] &= ~VIA1A_vHeadSel;> + Â  Â  Â  else> + Â  Â  Â  Â  Â  Â  Â  via1[vBufA] |= VIA1A_vHeadSel;> +}> +EXPORT_SYMBOL(via1_set_head);> diff --git a/drivers/block/Kconfig b/drivers/block/Kconfig> index 0344a8a..e7b8aa0 100644> --- a/drivers/block/Kconfig> +++ b/drivers/block/Kconfig> @@ -45,6 +45,13 @@ config MAC_FLOPPY> Â  Â  Â  Â  Â If you have a SWIM-3 (Super Woz Integrated Machine 3; from Apple)> Â  Â  Â  Â  Â floppy controller, say Y here. Most commonly found in PowerMacs.>> +config BLK_DEV_SWIM> + Â  Â  Â  tristate "Support for SWIM Macintosh floppy"> + Â  Â  Â  depends on M68K && MAC> + Â  Â  Â  help> + Â  Â  Â  Â  You should select this option if you want floppy support> + Â  Â  Â  Â  and you don't have a II, IIfx, Q900, Q950 or AV series.> +> Â config AMIGA_Z2RAM> Â  Â  Â  Â tristate "Amiga Zorro II ramdisk support"> Â  Â  Â  Â depends on ZORRO> diff --git a/drivers/block/Makefile b/drivers/block/Makefile> index 204332b..b32b7f9 100644> --- a/drivers/block/Makefile> +++ b/drivers/block/Makefile> @@ -6,6 +6,7 @@> Â #>> Â obj-$(CONFIG_MAC_FLOPPY) Â  Â  Â  += swim3.o> +obj-$(CONFIG_BLK_DEV_SWIM) Â  Â  += swim_mod.o> Â obj-$(CONFIG_BLK_DEV_FD) Â  Â  Â  += floppy.o> Â obj-$(CONFIG_AMIGA_FLOPPY) Â  Â  += amiflop.o> Â obj-$(CONFIG_PS3_DISK) Â  Â  Â  Â  += ps3disk.o> @@ -32,3 +33,5 @@ obj-$(CONFIG_BLK_DEV_UB) Â  Â  Â += ub.o> Â obj-$(CONFIG_BLK_DEV_HD) Â  Â  Â  += hd.o>> Â obj-$(CONFIG_XEN_BLKDEV_FRONTEND) Â  Â  Â += xen-blkfront.o> +> +swim_mod-objs Â := swim.o swim_asm.o> diff --git a/drivers/block/swim.c b/drivers/block/swim.c> new file mode 100644> index 0000000..d22cc38> --- /dev/null> +++ b/drivers/block/swim.c> @@ -0,0 +1,995 @@> +/*> + * Driver for SWIM (Sander Woz Integrated Machine) floppy controller> + *> + * Copyright (C) 2004,2008 Laurent Vivier <Laurent@lvivier.info>> + *> + * based on Alastair Bridgewater SWIM analysis, 2001> + * based on SWIM3 driver (c) Paul Mackerras, 1996> + * based on netBSD IWM driver (c) 1997, 1998 Hauke Fath.> + *> + * This program is free software; you can redistribute it and/or> + * modify it under the terms of the GNU General Public License> + * as published by the Free Software Foundation; either version> + * 2 of the License, or (at your option) any later version.> + *> + * 2004-08-21 (lv) - Initial implementation> + * 2008-10-30 (lv) - Port to 2.6> + */> +> +#include <linux/module.h>> +#include <linux/fd.h>> +#include <linux/blkdev.h>> +#include <linux/hdreg.h>> +#include <linux/kernel.h>> +#include <linux/delay.h>> +#include <linux/platform_device.h>> +> +#include <asm/macintosh.h>> +#include <asm/mac_via.h>> +> +#define CARDNAME "swim"> +> +struct sector_header {> + Â  Â  Â  unsigned char side;> + Â  Â  Â  unsigned char track;> + Â  Â  Â  unsigned char sector;> + Â  Â  Â  unsigned char size;> + Â  Â  Â  unsigned char crc0;> + Â  Â  Â  unsigned char crc1;> +} __attribute__((packed));> +> +#define DRIVER_VERSION "Version 0.2 (2008-10-30)"> +> +#define REG(x) unsigned char x, x ## _pad[0x200 - 1];> +> +struct swim {> + Â  Â  Â  REG(write_data)> + Â  Â  Â  REG(write_mark)> + Â  Â  Â  REG(write_CRC)> + Â  Â  Â  REG(write_parameter)> + Â  Â  Â  REG(write_phase)> + Â  Â  Â  REG(write_setup)> + Â  Â  Â  REG(write_mode0)> + Â  Â  Â  REG(write_mode1)> +> + Â  Â  Â  REG(read_data)> + Â  Â  Â  REG(read_mark)> + Â  Â  Â  REG(read_error)> + Â  Â  Â  REG(read_parameter)> + Â  Â  Â  REG(read_phase)> + Â  Â  Â  REG(read_setup)> + Â  Â  Â  REG(read_status)> + Â  Â  Â  REG(read_handshake)> +} __attribute__((packed));> +> +#define swim_write(base, reg, v) Â  Â  Â  out_8(&(base)->write_##reg, (v))> +#define swim_read(base, reg) Â  Â  Â  Â  Â  in_8(&(base)->read_##reg)> +> +/* IWM registers */> +> +struct iwm {> + Â  Â  Â  REG(ph0L)> + Â  Â  Â  REG(ph0H)> + Â  Â  Â  REG(ph1L)> + Â  Â  Â  REG(ph1H)> + Â  Â  Â  REG(ph2L)> + Â  Â  Â  REG(ph2H)> + Â  Â  Â  REG(ph3L)> + Â  Â  Â  REG(ph3H)> + Â  Â  Â  REG(mtrOff)> + Â  Â  Â  REG(mtrOn)> + Â  Â  Â  REG(intDrive)> + Â  Â  Â  REG(extDrive)> + Â  Â  Â  REG(q6L)> + Â  Â  Â  REG(q6H)> + Â  Â  Â  REG(q7L)> + Â  Â  Â  REG(q7H)> +} __attribute__((packed));> +> +#define iwm_write(base, reg, v) Â  Â  Â  Â out_8(&(base)->reg, (v))> +#define iwm_read(base, reg) Â  Â  Â  Â  Â  Â in_8(&(base)->reg)> +> +/* bits in phase register */> +> +#define SEEK_POSITIVE Â 0x070> +#define SEEK_NEGATIVE Â 0x074> +#define STEP Â  Â  Â  Â  Â  0x071> +#define MOTOR_ON Â  Â  Â  0x072> +#define MOTOR_OFF Â  Â  Â 0x076> +#define INDEX Â  Â  Â  Â  Â 0x073> +#define EJECT Â  Â  Â  Â  Â 0x077> +#define SETMFM Â  Â  Â  Â  0x171> +#define SETGCR Â  Â  Â  Â  0x175> +> +#define RELAX Â  Â  Â  Â  Â 0x033> +#define LSTRB Â  Â  Â  Â  Â 0x008> +> +#define CA_MASK Â  Â  Â  Â  Â  Â  Â  Â 0x077> +> +/* Select values for swim_select and swim_readbit */> +> +#define READ_DATA_0 Â  Â 0x074> +#define TWOMEG_DRIVE Â  0x075> +#define SINGLE_SIDED Â  0x076> +#define DRIVE_PRESENT Â 0x077> +#define DISK_IN Â  Â  Â  Â  Â  Â  Â  Â 0x170> +#define WRITE_PROT Â  Â  0x171> +#define TRACK_ZERO Â  Â  0x172> +#define TACHO Â  Â  Â  Â  Â 0x173> +#define READ_DATA_1 Â  Â 0x174> +#define MFM_MODE Â  Â  Â  0x175> +#define SEEK_COMPLETE Â 0x176> +#define ONEMEG_MEDIA Â  0x177> +> +/* Bits in handshake register */> +> +#define MARK_BYTE Â  Â  Â 0x01> +#define CRC_ZERO Â  Â  Â  0x02> +#define RDDATA Â  Â  Â  Â  0x04> +#define SENSE Â  Â  Â  Â  Â 0x08> +#define MOTEN Â  Â  Â  Â  Â 0x10> +#define ERROR Â  Â  Â  Â  Â 0x20> +#define DAT2BYTE Â  Â  Â  0x40> +#define DAT1BYTE Â  Â  Â  0x80> +> +/* bits in setup register */> +> +#define S_INV_WDATA Â  Â 0x01> +#define S_3_5_SELECT Â  0x02> +#define S_GCR Â  Â  Â  Â  Â 0x04> +#define S_FCLK_DIV2 Â  Â 0x08> +#define S_ERROR_CORR Â  0x10> +#define S_IBM_DRIVE Â  Â 0x20> +#define S_GCR_WRITE Â  Â 0x40> +#define S_TIMEOUT Â  Â  Â 0x80> +> +/* bits in mode register */> +> +#define CLFIFO Â  Â  Â  Â  0x01> +#define ENBL1 Â  Â  Â  Â  Â 0x02> +#define ENBL2 Â  Â  Â  Â  Â 0x04> +#define ACTION Â  Â  Â  Â  0x08> +#define WRITE_MODE Â  Â  0x10> +#define HEDSEL Â  Â  Â  Â  0x20> +#define MOTON Â  Â  Â  Â  Â 0x80> +> +/*----------------------------------------------------------------------------*/> +> +enum drive_location {> + Â  Â  Â  INTERNAL_DRIVE = 0x02,> + Â  Â  Â  EXTERNAL_DRIVE = 0x04,> +};> +> +enum media_type {> + Â  Â  Â  DD_MEDIA,> + Â  Â  Â  HD_MEDIA,> +};> +> +struct floppy_state {> +> + Â  Â  Â  /* physical properties */> +> + Â  Â  Â  enum drive_location location; Â  /* internal or external drive */> + Â  Â  Â  int Â  Â  Â  Â  Â  Â  Â head_number; Â  /* single- or double-sided drive */> +> + Â  Â  Â  /* media */> +> + Â  Â  Â  int Â  Â  Â  Â  Â  Â  Â disk_in;> + Â  Â  Â  int Â  Â  Â  Â  Â  Â  Â ejected;> + Â  Â  Â  enum media_type Â type;> + Â  Â  Â  int Â  Â  Â  Â  Â  Â  Â write_protected;> +> + Â  Â  Â  int Â  Â  Â  Â  Â  Â  Â total_secs;> + Â  Â  Â  int Â  Â  Â  Â  Â  Â  Â secpercyl;> + Â  Â  Â  int Â  Â  Â  Â  Â  Â  Â secpertrack;> +> + Â  Â  Â  /* in-use information */> +> + Â  Â  Â  int Â  Â  Â  Â  Â  Â  track;> + Â  Â  Â  int Â  Â  Â  Â  Â  Â  ref_count;> +> + Â  Â  Â  struct gendisk *disk;> +> + Â  Â  Â  /* parent controller */> +> + Â  Â  Â  struct swim_priv *swd;> +};> +> +enum motor_action {> + Â  Â  Â  OFF,> + Â  Â  Â  ON,> +};> +> +enum head {> + Â  Â  Â  LOWER_HEAD = 0,> + Â  Â  Â  UPPER_HEAD = 1,> +};> +> +#define FD_MAX_UNIT Â  Â 2> +> +struct swim_priv {> + Â  Â  Â  struct swim __iomem *base;> + Â  Â  Â  spinlock_t lock;> + Â  Â  Â  struct request_queue *queue;> + Â  Â  Â  int floppy_count;> + Â  Â  Â  struct floppy_state unit[FD_MAX_UNIT];> +};> +> +extern int swim_read_sector_header(struct swim __iomem *base,> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â struct sector_header *header);> +extern int swim_read_sector_data(struct swim __iomem *base,> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â unsigned char *data);> +> +static inline void set_swim_mode(struct swim __iomem *base, int enable)> +{> + Â  Â  Â  struct iwm __iomem *iwm_base;> + Â  Â  Â  unsigned long flags;> +> + Â  Â  Â  if (!enable) {> + Â  Â  Â  Â  Â  Â  Â  swim_write(base, mode0, 0xf8);> + Â  Â  Â  Â  Â  Â  Â  return;> + Â  Â  Â  }> +> + Â  Â  Â  iwm_base = (struct iwm __iomem *)base;> + Â  Â  Â  local_irq_save(flags);> +> + Â  Â  Â  iwm_read(iwm_base, q7L);> + Â  Â  Â  iwm_read(iwm_base, mtrOff);> + Â  Â  Â  iwm_read(iwm_base, q6H);> +> + Â  Â  Â  iwm_write(iwm_base, q7H, 0x57);> + Â  Â  Â  iwm_write(iwm_base, q7H, 0x17);> + Â  Â  Â  iwm_write(iwm_base, q7H, 0x57);> + Â  Â  Â  iwm_write(iwm_base, q7H, 0x57);> +> + Â  Â  Â  local_irq_restore(flags);> +}> +> +static inline int get_swim_mode(struct swim __iomem *base)> +{> + Â  Â  Â  unsigned long flags;> +> + Â  Â  Â  local_irq_save(flags);> +> + Â  Â  Â  swim_write(base, phase, 0xf5);> + Â  Â  Â  if (swim_read(base, phase) != 0xf5)> + Â  Â  Â  Â  Â  Â  Â  goto is_iwm;> + Â  Â  Â  swim_write(base, phase, 0xf6);> + Â  Â  Â  if (swim_read(base, phase) != 0xf6)> + Â  Â  Â  Â  Â  Â  Â  goto is_iwm;> + Â  Â  Â  swim_write(base, phase, 0xf7);> + Â  Â  Â  if (swim_read(base, phase) != 0xf7)> + Â  Â  Â  Â  Â  Â  Â  goto is_iwm;> + Â  Â  Â  local_irq_restore(flags);> + Â  Â  Â  return 1;> +is_iwm:> + Â  Â  Â  local_irq_restore(flags);> + Â  Â  Â  return 0;> +}> +> +static inline void swim_select(struct swim __iomem *base, int sel)> +{> + Â  Â  Â  swim_write(base, phase, RELAX);> +> + Â  Â  Â  via1_set_head(sel & 0x100);> +> + Â  Â  Â  swim_write(base, phase, sel & CA_MASK);> +}> +> +static inline void swim_action(struct swim __iomem *base, int action)> +{> + Â  Â  Â  unsigned long flags;> +> + Â  Â  Â  local_irq_save(flags);> +> + Â  Â  Â  swim_select(base, action);> + Â  Â  Â  udelay(1);> + Â  Â  Â  swim_write(base, phase, (LSTRB<<4) | LSTRB);> + Â  Â  Â  udelay(1);> + Â  Â  Â  swim_write(base, phase, (LSTRB<<4) | ((~LSTRB) & 0x0F));> + Â  Â  Â  udelay(1);> +> + Â  Â  Â  local_irq_restore(flags);> +}> +> +static inline int swim_readbit(struct swim __iomem *base, int bit)> +{> + Â  Â  Â  int stat;> +> + Â  Â  Â  swim_select(base, bit);> +> + Â  Â  Â  udelay(10);> +> + Â  Â  Â  stat = swim_read(base, handshake);> +> + Â  Â  Â  return (stat & SENSE) == 0;> +}> +> +static inline void swim_drive(struct swim __iomem *base,> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  enum drive_location location)> +{> + Â  Â  Â  if (location == INTERNAL_DRIVE) {> + Â  Â  Â  Â  Â  Â  Â  swim_write(base, mode0, EXTERNAL_DRIVE); /* clear drive 1 bit */> + Â  Â  Â  Â  Â  Â  Â  swim_write(base, mode1, INTERNAL_DRIVE); /* set drive 0 bit */> + Â  Â  Â  } else if (location == EXTERNAL_DRIVE) {> + Â  Â  Â  Â  Â  Â  Â  swim_write(base, mode0, INTERNAL_DRIVE); /* clear drive 0 bit */> + Â  Â  Â  Â  Â  Â  Â  swim_write(base, mode1, EXTERNAL_DRIVE); /* set drive 1 bit */> + Â  Â  Â  }> +}> +> +static inline void swim_motor(struct swim __iomem *base,> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  enum motor_action action)> +{> + Â  Â  Â  if (action == ON) {> + Â  Â  Â  Â  Â  Â  Â  int i;> +> + Â  Â  Â  Â  Â  Â  Â  swim_action(base, MOTOR_ON);> +> + Â  Â  Â  Â  Â  Â  Â  for (i = 0; i < 2*HZ; i++) {> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  swim_select(base, RELAX);> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  if (swim_readbit(base, MOTOR_ON))> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  break;> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  current->state = TASK_INTERRUPTIBLE;> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  schedule_timeout(1);> + Â  Â  Â  Â  Â  Â  Â  }> + Â  Â  Â  } else if (action == OFF) {> + Â  Â  Â  Â  Â  Â  Â  swim_action(base, MOTOR_OFF);> + Â  Â  Â  Â  Â  Â  Â  swim_select(base, RELAX);> + Â  Â  Â  }> +}> +> +static inline void swim_eject(struct swim __iomem *base)> +{> + Â  Â  Â  int i;> +> + Â  Â  Â  swim_action(base, EJECT);> +> + Â  Â  Â  for (i = 0; i < 2*HZ; i++) {> + Â  Â  Â  Â  Â  Â  Â  swim_select(base, RELAX);> + Â  Â  Â  Â  Â  Â  Â  if (!swim_readbit(base, DISK_IN))> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  break;> + Â  Â  Â  Â  Â  Â  Â  current->state = TASK_INTERRUPTIBLE;> + Â  Â  Â  Â  Â  Â  Â  schedule_timeout(1);> + Â  Â  Â  }> + Â  Â  Â  swim_select(base, RELAX);> +}> +> +static inline void swim_head(struct swim __iomem *base, enum head head)> +{> + Â  Â  Â  /* wait drive is ready */> +> + Â  Â  Â  if (head == UPPER_HEAD)> + Â  Â  Â  Â  Â  Â  Â  swim_select(base, READ_DATA_1);> + Â  Â  Â  else if (head == LOWER_HEAD)> + Â  Â  Â  Â  Â  Â  Â  swim_select(base, READ_DATA_0);> +}> +> +static inline int swim_step(struct swim __iomem *base)> +{> + Â  Â  Â  int wait;> +> + Â  Â  Â  swim_action(base, STEP);> +> + Â  Â  Â  for (wait = 0; wait < HZ; wait++) {> +> + Â  Â  Â  Â  Â  Â  Â  current->state = TASK_INTERRUPTIBLE;> + Â  Â  Â  Â  Â  Â  Â  schedule_timeout(1);> +> + Â  Â  Â  Â  Â  Â  Â  swim_select(base, RELAX);> + Â  Â  Â  Â  Â  Â  Â  if (!swim_readbit(base, STEP))> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  return 0;> + Â  Â  Â  }> + Â  Â  Â  return -1;> +}> +> +static inline int swim_track00(struct swim __iomem *base)> +{> + Â  Â  Â  int try;> +> + Â  Â  Â  swim_action(base, SEEK_NEGATIVE);> +> + Â  Â  Â  for (try = 0; try < 100; try++) {> +> + Â  Â  Â  Â  Â  Â  Â  swim_select(base, RELAX);> + Â  Â  Â  Â  Â  Â  Â  if (swim_readbit(base, TRACK_ZERO))> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  break;> +> + Â  Â  Â  Â  Â  Â  Â  if (swim_step(base))> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  return -1;> + Â  Â  Â  }> +> + Â  Â  Â  if (swim_readbit(base, TRACK_ZERO))> + Â  Â  Â  Â  Â  Â  Â  return 0;> +> + Â  Â  Â  return -1;> +}> +> +static inline int swim_seek(struct swim __iomem *base, int step)> +{> + Â  Â  Â  if (step == 0)> + Â  Â  Â  Â  Â  Â  Â  return 0;> +> + Â  Â  Â  if (step < 0) {> + Â  Â  Â  Â  Â  Â  Â  swim_action(base, SEEK_NEGATIVE);> + Â  Â  Â  Â  Â  Â  Â  step = -step;> + Â  Â  Â  } else> + Â  Â  Â  Â  Â  Â  Â  swim_action(base, SEEK_POSITIVE);> +> + Â  Â  Â  for ( ; step > 0; step--) {> + Â  Â  Â  Â  Â  Â  Â  if (swim_step(base))> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  return -1;> + Â  Â  Â  }> +> + Â  Â  Â  return 0;> +}> +> +static inline int swim_track(struct floppy_state *fs, Â int track)> +{> + Â  Â  Â  struct swim __iomem *base = fs->swd->base;> + Â  Â  Â  int ret;> +> + Â  Â  Â  ret = swim_seek(base, track - fs->track);> +> + Â  Â  Â  if (ret == 0)> + Â  Â  Â  Â  Â  Â  Â  fs->track = track;> + Â  Â  Â  else {> + Â  Â  Â  Â  Â  Â  Â  swim_track00(base);> + Â  Â  Â  Â  Â  Â  Â  fs->track = 0;> + Â  Â  Â  }> +> + Â  Â  Â  return ret;> +}> +> +static int floppy_eject(struct floppy_state *fs)> +{> + Â  Â  Â  struct swim __iomem *base = fs->swd->base;> +> + Â  Â  Â  swim_drive(base, fs->location);> + Â  Â  Â  swim_motor(base, OFF);> + Â  Â  Â  swim_eject(base);> +> + Â  Â  Â  fs->disk_in = 0;> + Â  Â  Â  fs->ejected = 1;> +> + Â  Â  Â  return 0;> +}> +> +static inline int swim_read_sector(struct floppy_state *fs,> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â int side, int track,> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â int sector, unsigned char *buffer)> +{> + Â  Â  Â  struct swim __iomem *base = fs->swd->base;> + Â  Â  Â  unsigned long flags;> + Â  Â  Â  struct sector_header header;> + Â  Â  Â  int ret = -1;> + Â  Â  Â  short i;> +> + Â  Â  Â  swim_track(fs, track);> +> + Â  Â  Â  swim_write(base, mode1, MOTON);> + Â  Â  Â  swim_head(base, side);> + Â  Â  Â  swim_write(base, mode0, side);> +> + Â  Â  Â  local_irq_save(flags);> + Â  Â  Â  for (i = 0; i < 36; i++) {> + Â  Â  Â  Â  Â  Â  Â  ret = swim_read_sector_header(base, &header);> + Â  Â  Â  Â  Â  Â  Â  if (!ret && (header.sector == sector)) {> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  /* found */> +> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  ret = swim_read_sector_data(base, buffer);> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  break;> + Â  Â  Â  Â  Â  Â  Â  }> + Â  Â  Â  }> + Â  Â  Â  local_irq_restore(flags);> +> + Â  Â  Â  swim_write(base, mode0, MOTON);> +> + Â  Â  Â  if ((header.side != side) Â || (header.track != track) ||> + Â  Â  Â  Â  Â  Â (header.sector != sector))> + Â  Â  Â  Â  Â  Â  Â  return 0;> +> + Â  Â  Â  return ret;> +}> +> +static int floppy_read_sectors(struct floppy_state *fs,> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â int req_sector, int sectors_nb,> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â unsigned char *buffer)> +{> + Â  Â  Â  struct swim __iomem *base = fs->swd->base;> + Â  Â  Â  int ret;> + Â  Â  Â  int side, track, sector;> + Â  Â  Â  int i, try;> +> +> + Â  Â  Â  swim_drive(base, fs->location);> + Â  Â  Â  for (i = req_sector; i < req_sector + sectors_nb; i++) {> + Â  Â  Â  Â  Â  Â  Â  int x;> + Â  Â  Â  Â  Â  Â  Â  track = i / fs->secpercyl;> + Â  Â  Â  Â  Â  Â  Â  x = i % fs->secpercyl;> + Â  Â  Â  Â  Â  Â  Â  side = x / fs->secpertrack;> + Â  Â  Â  Â  Â  Â  Â  sector = x % fs->secpertrack + 1;> +> + Â  Â  Â  Â  Â  Â  Â  try = 5;> + Â  Â  Â  Â  Â  Â  Â  do {> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  ret = swim_read_sector(fs, side, track, sector,> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  buffer);> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  if (try-- == 0)> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  return -1;> + Â  Â  Â  Â  Â  Â  Â  } while (ret != 512);> +> + Â  Â  Â  Â  Â  Â  Â  buffer += ret;> + Â  Â  Â  }> +> + Â  Â  Â  return 0;> +}> +> +static void redo_fd_request(struct request_queue *q)> +{> + Â  Â  Â  struct request *req;> + Â  Â  Â  struct floppy_state *fs;> +> + Â  Â  Â  while ((req = elv_next_request(q))) {> +> + Â  Â  Â  Â  Â  Â  Â  fs = req->rq_disk->private_data;> + Â  Â  Â  Â  Â  Â  Â  if (req->sector < 0 || req->sector >= fs->total_secs) {> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  end_request(req, 0);> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  continue;> + Â  Â  Â  Â  Â  Â  Â  }> + Â  Â  Â  Â  Â  Â  Â  if (req->current_nr_sectors == 0) {> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  end_request(req, 1);> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  continue;> + Â  Â  Â  Â  Â  Â  Â  }> + Â  Â  Â  Â  Â  Â  Â  if (!fs->disk_in) {> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  end_request(req, 0);> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  continue;> + Â  Â  Â  Â  Â  Â  Â  }> + Â  Â  Â  Â  Â  Â  Â  if (rq_data_dir(req) == WRITE) {> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  if (fs->write_protected) {> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  end_request(req, 0);> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  continue;> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  }> + Â  Â  Â  Â  Â  Â  Â  }> + Â  Â  Â  Â  Â  Â  Â  switch (rq_data_dir(req)) {> + Â  Â  Â  Â  Â  Â  Â  case WRITE:> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  /* NOT IMPLEMENTED */> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  end_request(req, 0);> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  break;> + Â  Â  Â  Â  Â  Â  Â  case READ:> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  if (floppy_read_sectors(fs, req->sector,> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  req->current_nr_sectors,> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  req->buffer)) {> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  end_request(req, 0);> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  continue;> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  }> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  req->nr_sectors -= req->current_nr_sectors;> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  req->sector += req->current_nr_sectors;> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  req->buffer += req->current_nr_sectors * 512;> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  end_request(req, 1);> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  break;> + Â  Â  Â  Â  Â  Â  Â  }> + Â  Â  Â  }> +}> +> +static void do_fd_request(struct request_queue *q)> +{> + Â  Â  Â  redo_fd_request(q);> +}> +> +static struct floppy_struct floppy_type[4] = {> + Â  Â  Â  { Â  Â 0, Â 0, 0, Â 0, 0, 0x00, 0x00, 0x00, 0x00, NULL }, /* no testing Â  */> + Â  Â  Â  { Â 720, Â 9, 1, 80, 0, 0x2A, 0x02, 0xDF, 0x50, NULL }, /* 360KB SS 3.5"*/> + Â  Â  Â  { 1440, Â 9, 2, 80, 0, 0x2A, 0x02, 0xDF, 0x50, NULL }, /* 720KB 3.5" Â  */> + Â  Â  Â  { 2880, 18, 2, 80, 0, 0x1B, 0x00, 0xCF, 0x6C, NULL }, /* 1.44MB 3.5" Â */> +};> +> +static int get_floppy_geometry(struct floppy_state *fs, int type,> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â struct floppy_struct **g)> +{> + Â  Â  Â  if (type >= ARRAY_SIZE(floppy_type))> + Â  Â  Â  Â  Â  Â  Â  return -EINVAL;> +> + Â  Â  Â  if (type)> + Â  Â  Â  Â  Â  Â  Â  *g = &floppy_type[type];> + Â  Â  Â  else if (fs->type == HD_MEDIA) /* High-Density media */> + Â  Â  Â  Â  Â  Â  Â  *g = &floppy_type[3];> + Â  Â  Â  else if (fs->head_number == 2) /* double-sided */> + Â  Â  Â  Â  Â  Â  Â  *g = &floppy_type[2];> + Â  Â  Â  else> + Â  Â  Â  Â  Â  Â  Â  *g = &floppy_type[1];> +> + Â  Â  Â  return 0;> +}> +> +static void setup_medium(struct floppy_state *fs)> +{> + Â  Â  Â  struct swim __iomem *base = fs->swd->base;> +> + Â  Â  Â  if (swim_readbit(base, DISK_IN)) {> + Â  Â  Â  Â  Â  Â  Â  struct floppy_struct *g;> + Â  Â  Â  Â  Â  Â  Â  fs->disk_in = 1;> + Â  Â  Â  Â  Â  Â  Â  fs->write_protected = swim_readbit(base, WRITE_PROT);> + Â  Â  Â  Â  Â  Â  Â  fs->type = swim_readbit(base, ONEMEG_MEDIA);> +> + Â  Â  Â  Â  Â  Â  Â  if (swim_track00(base))> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  printk(KERN_ERR> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  "SWIM: cannot move floppy head to track 0\n");> +> + Â  Â  Â  Â  Â  Â  Â  swim_track00(base);> +> + Â  Â  Â  Â  Â  Â  Â  get_floppy_geometry(fs, 0, &g);> + Â  Â  Â  Â  Â  Â  Â  fs->total_secs = g->size;> + Â  Â  Â  Â  Â  Â  Â  fs->secpercyl = g->head * g->sect;> + Â  Â  Â  Â  Â  Â  Â  fs->secpertrack = g->sect;> + Â  Â  Â  Â  Â  Â  Â  fs->track = 0;> + Â  Â  Â  } else {> + Â  Â  Â  Â  Â  Â  Â  fs->disk_in = 0;> + Â  Â  Â  }> +}> +> +static int floppy_open(struct block_device *bdev, fmode_t mode)> +{> + Â  Â  Â  struct floppy_state *fs = bdev->bd_disk->private_data;> + Â  Â  Â  struct swim __iomem *base = fs->swd->base;> + Â  Â  Â  int err;> +> + Â  Â  Â  if (fs->ref_count == -1 || (fs->ref_count && mode & FMODE_EXCL))> + Â  Â  Â  Â  Â  Â  Â  return -EBUSY;> +> + Â  Â  Â  if (mode & FMODE_EXCL)> + Â  Â  Â  Â  Â  Â  Â  fs->ref_count = -1;> + Â  Â  Â  else> + Â  Â  Â  Â  Â  Â  Â  fs->ref_count++;> +> + Â  Â  Â  swim_write(base, setup, S_IBM_DRIVE Â | S_FCLK_DIV2);> + Â  Â  Â  udelay(10);> + Â  Â  Â  swim_drive(base, INTERNAL_DRIVE);> + Â  Â  Â  swim_motor(base, ON);> + Â  Â  Â  swim_action(base, SETMFM);> + Â  Â  Â  if (fs->ejected)> + Â  Â  Â  Â  Â  Â  Â  setup_medium(fs);> + Â  Â  Â  if (!fs->disk_in) {> + Â  Â  Â  Â  Â  Â  Â  err = -ENXIO;> + Â  Â  Â  Â  Â  Â  Â  goto out;> + Â  Â  Â  }> +> + Â  Â  Â  if (mode & FMODE_NDELAY)> + Â  Â  Â  Â  Â  Â  Â  return 0;> +> + Â  Â  Â  if (mode & (FMODE_READ|FMODE_WRITE)) {> + Â  Â  Â  Â  Â  Â  Â  check_disk_change(bdev);> + Â  Â  Â  Â  Â  Â  Â  if ((mode & FMODE_WRITE) && fs->write_protected) {> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  err = -EROFS;> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  goto out;> + Â  Â  Â  Â  Â  Â  Â  }> + Â  Â  Â  }> + Â  Â  Â  return 0;> +out:> + Â  Â  Â  if (fs->ref_count < 0)> + Â  Â  Â  Â  Â  Â  Â  fs->ref_count = 0;> + Â  Â  Â  else if (fs->ref_count > 0)> + Â  Â  Â  Â  Â  Â  Â  --fs->ref_count;> +> + Â  Â  Â  if (fs->ref_count == 0)> + Â  Â  Â  Â  Â  Â  Â  swim_motor(base, OFF);> + Â  Â  Â  return err;> +}> +> +static int floppy_release(struct gendisk *disk, fmode_t mode)> +{> + Â  Â  Â  struct floppy_state *fs = disk->private_data;> + Â  Â  Â  struct swim __iomem *base = fs->swd->base;> +> + Â  Â  Â  if (fs->ref_count < 0)> + Â  Â  Â  Â  Â  Â  Â  fs->ref_count = 0;> + Â  Â  Â  else if (fs->ref_count > 0)> + Â  Â  Â  Â  Â  Â  Â  --fs->ref_count;> +> + Â  Â  Â  if (fs->ref_count == 0)> + Â  Â  Â  Â  Â  Â  Â  swim_motor(base, OFF);> +> + Â  Â  Â  return 0;> +}> +> +static int floppy_ioctl(struct block_device *bdev, fmode_t mode,> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  unsigned int cmd, unsigned long param)> +{> + Â  Â  Â  struct floppy_state *fs = bdev->bd_disk->private_data;> + Â  Â  Â  int err;> +> + Â  Â  Â  if ((cmd & 0x80) && !capable(CAP_SYS_ADMIN))> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  return -EPERM;> +> + Â  Â  Â  switch (cmd) {> + Â  Â  Â  case FDEJECT:> + Â  Â  Â  Â  Â  Â  Â  if (fs->ref_count != 1)> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  return -EBUSY;> + Â  Â  Â  Â  Â  Â  Â  err = floppy_eject(fs);> + Â  Â  Â  Â  Â  Â  Â  return err;> +> + Â  Â  Â  case FDGETPRM:> + Â  Â  Â  Â  Â  Â  Â  if (copy_to_user((void __user *) param, (void *) &floppy_type,> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â sizeof(struct floppy_struct)))> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  return -EFAULT;> + Â  Â  Â  Â  Â  Â  Â  break;> +> + Â  Â  Â  default:> + Â  Â  Â  Â  Â  Â  Â  printk(KERN_DEBUG "SWIM floppy_ioctl: unknown cmd %d\n",> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â cmd);> + Â  Â  Â  Â  Â  Â  Â  return -ENOSYS;> + Â  Â  Â  }> + Â  Â  Â  return 0;> +}> +> +static int floppy_getgeo(struct block_device *bdev, struct hd_geometry *geo)> +{> + Â  Â  Â  struct floppy_state *fs = bdev->bd_disk->private_data;> + Â  Â  Â  struct floppy_struct *g;> + Â  Â  Â  int ret;> +> + Â  Â  Â  ret = get_floppy_geometry(fs, 0, &g);> + Â  Â  Â  if (ret)> + Â  Â  Â  Â  Â  Â  Â  return ret;> +> + Â  Â  Â  geo->heads = g->head;> + Â  Â  Â  geo->sectors = g->sect;> + Â  Â  Â  geo->cylinders = g->track;> +> + Â  Â  Â  return 0;> +}> +> +static int floppy_check_change(struct gendisk *disk)> +{> + Â  Â  Â  struct floppy_state *fs = disk->private_data;> +> + Â  Â  Â  return fs->ejected;> +}> +> +static int floppy_revalidate(struct gendisk *disk)> +{> + Â  Â  Â  struct floppy_state *fs = disk->private_data;> + Â  Â  Â  struct swim __iomem *base = fs->swd->base;> +> + Â  Â  Â  swim_drive(base, fs->location);> +> + Â  Â  Â  if (fs->ejected)> + Â  Â  Â  Â  Â  Â  Â  setup_medium(fs);> +> + Â  Â  Â  if (!fs->disk_in)> + Â  Â  Â  Â  Â  Â  Â  swim_motor(base, OFF);> + Â  Â  Â  else> + Â  Â  Â  Â  Â  Â  Â  fs->ejected = 0;> +> + Â  Â  Â  return !fs->disk_in;> +}> +> +static struct block_device_operations floppy_fops = {> + Â  Â  Â  .owner Â  Â  Â  Â  Â  = THIS_MODULE,> + Â  Â  Â  .open Â  Â  Â  Â  Â  Â = floppy_open,> + Â  Â  Â  .release Â  Â  Â  Â  = floppy_release,> + Â  Â  Â  .locked_ioctl Â  Â = floppy_ioctl,> + Â  Â  Â  .getgeo Â  Â  Â  Â  Â = floppy_getgeo,> + Â  Â  Â  .media_changed Â  = floppy_check_change,> + Â  Â  Â  .revalidate_disk = floppy_revalidate,> +};> +> +static struct kobject *floppy_find(dev_t dev, int *part, void *data)> +{> + Â  Â  Â  struct swim_priv *swd = data;> + Â  Â  Â  int drive = (*part & 3);> +> + Â  Â  Â  if (drive > swd->floppy_count)> + Â  Â  Â  Â  Â  Â  Â  return NULL;> +> + Â  Â  Â  *part = 0;> + Â  Â  Â  return get_disk(swd->unit[drive].disk);> +}> +> +static int __devinit swim_add_floppy(struct swim_priv *swd,> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â enum drive_location location)> +{> + Â  Â  Â  struct floppy_state *fs = &swd->unit[swd->floppy_count];> + Â  Â  Â  struct swim __iomem *base = swd->base;> +> + Â  Â  Â  fs->location = location;> +> + Â  Â  Â  swim_drive(base, location);> +> + Â  Â  Â  swim_motor(base, OFF);> +> + Â  Â  Â  if (swim_readbit(base, SINGLE_SIDED))> + Â  Â  Â  Â  Â  Â  Â  fs->head_number = 1;> + Â  Â  Â  else> + Â  Â  Â  Â  Â  Â  Â  fs->head_number = 2;> + Â  Â  Â  fs->ref_count = 0;> + Â  Â  Â  fs->ejected = 1;> +> + Â  Â  Â  swd->floppy_count++;> +> + Â  Â  Â  return 0;> +}> +> +static int __devinit swim_floppy_init(struct swim_priv *swd)> +{> + Â  Â  Â  int err;> + Â  Â  Â  int drive;> + Â  Â  Â  struct swim __iomem *base = swd->base;> +> + Â  Â  Â  /* scan floppy drives */> +> + Â  Â  Â  swim_drive(base, INTERNAL_DRIVE);> + Â  Â  Â  if (swim_readbit(base, DRIVE_PRESENT))> + Â  Â  Â  Â  Â  Â  Â  swim_add_floppy(swd, INTERNAL_DRIVE);> + Â  Â  Â  swim_drive(base, EXTERNAL_DRIVE);> + Â  Â  Â  if (swim_readbit(base, DRIVE_PRESENT))> + Â  Â  Â  Â  Â  Â  Â  swim_add_floppy(swd, EXTERNAL_DRIVE);> +> + Â  Â  Â  /* register floppy drives */> +> + Â  Â  Â  err = register_blkdev(FLOPPY_MAJOR, "fd");> + Â  Â  Â  if (err) {> + Â  Â  Â  Â  Â  Â  Â  printk(KERN_ERR "Unable to get major %d for SWIM floppy\n",> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â FLOPPY_MAJOR);> + Â  Â  Â  Â  Â  Â  Â  return -EBUSY;> + Â  Â  Â  }> +> + Â  Â  Â  for (drive = 0; drive < swd->floppy_count; drive++) {> + Â  Â  Â  Â  Â  Â  Â  swd->unit[drive].disk = alloc_disk(1);> + Â  Â  Â  Â  Â  Â  Â  if (swd->unit[drive].disk == NULL) {> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  err = -ENOMEM;> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  goto exit_put_disks;> + Â  Â  Â  Â  Â  Â  Â  }> + Â  Â  Â  Â  Â  Â  Â  swd->unit[drive].swd = swd;> + Â  Â  Â  }> +> + Â  Â  Â  swd->queue = blk_init_queue(do_fd_request, &swd->lock);> + Â  Â  Â  if (!swd->queue) {> + Â  Â  Â  Â  Â  Â  Â  err = -ENOMEM;> + Â  Â  Â  Â  Â  Â  Â  goto exit_put_disks;> + Â  Â  Â  }> +> + Â  Â  Â  for (drive = 0; drive < swd->floppy_count; drive++) {> + Â  Â  Â  Â  Â  Â  Â  swd->unit[drive].disk->flags = GENHD_FL_REMOVABLE;> + Â  Â  Â  Â  Â  Â  Â  swd->unit[drive].disk->major = FLOPPY_MAJOR;> + Â  Â  Â  Â  Â  Â  Â  swd->unit[drive].disk->first_minor = drive;> + Â  Â  Â  Â  Â  Â  Â  sprintf(swd->unit[drive].disk->disk_name, "fd%d", drive);> + Â  Â  Â  Â  Â  Â  Â  swd->unit[drive].disk->fops = &floppy_fops;> + Â  Â  Â  Â  Â  Â  Â  swd->unit[drive].disk->private_data = &swd->unit[drive];> + Â  Â  Â  Â  Â  Â  Â  swd->unit[drive].disk->queue = swd->queue;> + Â  Â  Â  Â  Â  Â  Â  set_capacity(swd->unit[drive].disk, 2880);> + Â  Â  Â  Â  Â  Â  Â  add_disk(swd->unit[drive].disk);> + Â  Â  Â  }> +> + Â  Â  Â  blk_register_region(MKDEV(FLOPPY_MAJOR, 0), 256, THIS_MODULE,> + Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  Â  floppy_find, NULL, swd);> +> + Â  Â  Â  return 0;> +> +exit_put_disks:> + Â  Â  Â  unregister_blkdev(FLOPPY_MAJOR, "fd");> + Â  Â  Â  while (drive--)> + Â  Â  Â  Â  Â  Â  Â  put_disk(swd->unit[drive].disk);> + Â  Â  Â  return err;> +}> +> +static int __devinit swim_probe(struct platform_device *dev)> +{> + Â  Â  Â  struct resource *res;> + Â  Â  Â  struct swim __iomem *swim_base;> + Â  Â  Â  struct swim_priv *swd;> + Â  Â  Â  int ret;> +> + Â  Â  Â  res = platform_get_resource_byname(dev, IORESOURCE_MEM, "swim-regs");> + Â  Â  Â  if (!res) {> + Â  Â  Â  Â  Â  Â  Â  ret = -ENODEV;> + Â  Â  Â  Â  Â  Â  Â  goto out;> + Â  Â  Â  }> +> + Â  Â  Â  if (!request_mem_region(res->start, resource_size(res), CARDNAME)) {> + Â  Â  Â  Â  Â  Â  Â  ret = -EBUSY;> + Â  Â  Â  Â  Â  Â  Â  goto out;> + Â  Â  Â  }> +> + Â  Â  Â  swim_base = ioremap(res->start, resource_size(res));> + Â  Â  Â  if (!swim_base) {> + Â  Â  Â  Â  Â  Â  Â  return -ENOMEM;> + Â  Â  Â  Â  Â  Â  Â  goto out_release_io;> + Â  Â  Â  }> +> + Â  Â  Â  /* probe device */> +> + Â  Â  Â  set_swim_mode(swim_base, 1);> + Â  Â  Â  if (!get_swim_mode(swim_base)) {> + Â  Â  Â  Â  Â  Â  Â  printk(KERN_INFO "SWIM device not found !\n");> + Â  Â  Â  Â  Â  Â  Â  ret = -ENODEV;> + Â  Â  Â  Â  Â  Â  Â  goto out_iounmap;> + Â  Â  Â  }> +> + Â  Â  Â  /* set platform driver data */> +> + Â  Â  Â  swd = kzalloc(sizeof(struct swim_priv), GFP_KERNEL);> + Â  Â  Â  if (!swd) {> + Â  Â  Â  Â  Â  Â  Â  ret = -ENOMEM;> + Â  Â  Â  Â  Â  Â  Â  goto out_iounmap;> + Â  Â  Â  }> + Â  Â  Â  platform_set_drvdata(dev, swd);> +> + Â  Â  Â  swd->base = swim_base;> +> + Â  Â  Â  ret = swim_floppy_init(swd);> + Â  Â  Â  if (ret)> + Â  Â  Â  Â  Â  Â  Â  goto out_kfree;> +> + Â  Â  Â  return 0;> +> +out_kfree:> + Â  Â  Â  platform_set_drvdata(dev, NULL);> + Â  Â  Â  kfree(swd);> +out_iounmap:> + Â  Â  Â  iounmap(swim_base);> +out_release_io:> + Â  Â  Â  release_mem_region(res->start, resource_size(res));> +out:> + Â  Â  Â  return ret;> +}> +> +static int __devexit swim_remove(struct platform_device *dev)> +{> + Â  Â  Â  struct swim_priv *swd = platform_get_drvdata(dev);> + Â  Â  Â  int drive;> + Â  Â  Â  struct resource *res;> +> + Â  Â  Â  blk_unregister_region(MKDEV(FLOPPY_MAJOR, 0), 256);> +> + Â  Â  Â  for (drive = 0; drive < swd->floppy_count; drive++) {> + Â  Â  Â  Â  Â  Â  Â  del_gendisk(swd->unit[drive].disk);> + Â  Â  Â  Â  Â  Â  Â  put_disk(swd->unit[drive].disk);> + Â  Â  Â  }> +> + Â  Â  Â  unregister_blkdev(FLOPPY_MAJOR, "fd");> +> + Â  Â  Â  blk_cleanup_queue(swd->queue);> +> + Â  Â  Â  /* eject floppies */> +> + Â  Â  Â  for (drive = 0; drive < swd->floppy_count; drive++)> + Â  Â  Â  Â  Â  Â  Â  floppy_eject(&swd->unit[drive]);> +> + Â  Â  Â  iounmap(swd->base);> +> + Â  Â  Â  res = platform_get_resource_byname(dev, IORESOURCE_MEM, "swim-regs");> + Â  Â  Â  if (res)> + Â  Â  Â  Â  Â  Â  Â  release_mem_region(res->start, resource_size(res));> +> + Â  Â  Â  platform_set_drvdata(dev, NULL);> + Â  Â  Â  kfree(swd);> +> + Â  Â  Â  return 0;> +}> +> +static struct platform_driver swim_driver = {> + Â  Â  Â  .probe Â = swim_probe,> + Â  Â  Â  .remove = __devexit_p(swim_remove),> + Â  Â  Â  .driver Â  = {> + Â  Â  Â  Â  Â  Â  Â  .name Â  = CARDNAME,> + Â  Â  Â  Â  Â  Â  Â  .owner Â = THIS_MODULE,> + Â  Â  Â  },> +};> +> +static int __init swim_init(void)> +{> + Â  Â  Â  printk(KERN_INFO "SWIM floppy driver %s\n", DRIVER_VERSION);> +> + Â  Â  Â  return platform_driver_register(&swim_driver);> +}> +module_init(swim_init);> +> +static void __exit swim_exit(void)> +{> + Â  Â  Â  platform_driver_unregister(&swim_driver);> +}> +module_exit(swim_exit);> +> +MODULE_DESCRIPTION("Driver for SWIM floppy controller");> +MODULE_LICENSE("GPL");> +MODULE_AUTHOR("Laurent Vivier <laurent@lvivier.info>");> +MODULE_ALIAS_BLOCKDEV_MAJOR(FLOPPY_MAJOR);> diff --git a/drivers/block/swim_asm.S b/drivers/block/swim_asm.S> new file mode 100644> index 0000000..c966820> --- /dev/null> +++ b/drivers/block/swim_asm.S> @@ -0,0 +1,247 @@> +/*> + * low-level functions for the SWIM floppy controller> + *> + * needs assembly language because is very timing dependent> + * this controller exists only on macintosh 680x0 based> + *> + * Copyright (C) 2004,2008 Laurent Vivier <Laurent@lvivier.info>> + *> + * based on Alastair Bridgewater SWIM analysis, 2001> + * based on netBSD IWM driver (c) 1997, 1998 Hauke Fath.> + *> + * This program is free software; you can redistribute it and/or> + * modify it under the terms of the GNU General Public License> + * as published by the Free Software Foundation; either version> + * 2 of the License, or (at your option) any later version.> + *> + * 2004-08-21 (lv) - Initial implementation> + * 2008-11-05 (lv) - add get_swim_mode> + */> +> + Â  Â  Â  .equ Â  Â write_data, Â  Â  0x0000> + Â  Â  Â  .equ Â  Â write_mark, Â  Â  0x0200> + Â  Â  Â  .equ Â  Â write_CRC, Â  Â  Â 0x0400> + Â  Â  Â  .equ Â  Â write_parameter,0x0600> + Â  Â  Â  .equ Â  Â write_phase, Â  Â 0x0800> + Â  Â  Â  .equ Â  Â write_setup, Â  Â 0x0a00> + Â  Â  Â  .equ Â  Â write_mode0, Â  Â 0x0c00> + Â  Â  Â  .equ Â  Â write_mode1, Â  Â 0x0e00> + Â  Â  Â  .equ Â  Â read_data, Â  Â  Â 0x1000> + Â  Â  Â  .equ Â  Â read_mark, Â  Â  Â 0x1200> + Â  Â  Â  .equ Â  Â read_error, Â  Â  0x1400> + Â  Â  Â  .equ Â  Â read_parameter, 0x1600> + Â  Â  Â  .equ Â  Â read_phase, Â  Â  0x1800> + Â  Â  Â  .equ Â  Â read_setup, Â  Â  0x1a00> + Â  Â  Â  .equ Â  Â read_status, Â  Â 0x1c00> + Â  Â  Â  .equ Â  Â read_handshake, 0x1e00> +> + Â  Â  Â  .equ Â  Â o_side, 0> + Â  Â  Â  .equ Â  Â o_track, 1> + Â  Â  Â  .equ Â  Â o_sector, 2> + Â  Â  Â  .equ Â  Â o_size, 3> + Â  Â  Â  .equ Â  Â o_crc0, 4> + Â  Â  Â  .equ Â  Â o_crc1, 5> +> + Â  Â  Â  .equ Â  Â seek_time, 30000> + Â  Â  Â  .equ Â  Â max_retry, 40> + Â  Â  Â  .equ Â  Â sector_size, 512> +> + Â  Â  Â  .global swim_read_sector_header> +swim_read_sector_header:> + Â  Â  Â  link Â  Â %a6, #0> + Â  Â  Â  moveml Â %d1-%d5/%a0-%a4,%sp@-> + Â  Â  Â  movel Â  %a6@(0x0c), %a4> + Â  Â  Â  bsr Â  Â  mfm_read_addrmark> + Â  Â  Â  moveml Â %sp@+, %d1-%d5/%a0-%a4> + Â  Â  Â  unlk Â  Â %a6> + Â  Â  Â  rts> +> +sector_address_mark:> + Â  Â  Â  .byte Â  0xa1, 0xa1, 0xa1, 0xfe> +sector_data_mark:> + Â  Â  Â  .byte Â  0xa1, 0xa1, 0xa1, 0xfb> +> +mfm_read_addrmark:> + Â  Â  Â  movel Â  %a6@(0x08), %a3> + Â  Â  Â  lea Â  Â  %a3@(read_handshake), %a2> + Â  Â  Â  lea Â  Â  %a3@(read_mark), %a3> + Â  Â  Â  moveq Â  #-1, %d0> + Â  Â  Â  movew Â  #seek_time, %d2> +> +wait_header_init:> + Â  Â  Â  tstb Â  Â %a3@(read_error - read_mark)> + Â  Â  Â  moveb Â  #0x18, %a3@(write_mode0 - read_mark)> + Â  Â  Â  moveb Â  #0x01, %a3@(write_mode1 - read_mark)> + Â  Â  Â  moveb Â  #0x01, %a3@(write_mode0 - read_mark)> + Â  Â  Â  tstb Â  Â %a3@(read_error - read_mark)> + Â  Â  Â  moveb Â  #0x08, %a3@(write_mode1 - read_mark)> +> + Â  Â  Â  lea Â  Â  sector_address_mark, %a0> + Â  Â  Â  moveq Â  #3, %d1> +> +wait_addr_mark_byte:> +> + Â  Â  Â  tstb Â  Â %a2@> + Â  Â  Â  dbmi Â  Â %d2, wait_addr_mark_byte> + Â  Â  Â  bpl Â  Â  header_exit> +> + Â  Â  Â  moveb Â  %a3@, %d3> + Â  Â  Â  cmpb Â  Â %a0@+, %d3> + Â  Â  Â  dbne Â  Â %d1, wait_addr_mark_byte> + Â  Â  Â  bne Â  Â  wait_header_init> +> + Â  Â  Â  moveq Â  #max_retry, %d2> +> +amark0: Â  Â  Â  Â tstb Â  Â %a2@> + Â  Â  Â  dbmi Â  Â %d2, amark0> + Â  Â  Â  bpl Â  Â  signal_nonyb> +> + Â  Â  Â  moveb Â  %a3@, %a4@(o_track)> +> + Â  Â  Â  moveq Â  #max_retry, %d2> +> +amark1: Â  Â  Â  Â tstb Â  Â %a2@> + Â  Â  Â  dbmi Â  Â %d2, amark1> + Â  Â  Â  bpl Â  Â  signal_nonyb> +> + Â  Â  Â  moveb Â  %a3@, %a4@(o_side)> +> + Â  Â  Â  moveq Â  #max_retry, %d2> +> +amark2: Â  Â  Â  Â tstb Â  Â %a2@> + Â  Â  Â  dbmi Â  Â %d2, amark2> + Â  Â  Â  bpl Â  Â  signal_nonyb> +> + Â  Â  Â  moveb Â  %a3@, %a4@(o_sector)> +> + Â  Â  Â  moveq Â  #max_retry, %d2> +> +amark3: Â  Â  Â  Â tstb Â  Â %a2@> + Â  Â  Â  dbmi Â  Â %d2, amark3> + Â  Â  Â  bpl Â  Â  signal_nonyb> +> + Â  Â  Â  moveb Â  %a3@, %a4@(o_size)> +> + Â  Â  Â  moveq Â  #max_retry, %d2> +> +crc0: Â tstb Â  Â %a2@> + Â  Â  Â  dbmi Â  Â %d2, crc0> + Â  Â  Â  bpl Â  Â  signal_nonyb> +> + Â  Â  Â  moveb Â  %a3@, %a4@(o_crc0)> +> + Â  Â  Â  moveq Â  #max_retry, %d2> +> +crc1: Â tstb Â  Â %a2@> + Â  Â  Â  dbmi Â  Â %d2, crc1> + Â  Â  Â  bpl Â  Â  signal_nonyb> +> + Â  Â  Â  moveb Â  %a3@, %a4@(o_crc1)> +> + Â  Â  Â  tstb Â  Â %a3@(read_error - read_mark)> +> +header_exit:> + Â  Â  Â  moveq Â  #0, %d0> + Â  Â  Â  moveb Â  #0x18, %a3@(write_mode0 - read_mark)> + Â  Â  Â  rts> +signal_nonyb:> + Â  Â  Â  moveq Â  #-1, %d0> + Â  Â  Â  moveb Â  #0x18, %a3@(write_mode0 - read_mark)> + Â  Â  Â  rts> +> + Â  Â  Â  .global swim_read_sector_data> +swim_read_sector_data:> + Â  Â  Â  link Â  Â %a6, #0> + Â  Â  Â  moveml Â %d1-%d5/%a0-%a5,%sp@-> + Â  Â  Â  movel Â  %a6@(0x0c), %a4> + Â  Â  Â  bsr Â  Â  mfm_read_data> + Â  Â  Â  moveml Â %sp@+, %d1-%d5/%a0-%a5> + Â  Â  Â  unlk Â  Â %a6> + Â  Â  Â  rts> +> +mfm_read_data:> + Â  Â  Â  movel Â  %a6@(0x08), %a3> + Â  Â  Â  lea Â  Â  %a3@(read_handshake), %a2> + Â  Â  Â  lea Â  Â  %a3@(read_data), %a5> + Â  Â  Â  lea Â  Â  %a3@(read_mark), %a3> + Â  Â  Â  movew Â  #seek_time, %d2> +> +wait_data_init:> + Â  Â  Â  tstb Â  Â %a3@(read_error - read_mark)> + Â  Â  Â  moveb Â  #0x18, %a3@(write_mode0 - read_mark)> + Â  Â  Â  moveb Â  #0x01, %a3@(write_mode1 - read_mark)> + Â  Â  Â  moveb Â  #0x01, %a3@(write_mode0 - read_mark)> + Â  Â  Â  tstb Â  Â %a3@(read_error - read_mark)> + Â  Â  Â  moveb Â  #0x08, %a3@(write_mode1 - read_mark)> +> + Â  Â  Â  lea Â  Â  sector_data_mark, %a0> + Â  Â  Â  moveq Â  #3, %d1> +> + Â  Â  Â  /* wait data address mark */> +> +wait_data_mark_byte:> +> + Â  Â  Â  tstb Â  Â %a2@> + Â  Â  Â  dbmi Â  Â %d2, wait_data_mark_byte> + Â  Â  Â  bpl Â  Â  data_exit> +> + Â  Â  Â  moveb Â  %a3@, %d3> + Â  Â  Â  cmpb Â  Â %a0@+, %d3> + Â  Â  Â  dbne Â  Â %d1, wait_data_mark_byte> + Â  Â  Â  bne Â  Â  wait_data_init> +> + Â  Â  Â  /* read data */> +> + Â  Â  Â  tstb Â  Â %a3@(read_error - read_mark)> +> + Â  Â  Â  movel Â  #sector_size-1, %d4 Â  Â  Â  Â  Â  Â  /* sector size */> +read_new_data:> + Â  Â  Â  movew Â  #max_retry, %d2> +read_data_loop:> + Â  Â  Â  moveb Â  %a2@, %d5> + Â  Â  Â  andb Â  Â #0xc0, %d5> + Â  Â  Â  dbne Â  Â %d2, read_data_loop> + Â  Â  Â  beq Â  Â  data_exit> + Â  Â  Â  moveb Â  %a5@, %a4@+> + Â  Â  Â  andb Â  Â #0x40, %d5> + Â  Â  Â  dbne Â  Â %d4, read_new_data> + Â  Â  Â  beq Â  Â  exit_loop> + Â  Â  Â  moveb Â  %a5@, %a4@+> + Â  Â  Â  dbra Â  Â %d4, read_new_data> +exit_loop:> +> + Â  Â  Â  /* read CRC */> +> + Â  Â  Â  movew Â  #max_retry, %d2> +data_crc0:> +> + Â  Â  Â  tstb Â  Â %a2@> + Â  Â  Â  dbmi Â  Â %d2, data_crc0> + Â  Â  Â  bpl Â  Â  data_exit> +> + Â  Â  Â  moveb Â  %a3@, %d5> +> + Â  Â  Â  moveq Â  #max_retry, %d2> +> +data_crc1:> +> + Â  Â  Â  tstb Â  Â %a2@> + Â  Â  Â  dbmi Â  Â %d2, data_crc1> + Â  Â  Â  bpl Â  Â  data_exit> +> + Â  Â  Â  moveb Â  %a3@, %d5> +> + Â  Â  Â  tstb Â  Â %a3@(read_error - read_mark)> +> + Â  Â  Â  moveb Â  #0x18, %a3@(write_mode0 - read_mark)> +> + Â  Â  Â  /* return number of bytes read */> +> + Â  Â  Â  movel Â  #sector_size, %d0> + Â  Â  Â  addw Â  Â #1, %d4> + Â  Â  Â  subl Â  Â %d4, %d0> + Â  Â  Â  rts> +data_exit:> + Â  Â  Â  moveb Â  #0x18, %a3@(write_mode0 - read_mark)> + Â  Â  Â  moveq Â  #-1, %d0> + Â  Â  Â  rts> --> 1.6.1.3>>

-- Gr{oetje,eeting}s,
						Geert
--Geert Uytterhoeven -- There's lots of Linux beyond ia32 -- geert@linux-m68k.org
In personal conversations with technical people, I call myself a hacker. Butwhen I'm talking to journalists I just say "programmer" or something like that.							    -- Linus Torvaldsÿôèº{.nÇ+‰·Ÿ®‰†+%ŠËÿ±éÝ¶\x17¥Šwÿº{.nÇ+‰·¥Š{±þG«éÿŠ{ayº\x1dÊ‡Ú™ë,j\a¢f£¢·hšïêÿ‘êçz_è®\x03(éšŽŠÝ¢j"ú\x1a¶^[m§ÿÿ¾\a«þG«éÿ¢¸?™¨èÚ&£ø§~á¶iO•æ¬z·švØ^\x14\x04\x1a¶^[m§ÿÿÃ\fÿ¶ìÿ¢¸?–I¥

^ permalink raw reply	[flat|nested] 9+ messages in thread

* Re: [PATCH 3/6] m68k: mac - Add SWIM floppy support
  2009-03-25 14:55       ` [PATCH 3/6] m68k: mac - Add SWIM floppy support Geert Uytterhoeven
@ 2009-03-25 15:28         ` Jens Axboe
  0 siblings, 0 replies; 9+ messages in thread
From: Jens Axboe @ 2009-03-25 15:28 UTC (permalink / raw)
  To: Geert Uytterhoeven; +Cc: linux-kernel, Laurent Vivier, linux-m68k

On Wed, Mar 25 2009, Geert Uytterhoeven wrote:
> Hi Jens,
> 
> Is this OK for you to go in through the m68k tree?

Sure!

> 
> Thanks!
> 
> On Sun, Mar 1, 2009 at 10:21, Geert Uytterhoeven <geert@linux-m68k.org> wrote:
> > From: Laurent Vivier <laurent@lvivier.info>
> >
> > It allows to read data from a floppy, but not to write to, and to eject the
> > floppy (useful on our Mac without eject button).
> >
> > Signed-off-by: Laurent Vivier <Laurent@lvivier.info>
> > Signed-off-by: Geert Uytterhoeven <geert@linux-m68k.org>
> > Cc: Jens Axboe <axboe@kernel.dk>
> > ---
> >  arch/m68k/mac/config.c   |   44 ++
> >  arch/m68k/mac/via.c      |    9 +
> >  drivers/block/Kconfig    |    7 +
> >  drivers/block/Makefile   |    3 +
> >  drivers/block/swim.c     |  995 ++++++++++++++++++++++++++++++++++++++++++++++
> >  drivers/block/swim_asm.S |  247 ++++++++++++
> >  6 files changed, 1305 insertions(+), 0 deletions(-)
> >  create mode 100644 drivers/block/swim.c
> >  create mode 100644 drivers/block/swim_asm.S
> >
> > diff --git a/arch/m68k/mac/config.c b/arch/m68k/mac/config.c
> > index 3a1c0b2..be01798 100644
> > --- a/arch/m68k/mac/config.c
> > +++ b/arch/m68k/mac/config.c
> > @@ -22,6 +22,7 @@
> >  /* keyb */
> >  #include <linux/init.h>
> >  #include <linux/vt_kern.h>
> > +#include <linux/platform_device.h>
> >
> >  #define BOOTINFO_COMPAT_1_0
> >  #include <asm/setup.h>
> > @@ -43,6 +44,10 @@
> >  #include <asm/mac_oss.h>
> >  #include <asm/mac_psc.h>
> >
> > +/* platform device info */
> > +
> > +#define SWIM_IO_SIZE 0x2000    /* SWIM IO resource size */
> > +
> >  /* Mac bootinfo struct */
> >
> >  struct mac_booter_data mac_bi_data;
> > @@ -870,3 +875,42 @@ static void mac_get_model(char *str)
> >        strcpy(str, "Macintosh ");
> >        strcat(str, macintosh_config->name);
> >  }
> > +
> > +static struct resource swim_resources[1];
> > +
> > +static struct platform_device swim_device = {
> > +       .name           = "swim",
> > +       .id             = -1,
> > +       .num_resources  = ARRAY_SIZE(swim_resources),
> > +       .resource       = swim_resources,
> > +};
> > +
> > +static struct platform_device *mac_platform_devices[] __initdata = {
> > +       &swim_device
> > +};
> > +
> > +int __init mac_platform_init(void)
> > +{
> > +       u8 *swim_base;
> > +
> > +       switch (macintosh_config->floppy_type) {
> > +       case MAC_FLOPPY_SWIM_ADDR1:
> > +               swim_base = (u8 *)(VIA1_BASE + 0x1E000);
> > +               break;
> > +       case MAC_FLOPPY_SWIM_ADDR2:
> > +               swim_base = (u8 *)(VIA1_BASE + 0x16000);
> > +               break;
> > +       default:
> > +               return 0;
> > +       }
> > +
> > +       swim_resources[0].name = "swim-regs";
> > +       swim_resources[0].start = (resource_size_t)swim_base;
> > +       swim_resources[0].end = (resource_size_t)(swim_base + SWIM_IO_SIZE);
> > +       swim_resources[0].flags = IORESOURCE_MEM;
> > +
> > +       return platform_add_devices(mac_platform_devices,
> > +                                   ARRAY_SIZE(mac_platform_devices));
> > +}
> > +
> > +arch_initcall(mac_platform_init);
> > diff --git a/arch/m68k/mac/via.c b/arch/m68k/mac/via.c
> > index 7d97ba5..11bce3c 100644
> > --- a/arch/m68k/mac/via.c
> > +++ b/arch/m68k/mac/via.c
> > @@ -645,3 +645,12 @@ int via_irq_pending(int irq)
> >        }
> >        return 0;
> >  }
> > +
> > +void via1_set_head(int head)
> > +{
> > +       if (head == 0)
> > +               via1[vBufA] &= ~VIA1A_vHeadSel;
> > +       else
> > +               via1[vBufA] |= VIA1A_vHeadSel;
> > +}
> > +EXPORT_SYMBOL(via1_set_head);
> > diff --git a/drivers/block/Kconfig b/drivers/block/Kconfig
> > index 0344a8a..e7b8aa0 100644
> > --- a/drivers/block/Kconfig
> > +++ b/drivers/block/Kconfig
> > @@ -45,6 +45,13 @@ config MAC_FLOPPY
> >          If you have a SWIM-3 (Super Woz Integrated Machine 3; from Apple)
> >          floppy controller, say Y here. Most commonly found in PowerMacs.
> >
> > +config BLK_DEV_SWIM
> > +       tristate "Support for SWIM Macintosh floppy"
> > +       depends on M68K && MAC
> > +       help
> > +         You should select this option if you want floppy support
> > +         and you don't have a II, IIfx, Q900, Q950 or AV series.
> > +
> >  config AMIGA_Z2RAM
> >        tristate "Amiga Zorro II ramdisk support"
> >        depends on ZORRO
> > diff --git a/drivers/block/Makefile b/drivers/block/Makefile
> > index 204332b..b32b7f9 100644
> > --- a/drivers/block/Makefile
> > +++ b/drivers/block/Makefile
> > @@ -6,6 +6,7 @@
> >  #
> >
> >  obj-$(CONFIG_MAC_FLOPPY)       += swim3.o
> > +obj-$(CONFIG_BLK_DEV_SWIM)     += swim_mod.o
> >  obj-$(CONFIG_BLK_DEV_FD)       += floppy.o
> >  obj-$(CONFIG_AMIGA_FLOPPY)     += amiflop.o
> >  obj-$(CONFIG_PS3_DISK)         += ps3disk.o
> > @@ -32,3 +33,5 @@ obj-$(CONFIG_BLK_DEV_UB)      += ub.o
> >  obj-$(CONFIG_BLK_DEV_HD)       += hd.o
> >
> >  obj-$(CONFIG_XEN_BLKDEV_FRONTEND)      += xen-blkfront.o
> > +
> > +swim_mod-objs  := swim.o swim_asm.o
> > diff --git a/drivers/block/swim.c b/drivers/block/swim.c
> > new file mode 100644
> > index 0000000..d22cc38
> > --- /dev/null
> > +++ b/drivers/block/swim.c
> > @@ -0,0 +1,995 @@
> > +/*
> > + * Driver for SWIM (Sander Woz Integrated Machine) floppy controller
> > + *
> > + * Copyright (C) 2004,2008 Laurent Vivier <Laurent@lvivier.info>
> > + *
> > + * based on Alastair Bridgewater SWIM analysis, 2001
> > + * based on SWIM3 driver (c) Paul Mackerras, 1996
> > + * based on netBSD IWM driver (c) 1997, 1998 Hauke Fath.
> > + *
> > + * This program is free software; you can redistribute it and/or
> > + * modify it under the terms of the GNU General Public License
> > + * as published by the Free Software Foundation; either version
> > + * 2 of the License, or (at your option) any later version.
> > + *
> > + * 2004-08-21 (lv) - Initial implementation
> > + * 2008-10-30 (lv) - Port to 2.6
> > + */
> > +
> > +#include <linux/module.h>
> > +#include <linux/fd.h>
> > +#include <linux/blkdev.h>
> > +#include <linux/hdreg.h>
> > +#include <linux/kernel.h>
> > +#include <linux/delay.h>
> > +#include <linux/platform_device.h>
> > +
> > +#include <asm/macintosh.h>
> > +#include <asm/mac_via.h>
> > +
> > +#define CARDNAME "swim"
> > +
> > +struct sector_header {
> > +       unsigned char side;
> > +       unsigned char track;
> > +       unsigned char sector;
> > +       unsigned char size;
> > +       unsigned char crc0;
> > +       unsigned char crc1;
> > +} __attribute__((packed));
> > +
> > +#define DRIVER_VERSION "Version 0.2 (2008-10-30)"
> > +
> > +#define REG(x) unsigned char x, x ## _pad[0x200 - 1];
> > +
> > +struct swim {
> > +       REG(write_data)
> > +       REG(write_mark)
> > +       REG(write_CRC)
> > +       REG(write_parameter)
> > +       REG(write_phase)
> > +       REG(write_setup)
> > +       REG(write_mode0)
> > +       REG(write_mode1)
> > +
> > +       REG(read_data)
> > +       REG(read_mark)
> > +       REG(read_error)
> > +       REG(read_parameter)
> > +       REG(read_phase)
> > +       REG(read_setup)
> > +       REG(read_status)
> > +       REG(read_handshake)
> > +} __attribute__((packed));
> > +
> > +#define swim_write(base, reg, v)       out_8(&(base)->write_##reg, (v))
> > +#define swim_read(base, reg)           in_8(&(base)->read_##reg)
> > +
> > +/* IWM registers */
> > +
> > +struct iwm {
> > +       REG(ph0L)
> > +       REG(ph0H)
> > +       REG(ph1L)
> > +       REG(ph1H)
> > +       REG(ph2L)
> > +       REG(ph2H)
> > +       REG(ph3L)
> > +       REG(ph3H)
> > +       REG(mtrOff)
> > +       REG(mtrOn)
> > +       REG(intDrive)
> > +       REG(extDrive)
> > +       REG(q6L)
> > +       REG(q6H)
> > +       REG(q7L)
> > +       REG(q7H)
> > +} __attribute__((packed));
> > +
> > +#define iwm_write(base, reg, v)        out_8(&(base)->reg, (v))
> > +#define iwm_read(base, reg)            in_8(&(base)->reg)
> > +
> > +/* bits in phase register */
> > +
> > +#define SEEK_POSITIVE  0x070
> > +#define SEEK_NEGATIVE  0x074
> > +#define STEP           0x071
> > +#define MOTOR_ON       0x072
> > +#define MOTOR_OFF      0x076
> > +#define INDEX          0x073
> > +#define EJECT          0x077
> > +#define SETMFM         0x171
> > +#define SETGCR         0x175
> > +
> > +#define RELAX          0x033
> > +#define LSTRB          0x008
> > +
> > +#define CA_MASK                0x077
> > +
> > +/* Select values for swim_select and swim_readbit */
> > +
> > +#define READ_DATA_0    0x074
> > +#define TWOMEG_DRIVE   0x075
> > +#define SINGLE_SIDED   0x076
> > +#define DRIVE_PRESENT  0x077
> > +#define DISK_IN                0x170
> > +#define WRITE_PROT     0x171
> > +#define TRACK_ZERO     0x172
> > +#define TACHO          0x173
> > +#define READ_DATA_1    0x174
> > +#define MFM_MODE       0x175
> > +#define SEEK_COMPLETE  0x176
> > +#define ONEMEG_MEDIA   0x177
> > +
> > +/* Bits in handshake register */
> > +
> > +#define MARK_BYTE      0x01
> > +#define CRC_ZERO       0x02
> > +#define RDDATA         0x04
> > +#define SENSE          0x08
> > +#define MOTEN          0x10
> > +#define ERROR          0x20
> > +#define DAT2BYTE       0x40
> > +#define DAT1BYTE       0x80
> > +
> > +/* bits in setup register */
> > +
> > +#define S_INV_WDATA    0x01
> > +#define S_3_5_SELECT   0x02
> > +#define S_GCR          0x04
> > +#define S_FCLK_DIV2    0x08
> > +#define S_ERROR_CORR   0x10
> > +#define S_IBM_DRIVE    0x20
> > +#define S_GCR_WRITE    0x40
> > +#define S_TIMEOUT      0x80
> > +
> > +/* bits in mode register */
> > +
> > +#define CLFIFO         0x01
> > +#define ENBL1          0x02
> > +#define ENBL2          0x04
> > +#define ACTION         0x08
> > +#define WRITE_MODE     0x10
> > +#define HEDSEL         0x20
> > +#define MOTON          0x80
> > +
> > +/*----------------------------------------------------------------------------*/
> > +
> > +enum drive_location {
> > +       INTERNAL_DRIVE = 0x02,
> > +       EXTERNAL_DRIVE = 0x04,
> > +};
> > +
> > +enum media_type {
> > +       DD_MEDIA,
> > +       HD_MEDIA,
> > +};
> > +
> > +struct floppy_state {
> > +
> > +       /* physical properties */
> > +
> > +       enum drive_location location;   /* internal or external drive */
> > +       int              head_number;   /* single- or double-sided drive */
> > +
> > +       /* media */
> > +
> > +       int              disk_in;
> > +       int              ejected;
> > +       enum media_type  type;
> > +       int              write_protected;
> > +
> > +       int              total_secs;
> > +       int              secpercyl;
> > +       int              secpertrack;
> > +
> > +       /* in-use information */
> > +
> > +       int             track;
> > +       int             ref_count;
> > +
> > +       struct gendisk *disk;
> > +
> > +       /* parent controller */
> > +
> > +       struct swim_priv *swd;
> > +};
> > +
> > +enum motor_action {
> > +       OFF,
> > +       ON,
> > +};
> > +
> > +enum head {
> > +       LOWER_HEAD = 0,
> > +       UPPER_HEAD = 1,
> > +};
> > +
> > +#define FD_MAX_UNIT    2
> > +
> > +struct swim_priv {
> > +       struct swim __iomem *base;
> > +       spinlock_t lock;
> > +       struct request_queue *queue;
> > +       int floppy_count;
> > +       struct floppy_state unit[FD_MAX_UNIT];
> > +};
> > +
> > +extern int swim_read_sector_header(struct swim __iomem *base,
> > +                                  struct sector_header *header);
> > +extern int swim_read_sector_data(struct swim __iomem *base,
> > +                                unsigned char *data);
> > +
> > +static inline void set_swim_mode(struct swim __iomem *base, int enable)
> > +{
> > +       struct iwm __iomem *iwm_base;
> > +       unsigned long flags;
> > +
> > +       if (!enable) {
> > +               swim_write(base, mode0, 0xf8);
> > +               return;
> > +       }
> > +
> > +       iwm_base = (struct iwm __iomem *)base;
> > +       local_irq_save(flags);
> > +
> > +       iwm_read(iwm_base, q7L);
> > +       iwm_read(iwm_base, mtrOff);
> > +       iwm_read(iwm_base, q6H);
> > +
> > +       iwm_write(iwm_base, q7H, 0x57);
> > +       iwm_write(iwm_base, q7H, 0x17);
> > +       iwm_write(iwm_base, q7H, 0x57);
> > +       iwm_write(iwm_base, q7H, 0x57);
> > +
> > +       local_irq_restore(flags);
> > +}
> > +
> > +static inline int get_swim_mode(struct swim __iomem *base)
> > +{
> > +       unsigned long flags;
> > +
> > +       local_irq_save(flags);
> > +
> > +       swim_write(base, phase, 0xf5);
> > +       if (swim_read(base, phase) != 0xf5)
> > +               goto is_iwm;
> > +       swim_write(base, phase, 0xf6);
> > +       if (swim_read(base, phase) != 0xf6)
> > +               goto is_iwm;
> > +       swim_write(base, phase, 0xf7);
> > +       if (swim_read(base, phase) != 0xf7)
> > +               goto is_iwm;
> > +       local_irq_restore(flags);
> > +       return 1;
> > +is_iwm:
> > +       local_irq_restore(flags);
> > +       return 0;
> > +}
> > +
> > +static inline void swim_select(struct swim __iomem *base, int sel)
> > +{
> > +       swim_write(base, phase, RELAX);
> > +
> > +       via1_set_head(sel & 0x100);
> > +
> > +       swim_write(base, phase, sel & CA_MASK);
> > +}
> > +
> > +static inline void swim_action(struct swim __iomem *base, int action)
> > +{
> > +       unsigned long flags;
> > +
> > +       local_irq_save(flags);
> > +
> > +       swim_select(base, action);
> > +       udelay(1);
> > +       swim_write(base, phase, (LSTRB<<4) | LSTRB);
> > +       udelay(1);
> > +       swim_write(base, phase, (LSTRB<<4) | ((~LSTRB) & 0x0F));
> > +       udelay(1);
> > +
> > +       local_irq_restore(flags);
> > +}
> > +
> > +static inline int swim_readbit(struct swim __iomem *base, int bit)
> > +{
> > +       int stat;
> > +
> > +       swim_select(base, bit);
> > +
> > +       udelay(10);
> > +
> > +       stat = swim_read(base, handshake);
> > +
> > +       return (stat & SENSE) == 0;
> > +}
> > +
> > +static inline void swim_drive(struct swim __iomem *base,
> > +                             enum drive_location location)
> > +{
> > +       if (location == INTERNAL_DRIVE) {
> > +               swim_write(base, mode0, EXTERNAL_DRIVE); /* clear drive 1 bit */
> > +               swim_write(base, mode1, INTERNAL_DRIVE); /* set drive 0 bit */
> > +       } else if (location == EXTERNAL_DRIVE) {
> > +               swim_write(base, mode0, INTERNAL_DRIVE); /* clear drive 0 bit */
> > +               swim_write(base, mode1, EXTERNAL_DRIVE); /* set drive 1 bit */
> > +       }
> > +}
> > +
> > +static inline void swim_motor(struct swim __iomem *base,
> > +                             enum motor_action action)
> > +{
> > +       if (action == ON) {
> > +               int i;
> > +
> > +               swim_action(base, MOTOR_ON);
> > +
> > +               for (i = 0; i < 2*HZ; i++) {
> > +                       swim_select(base, RELAX);
> > +                       if (swim_readbit(base, MOTOR_ON))
> > +                               break;
> > +                       current->state = TASK_INTERRUPTIBLE;
> > +                       schedule_timeout(1);
> > +               }
> > +       } else if (action == OFF) {
> > +               swim_action(base, MOTOR_OFF);
> > +               swim_select(base, RELAX);
> > +       }
> > +}
> > +
> > +static inline void swim_eject(struct swim __iomem *base)
> > +{
> > +       int i;
> > +
> > +       swim_action(base, EJECT);
> > +
> > +       for (i = 0; i < 2*HZ; i++) {
> > +               swim_select(base, RELAX);
> > +               if (!swim_readbit(base, DISK_IN))
> > +                       break;
> > +               current->state = TASK_INTERRUPTIBLE;
> > +               schedule_timeout(1);
> > +       }
> > +       swim_select(base, RELAX);
> > +}
> > +
> > +static inline void swim_head(struct swim __iomem *base, enum head head)
> > +{
> > +       /* wait drive is ready */
> > +
> > +       if (head == UPPER_HEAD)
> > +               swim_select(base, READ_DATA_1);
> > +       else if (head == LOWER_HEAD)
> > +               swim_select(base, READ_DATA_0);
> > +}
> > +
> > +static inline int swim_step(struct swim __iomem *base)
> > +{
> > +       int wait;
> > +
> > +       swim_action(base, STEP);
> > +
> > +       for (wait = 0; wait < HZ; wait++) {
> > +
> > +               current->state = TASK_INTERRUPTIBLE;
> > +               schedule_timeout(1);
> > +
> > +               swim_select(base, RELAX);
> > +               if (!swim_readbit(base, STEP))
> > +                       return 0;
> > +       }
> > +       return -1;
> > +}
> > +
> > +static inline int swim_track00(struct swim __iomem *base)
> > +{
> > +       int try;
> > +
> > +       swim_action(base, SEEK_NEGATIVE);
> > +
> > +       for (try = 0; try < 100; try++) {
> > +
> > +               swim_select(base, RELAX);
> > +               if (swim_readbit(base, TRACK_ZERO))
> > +                       break;
> > +
> > +               if (swim_step(base))
> > +                       return -1;
> > +       }
> > +
> > +       if (swim_readbit(base, TRACK_ZERO))
> > +               return 0;
> > +
> > +       return -1;
> > +}
> > +
> > +static inline int swim_seek(struct swim __iomem *base, int step)
> > +{
> > +       if (step == 0)
> > +               return 0;
> > +
> > +       if (step < 0) {
> > +               swim_action(base, SEEK_NEGATIVE);
> > +               step = -step;
> > +       } else
> > +               swim_action(base, SEEK_POSITIVE);
> > +
> > +       for ( ; step > 0; step--) {
> > +               if (swim_step(base))
> > +                       return -1;
> > +       }
> > +
> > +       return 0;
> > +}
> > +
> > +static inline int swim_track(struct floppy_state *fs,  int track)
> > +{
> > +       struct swim __iomem *base = fs->swd->base;
> > +       int ret;
> > +
> > +       ret = swim_seek(base, track - fs->track);
> > +
> > +       if (ret == 0)
> > +               fs->track = track;
> > +       else {
> > +               swim_track00(base);
> > +               fs->track = 0;
> > +       }
> > +
> > +       return ret;
> > +}
> > +
> > +static int floppy_eject(struct floppy_state *fs)
> > +{
> > +       struct swim __iomem *base = fs->swd->base;
> > +
> > +       swim_drive(base, fs->location);
> > +       swim_motor(base, OFF);
> > +       swim_eject(base);
> > +
> > +       fs->disk_in = 0;
> > +       fs->ejected = 1;
> > +
> > +       return 0;
> > +}
> > +
> > +static inline int swim_read_sector(struct floppy_state *fs,
> > +                                  int side, int track,
> > +                                  int sector, unsigned char *buffer)
> > +{
> > +       struct swim __iomem *base = fs->swd->base;
> > +       unsigned long flags;
> > +       struct sector_header header;
> > +       int ret = -1;
> > +       short i;
> > +
> > +       swim_track(fs, track);
> > +
> > +       swim_write(base, mode1, MOTON);
> > +       swim_head(base, side);
> > +       swim_write(base, mode0, side);
> > +
> > +       local_irq_save(flags);
> > +       for (i = 0; i < 36; i++) {
> > +               ret = swim_read_sector_header(base, &header);
> > +               if (!ret && (header.sector == sector)) {
> > +                       /* found */
> > +
> > +                       ret = swim_read_sector_data(base, buffer);
> > +                       break;
> > +               }
> > +       }
> > +       local_irq_restore(flags);
> > +
> > +       swim_write(base, mode0, MOTON);
> > +
> > +       if ((header.side != side)  || (header.track != track) ||
> > +            (header.sector != sector))
> > +               return 0;
> > +
> > +       return ret;
> > +}
> > +
> > +static int floppy_read_sectors(struct floppy_state *fs,
> > +                              int req_sector, int sectors_nb,
> > +                              unsigned char *buffer)
> > +{
> > +       struct swim __iomem *base = fs->swd->base;
> > +       int ret;
> > +       int side, track, sector;
> > +       int i, try;
> > +
> > +
> > +       swim_drive(base, fs->location);
> > +       for (i = req_sector; i < req_sector + sectors_nb; i++) {
> > +               int x;
> > +               track = i / fs->secpercyl;
> > +               x = i % fs->secpercyl;
> > +               side = x / fs->secpertrack;
> > +               sector = x % fs->secpertrack + 1;
> > +
> > +               try = 5;
> > +               do {
> > +                       ret = swim_read_sector(fs, side, track, sector,
> > +                                               buffer);
> > +                       if (try-- == 0)
> > +                               return -1;
> > +               } while (ret != 512);
> > +
> > +               buffer += ret;
> > +       }
> > +
> > +       return 0;
> > +}
> > +
> > +static void redo_fd_request(struct request_queue *q)
> > +{
> > +       struct request *req;
> > +       struct floppy_state *fs;
> > +
> > +       while ((req = elv_next_request(q))) {
> > +
> > +               fs = req->rq_disk->private_data;
> > +               if (req->sector < 0 || req->sector >= fs->total_secs) {
> > +                       end_request(req, 0);
> > +                       continue;
> > +               }
> > +               if (req->current_nr_sectors == 0) {
> > +                       end_request(req, 1);
> > +                       continue;
> > +               }
> > +               if (!fs->disk_in) {
> > +                       end_request(req, 0);
> > +                       continue;
> > +               }
> > +               if (rq_data_dir(req) == WRITE) {
> > +                       if (fs->write_protected) {
> > +                               end_request(req, 0);
> > +                               continue;
> > +                       }
> > +               }
> > +               switch (rq_data_dir(req)) {
> > +               case WRITE:
> > +                       /* NOT IMPLEMENTED */
> > +                       end_request(req, 0);
> > +                       break;
> > +               case READ:
> > +                       if (floppy_read_sectors(fs, req->sector,
> > +                                               req->current_nr_sectors,
> > +                                               req->buffer)) {
> > +                               end_request(req, 0);
> > +                               continue;
> > +                       }
> > +                       req->nr_sectors -= req->current_nr_sectors;
> > +                       req->sector += req->current_nr_sectors;
> > +                       req->buffer += req->current_nr_sectors * 512;
> > +                       end_request(req, 1);
> > +                       break;
> > +               }
> > +       }
> > +}
> > +
> > +static void do_fd_request(struct request_queue *q)
> > +{
> > +       redo_fd_request(q);
> > +}
> > +
> > +static struct floppy_struct floppy_type[4] = {
> > +       {    0,  0, 0,  0, 0, 0x00, 0x00, 0x00, 0x00, NULL }, /* no testing   */
> > +       {  720,  9, 1, 80, 0, 0x2A, 0x02, 0xDF, 0x50, NULL }, /* 360KB SS 3.5"*/
> > +       { 1440,  9, 2, 80, 0, 0x2A, 0x02, 0xDF, 0x50, NULL }, /* 720KB 3.5"   */
> > +       { 2880, 18, 2, 80, 0, 0x1B, 0x00, 0xCF, 0x6C, NULL }, /* 1.44MB 3.5"  */
> > +};
> > +
> > +static int get_floppy_geometry(struct floppy_state *fs, int type,
> > +                              struct floppy_struct **g)
> > +{
> > +       if (type >= ARRAY_SIZE(floppy_type))
> > +               return -EINVAL;
> > +
> > +       if (type)
> > +               *g = &floppy_type[type];
> > +       else if (fs->type == HD_MEDIA) /* High-Density media */
> > +               *g = &floppy_type[3];
> > +       else if (fs->head_number == 2) /* double-sided */
> > +               *g = &floppy_type[2];
> > +       else
> > +               *g = &floppy_type[1];
> > +
> > +       return 0;
> > +}
> > +
> > +static void setup_medium(struct floppy_state *fs)
> > +{
> > +       struct swim __iomem *base = fs->swd->base;
> > +
> > +       if (swim_readbit(base, DISK_IN)) {
> > +               struct floppy_struct *g;
> > +               fs->disk_in = 1;
> > +               fs->write_protected = swim_readbit(base, WRITE_PROT);
> > +               fs->type = swim_readbit(base, ONEMEG_MEDIA);
> > +
> > +               if (swim_track00(base))
> > +                       printk(KERN_ERR
> > +                               "SWIM: cannot move floppy head to track 0\n");
> > +
> > +               swim_track00(base);
> > +
> > +               get_floppy_geometry(fs, 0, &g);
> > +               fs->total_secs = g->size;
> > +               fs->secpercyl = g->head * g->sect;
> > +               fs->secpertrack = g->sect;
> > +               fs->track = 0;
> > +       } else {
> > +               fs->disk_in = 0;
> > +       }
> > +}
> > +
> > +static int floppy_open(struct block_device *bdev, fmode_t mode)
> > +{
> > +       struct floppy_state *fs = bdev->bd_disk->private_data;
> > +       struct swim __iomem *base = fs->swd->base;
> > +       int err;
> > +
> > +       if (fs->ref_count == -1 || (fs->ref_count && mode & FMODE_EXCL))
> > +               return -EBUSY;
> > +
> > +       if (mode & FMODE_EXCL)
> > +               fs->ref_count = -1;
> > +       else
> > +               fs->ref_count++;
> > +
> > +       swim_write(base, setup, S_IBM_DRIVE  | S_FCLK_DIV2);
> > +       udelay(10);
> > +       swim_drive(base, INTERNAL_DRIVE);
> > +       swim_motor(base, ON);
> > +       swim_action(base, SETMFM);
> > +       if (fs->ejected)
> > +               setup_medium(fs);
> > +       if (!fs->disk_in) {
> > +               err = -ENXIO;
> > +               goto out;
> > +       }
> > +
> > +       if (mode & FMODE_NDELAY)
> > +               return 0;
> > +
> > +       if (mode & (FMODE_READ|FMODE_WRITE)) {
> > +               check_disk_change(bdev);
> > +               if ((mode & FMODE_WRITE) && fs->write_protected) {
> > +                       err = -EROFS;
> > +                       goto out;
> > +               }
> > +       }
> > +       return 0;
> > +out:
> > +       if (fs->ref_count < 0)
> > +               fs->ref_count = 0;
> > +       else if (fs->ref_count > 0)
> > +               --fs->ref_count;
> > +
> > +       if (fs->ref_count == 0)
> > +               swim_motor(base, OFF);
> > +       return err;
> > +}
> > +
> > +static int floppy_release(struct gendisk *disk, fmode_t mode)
> > +{
> > +       struct floppy_state *fs = disk->private_data;
> > +       struct swim __iomem *base = fs->swd->base;
> > +
> > +       if (fs->ref_count < 0)
> > +               fs->ref_count = 0;
> > +       else if (fs->ref_count > 0)
> > +               --fs->ref_count;
> > +
> > +       if (fs->ref_count == 0)
> > +               swim_motor(base, OFF);
> > +
> > +       return 0;
> > +}
> > +
> > +static int floppy_ioctl(struct block_device *bdev, fmode_t mode,
> > +                       unsigned int cmd, unsigned long param)
> > +{
> > +       struct floppy_state *fs = bdev->bd_disk->private_data;
> > +       int err;
> > +
> > +       if ((cmd & 0x80) && !capable(CAP_SYS_ADMIN))
> > +                       return -EPERM;
> > +
> > +       switch (cmd) {
> > +       case FDEJECT:
> > +               if (fs->ref_count != 1)
> > +                       return -EBUSY;
> > +               err = floppy_eject(fs);
> > +               return err;
> > +
> > +       case FDGETPRM:
> > +               if (copy_to_user((void __user *) param, (void *) &floppy_type,
> > +                                sizeof(struct floppy_struct)))
> > +                       return -EFAULT;
> > +               break;
> > +
> > +       default:
> > +               printk(KERN_DEBUG "SWIM floppy_ioctl: unknown cmd %d\n",
> > +                      cmd);
> > +               return -ENOSYS;
> > +       }
> > +       return 0;
> > +}
> > +
> > +static int floppy_getgeo(struct block_device *bdev, struct hd_geometry *geo)
> > +{
> > +       struct floppy_state *fs = bdev->bd_disk->private_data;
> > +       struct floppy_struct *g;
> > +       int ret;
> > +
> > +       ret = get_floppy_geometry(fs, 0, &g);
> > +       if (ret)
> > +               return ret;
> > +
> > +       geo->heads = g->head;
> > +       geo->sectors = g->sect;
> > +       geo->cylinders = g->track;
> > +
> > +       return 0;
> > +}
> > +
> > +static int floppy_check_change(struct gendisk *disk)
> > +{
> > +       struct floppy_state *fs = disk->private_data;
> > +
> > +       return fs->ejected;
> > +}
> > +
> > +static int floppy_revalidate(struct gendisk *disk)
> > +{
> > +       struct floppy_state *fs = disk->private_data;
> > +       struct swim __iomem *base = fs->swd->base;
> > +
> > +       swim_drive(base, fs->location);
> > +
> > +       if (fs->ejected)
> > +               setup_medium(fs);
> > +
> > +       if (!fs->disk_in)
> > +               swim_motor(base, OFF);
> > +       else
> > +               fs->ejected = 0;
> > +
> > +       return !fs->disk_in;
> > +}
> > +
> > +static struct block_device_operations floppy_fops = {
> > +       .owner           = THIS_MODULE,
> > +       .open            = floppy_open,
> > +       .release         = floppy_release,
> > +       .locked_ioctl    = floppy_ioctl,
> > +       .getgeo          = floppy_getgeo,
> > +       .media_changed   = floppy_check_change,
> > +       .revalidate_disk = floppy_revalidate,
> > +};
> > +
> > +static struct kobject *floppy_find(dev_t dev, int *part, void *data)
> > +{
> > +       struct swim_priv *swd = data;
> > +       int drive = (*part & 3);
> > +
> > +       if (drive > swd->floppy_count)
> > +               return NULL;
> > +
> > +       *part = 0;
> > +       return get_disk(swd->unit[drive].disk);
> > +}
> > +
> > +static int __devinit swim_add_floppy(struct swim_priv *swd,
> > +                                    enum drive_location location)
> > +{
> > +       struct floppy_state *fs = &swd->unit[swd->floppy_count];
> > +       struct swim __iomem *base = swd->base;
> > +
> > +       fs->location = location;
> > +
> > +       swim_drive(base, location);
> > +
> > +       swim_motor(base, OFF);
> > +
> > +       if (swim_readbit(base, SINGLE_SIDED))
> > +               fs->head_number = 1;
> > +       else
> > +               fs->head_number = 2;
> > +       fs->ref_count = 0;
> > +       fs->ejected = 1;
> > +
> > +       swd->floppy_count++;
> > +
> > +       return 0;
> > +}
> > +
> > +static int __devinit swim_floppy_init(struct swim_priv *swd)
> > +{
> > +       int err;
> > +       int drive;
> > +       struct swim __iomem *base = swd->base;
> > +
> > +       /* scan floppy drives */
> > +
> > +       swim_drive(base, INTERNAL_DRIVE);
> > +       if (swim_readbit(base, DRIVE_PRESENT))
> > +               swim_add_floppy(swd, INTERNAL_DRIVE);
> > +       swim_drive(base, EXTERNAL_DRIVE);
> > +       if (swim_readbit(base, DRIVE_PRESENT))
> > +               swim_add_floppy(swd, EXTERNAL_DRIVE);
> > +
> > +       /* register floppy drives */
> > +
> > +       err = register_blkdev(FLOPPY_MAJOR, "fd");
> > +       if (err) {
> > +               printk(KERN_ERR "Unable to get major %d for SWIM floppy\n",
> > +                      FLOPPY_MAJOR);
> > +               return -EBUSY;
> > +       }
> > +
> > +       for (drive = 0; drive < swd->floppy_count; drive++) {
> > +               swd->unit[drive].disk = alloc_disk(1);
> > +               if (swd->unit[drive].disk == NULL) {
> > +                       err = -ENOMEM;
> > +                       goto exit_put_disks;
> > +               }
> > +               swd->unit[drive].swd = swd;
> > +       }
> > +
> > +       swd->queue = blk_init_queue(do_fd_request, &swd->lock);
> > +       if (!swd->queue) {
> > +               err = -ENOMEM;
> > +               goto exit_put_disks;
> > +       }
> > +
> > +       for (drive = 0; drive < swd->floppy_count; drive++) {
> > +               swd->unit[drive].disk->flags = GENHD_FL_REMOVABLE;
> > +               swd->unit[drive].disk->major = FLOPPY_MAJOR;
> > +               swd->unit[drive].disk->first_minor = drive;
> > +               sprintf(swd->unit[drive].disk->disk_name, "fd%d", drive);
> > +               swd->unit[drive].disk->fops = &floppy_fops;
> > +               swd->unit[drive].disk->private_data = &swd->unit[drive];
> > +               swd->unit[drive].disk->queue = swd->queue;
> > +               set_capacity(swd->unit[drive].disk, 2880);
> > +               add_disk(swd->unit[drive].disk);
> > +       }
> > +
> > +       blk_register_region(MKDEV(FLOPPY_MAJOR, 0), 256, THIS_MODULE,
> > +                           floppy_find, NULL, swd);
> > +
> > +       return 0;
> > +
> > +exit_put_disks:
> > +       unregister_blkdev(FLOPPY_MAJOR, "fd");
> > +       while (drive--)
> > +               put_disk(swd->unit[drive].disk);
> > +       return err;
> > +}
> > +
> > +static int __devinit swim_probe(struct platform_device *dev)
> > +{
> > +       struct resource *res;
> > +       struct swim __iomem *swim_base;
> > +       struct swim_priv *swd;
> > +       int ret;
> > +
> > +       res = platform_get_resource_byname(dev, IORESOURCE_MEM, "swim-regs");
> > +       if (!res) {
> > +               ret = -ENODEV;
> > +               goto out;
> > +       }
> > +
> > +       if (!request_mem_region(res->start, resource_size(res), CARDNAME)) {
> > +               ret = -EBUSY;
> > +               goto out;
> > +       }
> > +
> > +       swim_base = ioremap(res->start, resource_size(res));
> > +       if (!swim_base) {
> > +               return -ENOMEM;
> > +               goto out_release_io;
> > +       }
> > +
> > +       /* probe device */
> > +
> > +       set_swim_mode(swim_base, 1);
> > +       if (!get_swim_mode(swim_base)) {
> > +               printk(KERN_INFO "SWIM device not found !\n");
> > +               ret = -ENODEV;
> > +               goto out_iounmap;
> > +       }
> > +
> > +       /* set platform driver data */
> > +
> > +       swd = kzalloc(sizeof(struct swim_priv), GFP_KERNEL);
> > +       if (!swd) {
> > +               ret = -ENOMEM;
> > +               goto out_iounmap;
> > +       }
> > +       platform_set_drvdata(dev, swd);
> > +
> > +       swd->base = swim_base;
> > +
> > +       ret = swim_floppy_init(swd);
> > +       if (ret)
> > +               goto out_kfree;
> > +
> > +       return 0;
> > +
> > +out_kfree:
> > +       platform_set_drvdata(dev, NULL);
> > +       kfree(swd);
> > +out_iounmap:
> > +       iounmap(swim_base);
> > +out_release_io:
> > +       release_mem_region(res->start, resource_size(res));
> > +out:
> > +       return ret;
> > +}
> > +
> > +static int __devexit swim_remove(struct platform_device *dev)
> > +{
> > +       struct swim_priv *swd = platform_get_drvdata(dev);
> > +       int drive;
> > +       struct resource *res;
> > +
> > +       blk_unregister_region(MKDEV(FLOPPY_MAJOR, 0), 256);
> > +
> > +       for (drive = 0; drive < swd->floppy_count; drive++) {
> > +               del_gendisk(swd->unit[drive].disk);
> > +               put_disk(swd->unit[drive].disk);
> > +       }
> > +
> > +       unregister_blkdev(FLOPPY_MAJOR, "fd");
> > +
> > +       blk_cleanup_queue(swd->queue);
> > +
> > +       /* eject floppies */
> > +
> > +       for (drive = 0; drive < swd->floppy_count; drive++)
> > +               floppy_eject(&swd->unit[drive]);
> > +
> > +       iounmap(swd->base);
> > +
> > +       res = platform_get_resource_byname(dev, IORESOURCE_MEM, "swim-regs");
> > +       if (res)
> > +               release_mem_region(res->start, resource_size(res));
> > +
> > +       platform_set_drvdata(dev, NULL);
> > +       kfree(swd);
> > +
> > +       return 0;
> > +}
> > +
> > +static struct platform_driver swim_driver = {
> > +       .probe  = swim_probe,
> > +       .remove = __devexit_p(swim_remove),
> > +       .driver   = {
> > +               .name   = CARDNAME,
> > +               .owner  = THIS_MODULE,
> > +       },
> > +};
> > +
> > +static int __init swim_init(void)
> > +{
> > +       printk(KERN_INFO "SWIM floppy driver %s\n", DRIVER_VERSION);
> > +
> > +       return platform_driver_register(&swim_driver);
> > +}
> > +module_init(swim_init);
> > +
> > +static void __exit swim_exit(void)
> > +{
> > +       platform_driver_unregister(&swim_driver);
> > +}
> > +module_exit(swim_exit);
> > +
> > +MODULE_DESCRIPTION("Driver for SWIM floppy controller");
> > +MODULE_LICENSE("GPL");
> > +MODULE_AUTHOR("Laurent Vivier <laurent@lvivier.info>");
> > +MODULE_ALIAS_BLOCKDEV_MAJOR(FLOPPY_MAJOR);
> > diff --git a/drivers/block/swim_asm.S b/drivers/block/swim_asm.S
> > new file mode 100644
> > index 0000000..c966820
> > --- /dev/null
> > +++ b/drivers/block/swim_asm.S
> > @@ -0,0 +1,247 @@
> > +/*
> > + * low-level functions for the SWIM floppy controller
> > + *
> > + * needs assembly language because is very timing dependent
> > + * this controller exists only on macintosh 680x0 based
> > + *
> > + * Copyright (C) 2004,2008 Laurent Vivier <Laurent@lvivier.info>
> > + *
> > + * based on Alastair Bridgewater SWIM analysis, 2001
> > + * based on netBSD IWM driver (c) 1997, 1998 Hauke Fath.
> > + *
> > + * This program is free software; you can redistribute it and/or
> > + * modify it under the terms of the GNU General Public License
> > + * as published by the Free Software Foundation; either version
> > + * 2 of the License, or (at your option) any later version.
> > + *
> > + * 2004-08-21 (lv) - Initial implementation
> > + * 2008-11-05 (lv) - add get_swim_mode
> > + */
> > +
> > +       .equ    write_data,     0x0000
> > +       .equ    write_mark,     0x0200
> > +       .equ    write_CRC,      0x0400
> > +       .equ    write_parameter,0x0600
> > +       .equ    write_phase,    0x0800
> > +       .equ    write_setup,    0x0a00
> > +       .equ    write_mode0,    0x0c00
> > +       .equ    write_mode1,    0x0e00
> > +       .equ    read_data,      0x1000
> > +       .equ    read_mark,      0x1200
> > +       .equ    read_error,     0x1400
> > +       .equ    read_parameter, 0x1600
> > +       .equ    read_phase,     0x1800
> > +       .equ    read_setup,     0x1a00
> > +       .equ    read_status,    0x1c00
> > +       .equ    read_handshake, 0x1e00
> > +
> > +       .equ    o_side, 0
> > +       .equ    o_track, 1
> > +       .equ    o_sector, 2
> > +       .equ    o_size, 3
> > +       .equ    o_crc0, 4
> > +       .equ    o_crc1, 5
> > +
> > +       .equ    seek_time, 30000
> > +       .equ    max_retry, 40
> > +       .equ    sector_size, 512
> > +
> > +       .global swim_read_sector_header
> > +swim_read_sector_header:
> > +       link    %a6, #0
> > +       moveml  %d1-%d5/%a0-%a4,%sp@-
> > +       movel   %a6@(0x0c), %a4
> > +       bsr     mfm_read_addrmark
> > +       moveml  %sp@+, %d1-%d5/%a0-%a4
> > +       unlk    %a6
> > +       rts
> > +
> > +sector_address_mark:
> > +       .byte   0xa1, 0xa1, 0xa1, 0xfe
> > +sector_data_mark:
> > +       .byte   0xa1, 0xa1, 0xa1, 0xfb
> > +
> > +mfm_read_addrmark:
> > +       movel   %a6@(0x08), %a3
> > +       lea     %a3@(read_handshake), %a2
> > +       lea     %a3@(read_mark), %a3
> > +       moveq   #-1, %d0
> > +       movew   #seek_time, %d2
> > +
> > +wait_header_init:
> > +       tstb    %a3@(read_error - read_mark)
> > +       moveb   #0x18, %a3@(write_mode0 - read_mark)
> > +       moveb   #0x01, %a3@(write_mode1 - read_mark)
> > +       moveb   #0x01, %a3@(write_mode0 - read_mark)
> > +       tstb    %a3@(read_error - read_mark)
> > +       moveb   #0x08, %a3@(write_mode1 - read_mark)
> > +
> > +       lea     sector_address_mark, %a0
> > +       moveq   #3, %d1
> > +
> > +wait_addr_mark_byte:
> > +
> > +       tstb    %a2@
> > +       dbmi    %d2, wait_addr_mark_byte
> > +       bpl     header_exit
> > +
> > +       moveb   %a3@, %d3
> > +       cmpb    %a0@+, %d3
> > +       dbne    %d1, wait_addr_mark_byte
> > +       bne     wait_header_init
> > +
> > +       moveq   #max_retry, %d2
> > +
> > +amark0:        tstb    %a2@
> > +       dbmi    %d2, amark0
> > +       bpl     signal_nonyb
> > +
> > +       moveb   %a3@, %a4@(o_track)
> > +
> > +       moveq   #max_retry, %d2
> > +
> > +amark1:        tstb    %a2@
> > +       dbmi    %d2, amark1
> > +       bpl     signal_nonyb
> > +
> > +       moveb   %a3@, %a4@(o_side)
> > +
> > +       moveq   #max_retry, %d2
> > +
> > +amark2:        tstb    %a2@
> > +       dbmi    %d2, amark2
> > +       bpl     signal_nonyb
> > +
> > +       moveb   %a3@, %a4@(o_sector)
> > +
> > +       moveq   #max_retry, %d2
> > +
> > +amark3:        tstb    %a2@
> > +       dbmi    %d2, amark3
> > +       bpl     signal_nonyb
> > +
> > +       moveb   %a3@, %a4@(o_size)
> > +
> > +       moveq   #max_retry, %d2
> > +
> > +crc0:  tstb    %a2@
> > +       dbmi    %d2, crc0
> > +       bpl     signal_nonyb
> > +
> > +       moveb   %a3@, %a4@(o_crc0)
> > +
> > +       moveq   #max_retry, %d2
> > +
> > +crc1:  tstb    %a2@
> > +       dbmi    %d2, crc1
> > +       bpl     signal_nonyb
> > +
> > +       moveb   %a3@, %a4@(o_crc1)
> > +
> > +       tstb    %a3@(read_error - read_mark)
> > +
> > +header_exit:
> > +       moveq   #0, %d0
> > +       moveb   #0x18, %a3@(write_mode0 - read_mark)
> > +       rts
> > +signal_nonyb:
> > +       moveq   #-1, %d0
> > +       moveb   #0x18, %a3@(write_mode0 - read_mark)
> > +       rts
> > +
> > +       .global swim_read_sector_data
> > +swim_read_sector_data:
> > +       link    %a6, #0
> > +       moveml  %d1-%d5/%a0-%a5,%sp@-
> > +       movel   %a6@(0x0c), %a4
> > +       bsr     mfm_read_data
> > +       moveml  %sp@+, %d1-%d5/%a0-%a5
> > +       unlk    %a6
> > +       rts
> > +
> > +mfm_read_data:
> > +       movel   %a6@(0x08), %a3
> > +       lea     %a3@(read_handshake), %a2
> > +       lea     %a3@(read_data), %a5
> > +       lea     %a3@(read_mark), %a3
> > +       movew   #seek_time, %d2
> > +
> > +wait_data_init:
> > +       tstb    %a3@(read_error - read_mark)
> > +       moveb   #0x18, %a3@(write_mode0 - read_mark)
> > +       moveb   #0x01, %a3@(write_mode1 - read_mark)
> > +       moveb   #0x01, %a3@(write_mode0 - read_mark)
> > +       tstb    %a3@(read_error - read_mark)
> > +       moveb   #0x08, %a3@(write_mode1 - read_mark)
> > +
> > +       lea     sector_data_mark, %a0
> > +       moveq   #3, %d1
> > +
> > +       /* wait data address mark */
> > +
> > +wait_data_mark_byte:
> > +
> > +       tstb    %a2@
> > +       dbmi    %d2, wait_data_mark_byte
> > +       bpl     data_exit
> > +
> > +       moveb   %a3@, %d3
> > +       cmpb    %a0@+, %d3
> > +       dbne    %d1, wait_data_mark_byte
> > +       bne     wait_data_init
> > +
> > +       /* read data */
> > +
> > +       tstb    %a3@(read_error - read_mark)
> > +
> > +       movel   #sector_size-1, %d4             /* sector size */
> > +read_new_data:
> > +       movew   #max_retry, %d2
> > +read_data_loop:
> > +       moveb   %a2@, %d5
> > +       andb    #0xc0, %d5
> > +       dbne    %d2, read_data_loop
> > +       beq     data_exit
> > +       moveb   %a5@, %a4@+
> > +       andb    #0x40, %d5
> > +       dbne    %d4, read_new_data
> > +       beq     exit_loop
> > +       moveb   %a5@, %a4@+
> > +       dbra    %d4, read_new_data
> > +exit_loop:
> > +
> > +       /* read CRC */
> > +
> > +       movew   #max_retry, %d2
> > +data_crc0:
> > +
> > +       tstb    %a2@
> > +       dbmi    %d2, data_crc0
> > +       bpl     data_exit
> > +
> > +       moveb   %a3@, %d5
> > +
> > +       moveq   #max_retry, %d2
> > +
> > +data_crc1:
> > +
> > +       tstb    %a2@
> > +       dbmi    %d2, data_crc1
> > +       bpl     data_exit
> > +
> > +       moveb   %a3@, %d5
> > +
> > +       tstb    %a3@(read_error - read_mark)
> > +
> > +       moveb   #0x18, %a3@(write_mode0 - read_mark)
> > +
> > +       /* return number of bytes read */
> > +
> > +       movel   #sector_size, %d0
> > +       addw    #1, %d4
> > +       subl    %d4, %d0
> > +       rts
> > +data_exit:
> > +       moveb   #0x18, %a3@(write_mode0 - read_mark)
> > +       moveq   #-1, %d0
> > +       rts
> > --
> > 1.6.1.3
> >
> >
> 
> 
> 
> -- 
> Gr{oetje,eeting}s,
> 
> 						Geert
> 
> --
> Geert Uytterhoeven -- There's lots of Linux beyond ia32 -- geert@linux-m68k.org
> 
> In personal conversations with technical people, I call myself a hacker. But
> when I'm talking to journalists I just say "programmer" or something like that.
> 							    -- Linus Torvalds

-- 
Jens Axboe


^ permalink raw reply	[flat|nested] 9+ messages in thread

end of thread, other threads:[~2009-03-25 15:28 UTC | newest]

Thread overview: 9+ messages (download: mbox.gz follow: Atom feed
-- links below jump to the message on this page --
2009-03-01  9:21 [PATCH] m68k patches for 2.6.30 Geert Uytterhoeven
2009-03-01  9:21 ` [PATCH 1/6] m68k: Add install target Geert Uytterhoeven
2009-03-01  9:21   ` [PATCH 2/6] m68k: mac - Add a new entry in mac_model to identify the floppy controller type Geert Uytterhoeven
2009-03-01  9:21     ` [PATCH 3/6] m68k: mac - Add SWIM floppy support Geert Uytterhoeven
2009-03-01  9:21       ` [PATCH 4/6] MAINTAINERS: Replace dead link to m68k CVS repository by link to new git repository Geert Uytterhoeven
2009-03-01  9:21         ` [PATCH 5/6] m68k: section mismatch fixes: DMAsound for Atari Geert Uytterhoeven
2009-03-01  9:21           ` [PATCH 6/6] m68k: section mismatch fixes: Atari SCSI Geert Uytterhoeven
2009-03-25 14:55       ` [PATCH 3/6] m68k: mac - Add SWIM floppy support Geert Uytterhoeven
2009-03-25 15:28         ` Jens Axboe

This is a public inbox, see mirroring instructions
for how to clone and mirror all data and code used for this inbox