]> pilppa.com Git - linux-2.6-omap-h63xx.git/commitdiff
[PATCH] MPC8xx PCMCIA driver
authorMarcelo Tosatti <marcelo.tosatti@cyclades.com>
Sat, 29 Oct 2005 00:46:13 +0000 (17:46 -0700)
committerPaul Mackerras <paulus@samba.org>
Sat, 29 Oct 2005 03:55:35 +0000 (13:55 +1000)
Here is an uptodated version of the MPC8xx PCMCIA driver for v2.6,
addressing comments by Jeff and Dominik:

- use IO accessors instead of direct device memory referencing
- avoid usage of non-standard "uint/uchar" data types
- kill struct typedef's

Will submit it for inclusion once v2.6.14 is out.

Testing on 8xx platforms is more than welcome! Works like a charm
on our custom hardware (CONFIG_PRxK).

Cc: Dominik Brodowski <linux@dominikbrodowski.net>
Signed-off-by: Andrew Morton <akpm@osdl.org>
Signed-off-by: Paul Mackerras <paulus@samba.org>
drivers/pcmcia/Kconfig
drivers/pcmcia/Makefile
drivers/pcmcia/m8xx_pcmcia.c [new file with mode: 0644]

index 36cc9a96a3387c4d7619546cc36c1bd48bfcb675..ccf20039e90975c932ca7ad97c79594395b26d3d 100644 (file)
@@ -154,6 +154,16 @@ config TCIC
          "Bridge" is the name used for the hardware inside your computer that
          PCMCIA cards are plugged into. If unsure, say N.
 
+config PCMCIA_M8XX
+        tristate "MPC8xx PCMCIA support"
+        depends on PCMCIA && PPC
+        select PCCARD_NONSTATIC
+        help
+        Say Y here to include support for PowerPC 8xx series PCMCIA
+        controller.
+
+        This driver is also available as a module called m8xx_pcmcia.
+
 config HD64465_PCMCIA
        tristate "HD64465 host bridge support"
        depends on HD64465 && PCMCIA
index a41fbb38fdcbe6dfdd145fa0fd72db3ce330c534..cb4861d9cb8027f1e7109d6111991f619d9c0c19 100644 (file)
@@ -25,6 +25,7 @@ obj-$(CONFIG_PD6729)                          += pd6729.o
 obj-$(CONFIG_I82365)                           += i82365.o
 obj-$(CONFIG_I82092)                           += i82092.o
 obj-$(CONFIG_TCIC)                             += tcic.o
+obj-$(CONFIG_PCMCIA_M8XX)                              += m8xx_pcmcia.o
 obj-$(CONFIG_HD64465_PCMCIA)                   += hd64465_ss.o
 obj-$(CONFIG_PCMCIA_SA1100)                    += sa11xx_core.o sa1100_cs.o
 obj-$(CONFIG_PCMCIA_SA1111)                    += sa11xx_core.o sa1111_cs.o
diff --git a/drivers/pcmcia/m8xx_pcmcia.c b/drivers/pcmcia/m8xx_pcmcia.c
new file mode 100644 (file)
index 0000000..f8bed87
--- /dev/null
@@ -0,0 +1,1290 @@
+/*
+ * m8xx_pcmcia.c - Linux PCMCIA socket driver for the mpc8xx series.
+ *
+ * (C) 1999-2000 Magnus Damm <damm@bitsmart.com>
+ * (C) 2001-2002 Montavista Software, Inc.
+ *     <mlocke@mvista.com>
+ *
+ * Support for two slots by Cyclades Corporation
+ *     <oliver.kurth@cyclades.de>
+ * Further fixes, v2.6 kernel port
+ *     <marcelo.tosatti@cyclades.com>
+ *
+ * "The ExCA standard specifies that socket controllers should provide
+ * two IO and five memory windows per socket, which can be independently
+ * configured and positioned in the host address space and mapped to
+ * arbitrary segments of card address space. " - David A Hinds. 1999
+ *
+ * This controller does _not_ meet the ExCA standard.
+ *
+ * m8xx pcmcia controller brief info:
+ * + 8 windows (attrib, mem, i/o)
+ * + up to two slots (SLOT_A and SLOT_B)
+ * + inputpins, outputpins, event and mask registers.
+ * - no offset register. sigh.
+ *
+ * Because of the lacking offset register we must map the whole card.
+ * We assign each memory window PCMCIA_MEM_WIN_SIZE address space.
+ * Make sure there is (PCMCIA_MEM_WIN_SIZE * PCMCIA_MEM_WIN_NO
+ * * PCMCIA_SOCKETS_NO) bytes at PCMCIA_MEM_WIN_BASE.
+ * The i/o windows are dynamically allocated at PCMCIA_IO_WIN_BASE.
+ * They are maximum 64KByte each...
+ */
+
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/types.h>
+#include <linux/fcntl.h>
+#include <linux/string.h>
+
+#include <asm/io.h>
+#include <asm/bitops.h>
+#include <asm/segment.h>
+#include <asm/system.h>
+
+#include <linux/kernel.h>
+#include <linux/errno.h>
+#include <linux/sched.h>
+#include <linux/slab.h>
+#include <linux/timer.h>
+#include <linux/ioport.h>
+#include <linux/delay.h>
+#include <linux/interrupt.h>
+
+#include <asm/mpc8xx.h>
+#include <asm/8xx_immap.h>
+#include <asm/irq.h>
+
+#include <pcmcia/version.h>
+#include <pcmcia/cs_types.h>
+#include <pcmcia/cs.h>
+#include <pcmcia/ss.h>
+
+#ifdef PCMCIA_DEBUG
+static int pc_debug = PCMCIA_DEBUG;
+module_param(pc_debug, int, 0);
+#define dprintk(args...) printk(KERN_DEBUG "m8xx_pcmcia: " args);
+#else
+#define dprintk(args...)
+#endif
+
+#define pcmcia_info(args...) printk(KERN_INFO "m8xx_pcmcia: "args)
+#define pcmcia_error(args...) printk(KERN_ERR "m8xx_pcmcia: "args)
+
+static const char *version = "Version 0.06, Aug 2005";
+MODULE_LICENSE("Dual MPL/GPL");
+
+#if !defined(CONFIG_PCMCIA_SLOT_A) && !defined(CONFIG_PCMCIA_SLOT_B)
+
+/* The RPX series use SLOT_B */
+#if defined(CONFIG_RPXCLASSIC) || defined(CONFIG_RPXLITE)
+#define CONFIG_PCMCIA_SLOT_B
+#define CONFIG_BD_IS_MHZ
+#endif
+
+/* The ADS board use SLOT_A */
+#ifdef CONFIG_ADS
+#define CONFIG_PCMCIA_SLOT_A
+#define CONFIG_BD_IS_MHZ
+#endif
+
+/* The FADS series are a mess */
+#ifdef CONFIG_FADS
+#if defined(CONFIG_MPC860T) || defined(CONFIG_MPC860) || defined(CONFIG_MPC821)
+#define CONFIG_PCMCIA_SLOT_A
+#else
+#define CONFIG_PCMCIA_SLOT_B
+#endif
+#endif
+
+/* Cyclades ACS uses both slots */
+#ifdef CONFIG_PRxK
+#define CONFIG_PCMCIA_SLOT_A
+#define CONFIG_PCMCIA_SLOT_B
+#endif
+
+#endif /* !defined(CONFIG_PCMCIA_SLOT_A) && !defined(CONFIG_PCMCIA_SLOT_B) */
+
+#if defined(CONFIG_PCMCIA_SLOT_A) && defined(CONFIG_PCMCIA_SLOT_B)
+
+#define PCMCIA_SOCKETS_NO 2
+/* We have only 8 windows, dualsocket support will be limited. */
+#define PCMCIA_MEM_WIN_NO 2
+#define PCMCIA_IO_WIN_NO  2
+#define PCMCIA_SLOT_MSG "SLOT_A and SLOT_B"
+
+#elif defined(CONFIG_PCMCIA_SLOT_A) || defined(CONFIG_PCMCIA_SLOT_B)
+
+#define PCMCIA_SOCKETS_NO 1
+/* full support for one slot */
+#define PCMCIA_MEM_WIN_NO 5
+#define PCMCIA_IO_WIN_NO  2
+
+/* define _slot_ to be able to optimize macros */
+
+#ifdef CONFIG_PCMCIA_SLOT_A
+#define _slot_ 0
+#define PCMCIA_SLOT_MSG "SLOT_A"
+#else
+#define _slot_ 1
+#define PCMCIA_SLOT_MSG "SLOT_B"
+#endif
+
+#else
+#error m8xx_pcmcia: Bad configuration!
+#endif
+
+/* ------------------------------------------------------------------------- */
+
+#define PCMCIA_MEM_WIN_BASE 0xe0000000 /* base address for memory window 0   */
+#define PCMCIA_MEM_WIN_SIZE 0x04000000 /* each memory window is 64 MByte     */
+#define PCMCIA_IO_WIN_BASE  _IO_BASE   /* base address for io window 0       */
+
+#define PCMCIA_SCHLVL PCMCIA_INTERRUPT /* Status Change Interrupt Level      */
+
+/* ------------------------------------------------------------------------- */
+
+/* 2.4.x and newer has this always in HZ */
+#define M8XX_BUSFREQ ((((bd_t *)&(__res))->bi_busfreq))
+
+static int pcmcia_schlvl = PCMCIA_SCHLVL;
+
+static spinlock_t events_lock = SPIN_LOCK_UNLOCKED;
+
+
+#define PCMCIA_SOCKET_KEY_5V 1
+#define PCMCIA_SOCKET_KEY_LV 2
+
+/* look up table for pgcrx registers */
+static u32 *m8xx_pgcrx[2] = {
+       &((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pgcra,
+       &((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pgcrb
+};
+
+/*
+ * This structure is used to address each window in the PCMCIA controller.
+ *
+ * Keep in mind that we assume that pcmcia_win[n+1] is mapped directly
+ * after pcmcia_win[n]...
+ */
+
+struct pcmcia_win {
+       u32     br;
+       u32     or;
+};
+
+/*
+ * For some reason the hardware guys decided to make both slots share
+ * some registers.
+ *
+ * Could someone invent object oriented hardware ?
+ *
+ * The macros are used to get the right bit from the registers.
+ * SLOT_A : slot = 0
+ * SLOT_B : slot = 1
+ */
+
+#define M8XX_PCMCIA_VS1(slot)      (0x80000000 >> (slot << 4))
+#define M8XX_PCMCIA_VS2(slot)      (0x40000000 >> (slot << 4))
+#define M8XX_PCMCIA_VS_MASK(slot)  (0xc0000000 >> (slot << 4))
+#define M8XX_PCMCIA_VS_SHIFT(slot) (30 - (slot << 4))
+
+#define M8XX_PCMCIA_WP(slot)       (0x20000000 >> (slot << 4))
+#define M8XX_PCMCIA_CD2(slot)      (0x10000000 >> (slot << 4))
+#define M8XX_PCMCIA_CD1(slot)      (0x08000000 >> (slot << 4))
+#define M8XX_PCMCIA_BVD2(slot)     (0x04000000 >> (slot << 4))
+#define M8XX_PCMCIA_BVD1(slot)     (0x02000000 >> (slot << 4))
+#define M8XX_PCMCIA_RDY(slot)      (0x01000000 >> (slot << 4))
+#define M8XX_PCMCIA_RDY_L(slot)    (0x00800000 >> (slot << 4))
+#define M8XX_PCMCIA_RDY_H(slot)    (0x00400000 >> (slot << 4))
+#define M8XX_PCMCIA_RDY_R(slot)    (0x00200000 >> (slot << 4))
+#define M8XX_PCMCIA_RDY_F(slot)    (0x00100000 >> (slot << 4))
+#define M8XX_PCMCIA_MASK(slot)     (0xFFFF0000 >> (slot << 4))
+
+#define M8XX_PCMCIA_POR_VALID    0x00000001
+#define M8XX_PCMCIA_POR_WRPROT   0x00000002
+#define M8XX_PCMCIA_POR_ATTRMEM  0x00000010
+#define M8XX_PCMCIA_POR_IO       0x00000018
+#define M8XX_PCMCIA_POR_16BIT    0x00000040
+
+#define M8XX_PGCRX(slot)  m8xx_pgcrx[slot]
+
+#define M8XX_PGCRX_CXOE    0x00000080
+#define M8XX_PGCRX_CXRESET 0x00000040
+
+/* we keep one lookup table per socket to check flags */
+
+#define PCMCIA_EVENTS_MAX 5  /* 4 max at a time + termination */
+
+struct event_table {
+       u32 regbit;
+       u32 eventbit;
+};
+
+struct socket_info {
+       void    (*handler)(void *info, u32 events);
+       void    *info;
+
+       u32 slot;
+
+       socket_state_t state;
+       struct pccard_mem_map mem_win[PCMCIA_MEM_WIN_NO];
+       struct pccard_io_map  io_win[PCMCIA_IO_WIN_NO];
+       struct event_table events[PCMCIA_EVENTS_MAX];
+       struct pcmcia_socket socket;
+};
+
+static struct socket_info socket[PCMCIA_SOCKETS_NO];
+
+/*
+ * Search this table to see if the windowsize is
+ * supported...
+ */
+
+#define M8XX_SIZES_NO 32
+
+static const u32 m8xx_size_to_gray[M8XX_SIZES_NO] =
+{
+       0x00000001, 0x00000002, 0x00000008, 0x00000004,
+       0x00000080, 0x00000040, 0x00000010, 0x00000020,
+       0x00008000, 0x00004000, 0x00001000, 0x00002000,
+       0x00000100, 0x00000200, 0x00000800, 0x00000400,
+
+       0x0fffffff, 0xffffffff, 0xffffffff, 0xffffffff,
+       0x01000000, 0x02000000, 0xffffffff, 0x04000000,
+       0x00010000, 0x00020000, 0x00080000, 0x00040000,
+       0x00800000, 0x00400000, 0x00100000, 0x00200000
+};
+
+/* ------------------------------------------------------------------------- */
+
+static irqreturn_t m8xx_interrupt(int irq, void *dev, struct pt_regs *regs);
+
+#define PCMCIA_BMT_LIMIT (15*4)  /* Bus Monitor Timeout value */
+
+/* ------------------------------------------------------------------------- */
+/* board specific stuff:                                                     */
+/* voltage_set(), hardware_enable() and hardware_disable()                   */
+/* ------------------------------------------------------------------------- */
+/* RPX Boards from Embedded Planet                                           */
+
+#if defined(CONFIG_RPXCLASSIC) || defined(CONFIG_RPXLITE)
+
+/* The RPX boards seems to have it's bus monitor timeout set to 6*8 clocks.
+ * SYPCR is write once only, therefore must the slowest memory be faster
+ * than the bus monitor or we will get a machine check due to the bus timeout.
+ */
+
+#define PCMCIA_BOARD_MSG "RPX CLASSIC or RPX LITE"
+
+#undef PCMCIA_BMT_LIMIT
+#define PCMCIA_BMT_LIMIT (6*8)
+
+static int voltage_set(int slot, int vcc, int vpp)
+{
+       u32 reg = 0;
+
+       switch(vcc) {
+       case 0: break;
+       case 33:
+               reg |= BCSR1_PCVCTL4;
+               break;
+       case 50:
+               reg |= BCSR1_PCVCTL5;
+               break;
+       default:
+               return 1;
+       }
+
+       switch(vpp) {
+       case 0: break;
+       case 33:
+       case 50:
+               if(vcc == vpp)
+                       reg |= BCSR1_PCVCTL6;
+               else
+                       return 1;
+               break;
+       case 120:
+               reg |= BCSR1_PCVCTL7;
+       default:
+               return 1;
+       }
+
+       if(!((vcc == 50) || (vcc == 0)))
+               return 1;
+
+       /* first, turn off all power */
+
+       out_be32(((u32 *)RPX_CSR_ADDR), in_be32(((u32 *)RPX_CSR_ADDR)) & ~(BCSR1_PCVCTL4 | BCSR1_PCVCTL5 | BCSR1_PCVCTL6 | BCSR1_PCVCTL7));
+
+       /* enable new powersettings */
+
+       out_be32(((u32 *)RPX_CSR_ADDR), in_be32(((u32 *)RPX_CSR_ADDR)) | reg);
+
+       return 0;
+}
+
+#define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
+#define hardware_enable(_slot_)  /* No hardware to enable */
+#define hardware_disable(_slot_) /* No hardware to disable */
+
+#endif /* CONFIG_RPXCLASSIC */
+
+/* FADS Boards from Motorola                                               */
+
+#if defined(CONFIG_FADS)
+
+#define PCMCIA_BOARD_MSG "FADS"
+
+static int voltage_set(int slot, int vcc, int vpp)
+{
+       u32 reg = 0;
+
+       switch(vcc) {
+               case 0:
+                       break;
+               case 33:
+                       reg |= BCSR1_PCCVCC0;
+                       break;
+               case 50:
+                       reg |= BCSR1_PCCVCC1;
+                       break;
+               default:
+                       return 1;
+       }
+
+       switch(vpp) {
+               case 0:
+                       break;
+               case 33:
+               case 50:
+                       if(vcc == vpp)
+                               reg |= BCSR1_PCCVPP1;
+                       else
+                               return 1;
+                       break;
+               case 120:
+                       if ((vcc == 33) || (vcc == 50))
+                               reg |= BCSR1_PCCVPP0;
+                       else
+                               return 1;
+               default:
+                       return 1;
+       }
+
+       /* first, turn off all power */
+       out_be32(&((u32 *)BCSR1), in_be32(&((u32 *)BCSR1)) & ~(BCSR1_PCCVCC_MASK | BCSR1_PCCVPP_MASK));
+
+       /* enable new powersettings */
+       out_be32(&((u32 *)BCSR1), in_be32(&((u32 *)BCSR1)) | reg);
+
+       return 0;
+}
+
+#define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
+
+static void hardware_enable(int slot)
+{
+       out_be32(&((u32 *)BCSR1), in_be32(&((u32 *)BCSR1)) & ~BCSR1_PCCEN);
+}
+
+static void hardware_disable(int slot)
+{
+       out_be32(&((u32 *)BCSR1), in_be32(&((u32 *)BCSR1)) |  BCSR1_PCCEN);
+}
+
+#endif
+
+/* ------------------------------------------------------------------------- */
+/* Motorola MBX860                                                           */
+
+#if defined(CONFIG_MBX)
+
+#define PCMCIA_BOARD_MSG "MBX"
+
+static int voltage_set(int slot, int vcc, int vpp)
+{
+       u8 reg = 0;
+
+       switch(vcc) {
+               case 0:
+                       break;
+               case 33:
+                       reg |= CSR2_VCC_33;
+                       break;
+               case 50:
+                       reg |= CSR2_VCC_50;
+                       break;
+               default:
+                       return 1;
+       }
+
+       switch(vpp) {
+               case 0:
+                       break;
+               case 33:
+               case 50:
+                       if(vcc == vpp)
+                               reg |= CSR2_VPP_VCC;
+                       else
+                               return 1;
+                       break;
+               case 120:
+                       if ((vcc == 33) || (vcc == 50))
+                               reg |= CSR2_VPP_12;
+                       else
+                               return 1;
+               default:
+                       return 1;
+       }
+
+       /* first, turn off all power */
+       out_8(&((u8 *)MBX_CSR2_ADDR), in_8(&((u8 *)MBX_CSR2_ADDR)) & ~(CSR2_VCC_MASK | CSR2_VPP_MASK));
+
+       /* enable new powersettings */
+       out_8(&((u8 *)MBX_CSR2_ADDR), in_8(&((u8 *)MBX_CSR2_ADDR)) | reg);
+
+       return 0;
+}
+
+#define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
+#define hardware_enable(_slot_)  /* No hardware to enable */
+#define hardware_disable(_slot_) /* No hardware to disable */
+
+#endif /* CONFIG_MBX */
+
+#if defined(CONFIG_PRxK)
+#include <asm/cpld.h>
+extern volatile fpga_pc_regs *fpga_pc;
+
+#define PCMCIA_BOARD_MSG "MPC855T"
+
+static int voltage_set(int slot, int vcc, int vpp)
+{
+       u8 reg = 0;
+       u8 regread;
+       cpld_regs *ccpld = get_cpld();
+
+       switch(vcc) {
+               case 0:
+                       break;
+               case 33:
+                       reg |= PCMCIA_VCC_33;
+                       break;
+               case 50:
+                       reg |= PCMCIA_VCC_50;
+                       break;
+               default:
+                       return 1;
+       }
+
+       switch(vpp) {
+               case 0:
+                       break;
+               case 33:
+               case 50:
+                       if(vcc == vpp)
+                               reg |= PCMCIA_VPP_VCC;
+                       else
+                               return 1;
+                       break;
+               case 120:
+                       if ((vcc == 33) || (vcc == 50))
+                               reg |= PCMCIA_VPP_12;
+                       else
+                               return 1;
+               default:
+                       return 1;
+       }
+
+       reg = reg >> (slot << 2);
+       regread = in_8(&ccpld->fpga_pc_ctl);
+       if (reg != (regread & ((PCMCIA_VCC_MASK | PCMCIA_VPP_MASK) >> (slot << 2)))) {
+               /* enable new powersettings */
+               regread = regread & ~((PCMCIA_VCC_MASK | PCMCIA_VPP_MASK) >> (slot << 2));
+               out_8(&ccpld->fpga_pc_ctl, reg | regread);
+               msleep(100);
+       }
+
+       return 0;
+}
+
+#define socket_get(_slot_) PCMCIA_SOCKET_KEY_LV
+#define hardware_enable(_slot_)  /* No hardware to enable */
+#define hardware_disable(_slot_) /* No hardware to disable */
+
+#endif /* CONFIG_PRxK */
+
+static void m8xx_shutdown(void)
+{
+       u32 m, i;
+       struct pcmcia_win *w;
+
+       for(i = 0; i < PCMCIA_SOCKETS_NO; i++){
+               w = (void *) &((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pbr0;
+
+               out_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pscr, M8XX_PCMCIA_MASK(i));
+               out_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_per, in_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_per) & ~M8XX_PCMCIA_MASK(i));
+
+               /* turn off interrupt and disable CxOE */
+               out_be32(M8XX_PGCRX(i), M8XX_PGCRX_CXOE);
+
+               /* turn off memory windows */
+               for(m = 0; m < PCMCIA_MEM_WIN_NO; m++) {
+                       out_be32(&w->or, 0); /* set to not valid */
+                       w++;
+               }
+
+               /* turn off voltage */
+               voltage_set(i, 0, 0);
+
+               /* disable external hardware */
+               hardware_disable(i);
+       }
+
+       free_irq(pcmcia_schlvl, NULL);
+}
+
+/* copied from tcic.c */
+
+static int m8xx_drv_suspend(struct device *dev, pm_message_t state, u32 level)
+{
+        int ret = 0;
+        if (level == SUSPEND_SAVE_STATE)
+                ret = pcmcia_socket_dev_suspend(dev, state);
+        return ret;
+}
+
+static int m8xx_drv_resume(struct device *dev, u32 level)
+{
+        int ret = 0;
+        if (level == RESUME_RESTORE_STATE)
+                ret = pcmcia_socket_dev_resume(dev);
+        return ret;
+}
+
+static struct device_driver m8xx_driver = {
+        .name = "m8xx-pcmcia",
+        .bus = &platform_bus_type,
+        .suspend = m8xx_drv_suspend,
+        .resume = m8xx_drv_resume,
+};
+
+static struct platform_device m8xx_device = {
+        .name = "m8xx-pcmcia",
+        .id = 0,
+};
+
+static u32 pending_events[PCMCIA_SOCKETS_NO];
+static spinlock_t pending_event_lock = SPIN_LOCK_UNLOCKED;
+
+static irqreturn_t m8xx_interrupt(int irq, void *dev, struct pt_regs *regs)
+{
+       struct socket_info *s;
+       struct event_table *e;
+       unsigned int i, events, pscr, pipr, per;
+
+       dprintk("Interrupt!\n");
+       /* get interrupt sources */
+
+       pscr = in_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pscr);
+       pipr = in_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pipr);
+       per = in_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_per);
+
+       for(i = 0; i < PCMCIA_SOCKETS_NO; i++) {
+               s = &socket[i];
+               e = &s->events[0];
+               events = 0;
+
+               while(e->regbit) {
+                       if(pscr & e->regbit)
+                               events |= e->eventbit;
+
+                               e++;
+               }
+
+               /*
+                * report only if both card detect signals are the same
+                * not too nice done,
+                * we depend on that CD2 is the bit to the left of CD1...
+                */
+               if(events & SS_DETECT)
+                       if(((pipr & M8XX_PCMCIA_CD2(i)) >> 1) ^
+                               (pipr & M8XX_PCMCIA_CD1(i)))
+                       {
+                               events &= ~SS_DETECT;
+                       }
+
+#ifdef PCMCIA_GLITCHY_CD
+               /*
+                * I've experienced CD problems with my ADS board.
+                * We make an extra check to see if there was a
+                * real change of Card detection.
+                */
+
+               if((events & SS_DETECT) &&
+                  ((pipr &
+                    (M8XX_PCMCIA_CD2(i) | M8XX_PCMCIA_CD1(i))) == 0) &&
+                  (s->state.Vcc | s->state.Vpp)) {
+                       events &= ~SS_DETECT;
+                       /*printk( "CD glitch workaround - CD = 0x%08x!\n",
+                               (pipr & (M8XX_PCMCIA_CD2(i)
+                                        | M8XX_PCMCIA_CD1(i))));*/
+               }
+#endif
+
+               /* call the handler */
+
+               dprintk("slot %u: events = 0x%02x, pscr = 0x%08x, "
+                       "pipr = 0x%08x\n",
+                       i, events, pscr, pipr);
+
+               if(events) {
+                       spin_lock(&pending_event_lock);
+                       pending_events[i] |= events;
+                       spin_unlock(&pending_event_lock);
+                       /*
+                        * Turn off RDY_L bits in the PER mask on
+                        * CD interrupt receival.
+                        *
+                        * They can generate bad interrupts on the
+                        * ACS4,8,16,32.   - marcelo
+                        */
+                       per &= ~M8XX_PCMCIA_RDY_L(0);
+                       per &= ~M8XX_PCMCIA_RDY_L(1);
+
+                       out_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_per, per);
+
+                       if (events)
+                               pcmcia_parse_events(&socket[i].socket, events);
+               }
+       }
+
+       /* clear the interrupt sources */
+       out_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pscr, pscr);
+
+       dprintk("Interrupt done.\n");
+
+       return IRQ_HANDLED;
+}
+
+static u32 m8xx_get_graycode(u32 size)
+{
+       u32 k;
+
+       for(k = 0; k < M8XX_SIZES_NO; k++)
+               if(m8xx_size_to_gray[k] == size)
+                       break;
+
+       if((k == M8XX_SIZES_NO) || (m8xx_size_to_gray[k] == -1))
+               k = -1;
+
+       return k;
+}
+
+static u32 m8xx_get_speed(u32 ns, u32 is_io)
+{
+       u32 reg, clocks, psst, psl, psht;
+
+       if(!ns) {
+
+               /*
+                * We get called with IO maps setup to 0ns
+                * if not specified by the user.
+                * They should be 255ns.
+                */
+
+               if(is_io)
+                       ns = 255;
+               else
+                       ns = 100;  /* fast memory if 0 */
+       }
+
+       /*
+        * In PSST, PSL, PSHT fields we tell the controller
+        * timing parameters in CLKOUT clock cycles.
+        * CLKOUT is the same as GCLK2_50.
+        */
+
+/* how we want to adjust the timing - in percent */
+
+#define ADJ 180 /* 80 % longer accesstime - to be sure */
+
+       clocks = ((M8XX_BUSFREQ / 1000) * ns) / 1000;
+       clocks = (clocks * ADJ) / (100*1000);
+       if(clocks >= PCMCIA_BMT_LIMIT) {
+               printk( "Max access time limit reached\n");
+               clocks = PCMCIA_BMT_LIMIT-1;
+       }
+
+       psst = clocks / 7;          /* setup time */
+       psht = clocks / 7;          /* hold time */
+       psl  = (clocks * 5) / 7;    /* strobe length */
+
+       psst += clocks - (psst + psht + psl);
+
+       reg =  psst << 12;
+       reg |= psl  << 7;
+       reg |= psht << 16;
+
+       return reg;
+}
+
+static int m8xx_get_status(struct pcmcia_socket *sock, unsigned int *value)
+{
+       int lsock = container_of(sock, struct socket_info, socket)->slot;
+       struct socket_info *s = &socket[lsock];
+       unsigned int pipr, reg;
+
+       pipr = in_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pipr);
+
+       *value  = ((pipr & (M8XX_PCMCIA_CD1(lsock)
+                           | M8XX_PCMCIA_CD2(lsock))) == 0) ? SS_DETECT : 0;
+       *value |= (pipr & M8XX_PCMCIA_WP(lsock)) ? SS_WRPROT : 0;
+
+       if (s->state.flags & SS_IOCARD)
+               *value |= (pipr & M8XX_PCMCIA_BVD1(lsock)) ? SS_STSCHG : 0;
+       else {
+               *value |= (pipr & M8XX_PCMCIA_RDY(lsock)) ? SS_READY : 0;
+               *value |= (pipr & M8XX_PCMCIA_BVD1(lsock)) ? SS_BATDEAD : 0;
+               *value |= (pipr & M8XX_PCMCIA_BVD2(lsock)) ? SS_BATWARN : 0;
+       }
+
+       if (s->state.Vcc | s->state.Vpp)
+               *value |= SS_POWERON;
+
+       /*
+        * Voltage detection:
+        * This driver only supports 16-Bit pc-cards.
+        * Cardbus is not handled here.
+        *
+        * To determine what voltage to use we must read the VS1 and VS2 pin.
+        * Depending on what socket type is present,
+        * different combinations mean different things.
+        *
+        * Card Key  Socket Key   VS1   VS2   Card         Vcc for CIS parse
+        *
+        * 5V        5V, LV*      NC    NC    5V only       5V (if available)
+        *
+        * 5V        5V, LV*      GND   NC    5 or 3.3V     as low as possible
+        *
+        * 5V        5V, LV*      GND   GND   5, 3.3, x.xV  as low as possible
+        *
+        * LV*       5V            -     -    shall not fit into socket
+        *
+        * LV*       LV*          GND   NC    3.3V only     3.3V
+        *
+        * LV*       LV*          NC    GND   x.xV          x.xV (if avail.)
+        *
+        * LV*       LV*          GND   GND   3.3 or x.xV   as low as possible
+        *
+        * *LV means Low Voltage
+        *
+        *
+        * That gives us the following table:
+        *
+        * Socket    VS1  VS2   Voltage
+        *
+        * 5V        NC   NC    5V
+        * 5V        NC   GND   none (should not be possible)
+        * 5V        GND  NC    >= 3.3V
+        * 5V        GND  GND   >= x.xV
+        *
+        * LV        NC   NC    5V   (if available)
+        * LV        NC   GND   x.xV (if available)
+        * LV        GND  NC    3.3V
+        * LV        GND  GND   >= x.xV
+        *
+        * So, how do I determine if I have a 5V or a LV
+        * socket on my board?  Look at the socket!
+        *
+        *
+        * Socket with 5V key:
+        * ++--------------------------------------------+
+        * ||                                            |
+        * ||                                           ||
+        * ||                                           ||
+        * |                                             |
+        * +---------------------------------------------+
+        *
+        * Socket with LV key:
+        * ++--------------------------------------------+
+        * ||                                            |
+        * |                                            ||
+        * |                                            ||
+        * |                                             |
+        * +---------------------------------------------+
+        *
+        *
+        * With other words - LV only cards does not fit
+        * into the 5V socket!
+        */
+
+       /* read out VS1 and VS2 */
+
+       reg = (pipr & M8XX_PCMCIA_VS_MASK(lsock))
+               >> M8XX_PCMCIA_VS_SHIFT(lsock);
+
+       if(socket_get(lsock) == PCMCIA_SOCKET_KEY_LV) {
+               switch(reg) {
+               case 1:
+                       *value |= SS_3VCARD;
+                       break; /* GND, NC - 3.3V only */
+               case 2:
+                       *value |= SS_XVCARD;
+                       break; /* NC. GND - x.xV only */
+               };
+       }
+
+       dprintk("GetStatus(%d) = %#2.2x\n", lsock, *value);
+       return 0;
+}
+
+static int m8xx_get_socket(struct pcmcia_socket *sock, socket_state_t *state)
+{
+       int lsock = container_of(sock, struct socket_info, socket)->slot;
+       *state = socket[lsock].state; /* copy the whole structure */
+
+       dprintk("GetSocket(%d) = flags %#3.3x, Vcc %d, Vpp %d, "
+             "io_irq %d, csc_mask %#2.2x\n", lsock, state->flags,
+             state->Vcc, state->Vpp, state->io_irq, state->csc_mask);
+       return 0;
+}
+
+static int m8xx_set_socket(struct pcmcia_socket *sock, socket_state_t *state)
+{
+       int lsock = container_of(sock, struct socket_info, socket)->slot;
+       struct socket_info *s = &socket[lsock];
+       struct event_table *e;
+       unsigned int reg;
+       unsigned long flags;
+
+       dprintk( "SetSocket(%d, flags %#3.3x, Vcc %d, Vpp %d, "
+             "io_irq %d, csc_mask %#2.2x)\n", lsock, state->flags,
+             state->Vcc, state->Vpp, state->io_irq, state->csc_mask);
+
+       /* First, set voltage - bail out if invalid */
+       if(voltage_set(lsock, state->Vcc, state->Vpp))
+               return -EINVAL;
+
+       /* Take care of reset... */
+       if(state->flags & SS_RESET)
+               out_be32(M8XX_PGCRX(lsock), in_be32(M8XX_PGCRX(lsock)) |  M8XX_PGCRX_CXRESET); /* active high */
+       else
+               out_be32(M8XX_PGCRX(lsock), in_be32(M8XX_PGCRX(lsock)) & ~M8XX_PGCRX_CXRESET);
+
+       /* ... and output enable. */
+
+       /* The CxOE signal is connected to a 74541 on the ADS.
+          I guess most other boards used the ADS as a reference.
+          I tried to control the CxOE signal with SS_OUTPUT_ENA,
+          but the reset signal seems connected via the 541.
+          If the CxOE is left high are some signals tristated and
+          no pullups are present -> the cards act wierd.
+          So right now the buffers are enabled if the power is on. */
+
+       if(state->Vcc || state->Vpp)
+               out_be32(M8XX_PGCRX(lsock), in_be32(M8XX_PGCRX(lsock)) & ~M8XX_PGCRX_CXOE); /* active low */
+       else
+               out_be32(M8XX_PGCRX(lsock), in_be32(M8XX_PGCRX(lsock)) | M8XX_PGCRX_CXOE);
+
+       /*
+        * We'd better turn off interrupts before
+        * we mess with the events-table..
+        */
+
+       spin_lock_irqsave(&events_lock, flags);
+
+       /*
+        * Play around with the interrupt mask to be able to
+        * give the events the generic pcmcia driver wants us to.
+        */
+
+       e = &s->events[0];
+       reg = 0;
+
+       if(state->csc_mask & SS_DETECT) {
+               e->eventbit = SS_DETECT;
+               reg |= e->regbit = (M8XX_PCMCIA_CD2(lsock)
+                                   | M8XX_PCMCIA_CD1(lsock));
+               e++;
+       }
+       if(state->flags & SS_IOCARD) {
+               /*
+                * I/O card
+                */
+               if(state->csc_mask & SS_STSCHG) {
+                       e->eventbit = SS_STSCHG;
+                       reg |= e->regbit = M8XX_PCMCIA_BVD1(lsock);
+                       e++;
+               }
+               /*
+                * If io_irq is non-zero we should enable irq.
+                */
+               if(state->io_irq) {
+                       out_be32(M8XX_PGCRX(lsock), in_be32(M8XX_PGCRX(lsock)) | mk_int_int_mask(state->io_irq) << 24);
+                       /*
+                        * Strange thing here:
+                        * The manual does not tell us which interrupt
+                        * the sources generate.
+                        * Anyhow, I found out that RDY_L generates IREQLVL.
+                        *
+                        * We use level triggerd interrupts, and they don't
+                        * have to be cleared in PSCR in the interrupt handler.
+                        */
+                       reg |= M8XX_PCMCIA_RDY_L(lsock);
+               }
+               else
+                       out_be32(M8XX_PGCRX(lsock), in_be32(M8XX_PGCRX(lsock)) & 0x00ffffff);
+       }
+       else {
+               /*
+                * Memory card
+                */
+               if(state->csc_mask & SS_BATDEAD) {
+                       e->eventbit = SS_BATDEAD;
+                       reg |= e->regbit = M8XX_PCMCIA_BVD1(lsock);
+                       e++;
+               }
+               if(state->csc_mask & SS_BATWARN) {
+                       e->eventbit = SS_BATWARN;
+                       reg |= e->regbit = M8XX_PCMCIA_BVD2(lsock);
+                       e++;
+               }
+               /* What should I trigger on - low/high,raise,fall? */
+               if(state->csc_mask & SS_READY) {
+                       e->eventbit = SS_READY;
+                       reg |= e->regbit = 0; //??
+                       e++;
+               }
+       }
+
+       e->regbit = 0;  /* terminate list */
+
+       /*
+        * Clear the status changed .
+        * Port A and Port B share the same port.
+        * Writing ones will clear the bits.
+        */
+
+       out_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pscr, reg);
+
+       /*
+        * Write the mask.
+        * Port A and Port B share the same port.
+        * Need for read-modify-write.
+        * Ones will enable the interrupt.
+        */
+
+       /*
+         reg |= ((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_per
+         & M8XX_PCMCIA_MASK(lsock);
+       */
+
+       reg |= in_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_per) &
+               (M8XX_PCMCIA_MASK(0) | M8XX_PCMCIA_MASK(1));
+
+       out_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_per, reg);
+
+       spin_unlock_irqrestore(&events_lock, flags);
+
+       /* copy the struct and modify the copy */
+
+       s->state = *state;
+
+       return 0;
+}
+
+static int m8xx_set_io_map(struct pcmcia_socket *sock, struct pccard_io_map *io)
+{
+       int lsock = container_of(sock, struct socket_info, socket)->slot;
+
+       struct socket_info *s = &socket[lsock];
+       struct pcmcia_win *w;
+       unsigned int reg, winnr;
+
+#define M8XX_SIZE (io->stop - io->start + 1)
+#define M8XX_BASE (PCMCIA_IO_WIN_BASE + io->start)
+
+       dprintk( "SetIOMap(%d, %d, %#2.2x, %d ns, "
+             "%#4.4x-%#4.4x)\n", lsock, io->map, io->flags,
+             io->speed, io->start, io->stop);
+
+       if ((io->map >= PCMCIA_IO_WIN_NO) || (io->start > 0xffff)
+           || (io->stop > 0xffff) || (io->stop < io->start))
+               return -EINVAL;
+
+       if((reg = m8xx_get_graycode(M8XX_SIZE)) == -1)
+               return -EINVAL;
+
+       if(io->flags & MAP_ACTIVE) {
+
+               dprintk( "io->flags & MAP_ACTIVE\n");
+
+               winnr = (PCMCIA_MEM_WIN_NO * PCMCIA_SOCKETS_NO)
+                       + (lsock * PCMCIA_IO_WIN_NO) + io->map;
+
+               /* setup registers */
+
+               w = (void *) &((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pbr0;
+               w += winnr;
+
+               out_be32(&w->or, 0); /* turn off window first */
+               out_be32(&w->br, M8XX_BASE);
+
+               reg <<= 27;
+               reg |= M8XX_PCMCIA_POR_IO |(lsock << 2);
+
+               reg |= m8xx_get_speed(io->speed, 1);
+
+               if(io->flags & MAP_WRPROT)
+                       reg |= M8XX_PCMCIA_POR_WRPROT;
+
+               /*if(io->flags & (MAP_16BIT | MAP_AUTOSZ))*/
+               if(io->flags & MAP_16BIT)
+                       reg |= M8XX_PCMCIA_POR_16BIT;
+
+               if(io->flags & MAP_ACTIVE)
+                       reg |= M8XX_PCMCIA_POR_VALID;
+
+               out_be32(&w->or, reg);
+
+               dprintk("Socket %u: Mapped io window %u at %#8.8x, "
+                     "OR = %#8.8x.\n", lsock, io->map, w->br, w->or);
+       } else {
+               /* shutdown IO window */
+               winnr = (PCMCIA_MEM_WIN_NO * PCMCIA_SOCKETS_NO)
+                       + (lsock * PCMCIA_IO_WIN_NO) + io->map;
+
+               /* setup registers */
+
+               w = (void *) &((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pbr0;
+               w += winnr;
+
+               out_be32(&w->or, 0); /* turn off window */
+               out_be32(&w->br, 0); /* turn off base address */
+
+               dprintk("Socket %u: Unmapped io window %u at %#8.8x, "
+                       "OR = %#8.8x.\n", lsock, io->map, w->br, w->or);
+       }
+
+       /* copy the struct and modify the copy */
+       s->io_win[io->map] = *io;
+       s->io_win[io->map].flags &= (MAP_WRPROT
+                                    | MAP_16BIT
+                                    | MAP_ACTIVE);
+       dprintk("SetIOMap exit\n");
+
+       return 0;
+}
+
+static int m8xx_set_mem_map(struct pcmcia_socket *sock, struct pccard_mem_map *mem)
+{
+       int lsock = container_of(sock, struct socket_info, socket)->slot;
+       struct socket_info *s = &socket[lsock];
+       struct pcmcia_win *w;
+       struct pccard_mem_map *old;
+       unsigned int reg, winnr;
+
+       dprintk( "SetMemMap(%d, %d, %#2.2x, %d ns, "
+             "%#5.5lx, %#5.5x)\n", lsock, mem->map, mem->flags,
+             mem->speed, mem->static_start, mem->card_start);
+
+       if ((mem->map >= PCMCIA_MEM_WIN_NO)
+//         || ((mem->s) >= PCMCIA_MEM_WIN_SIZE)
+           || (mem->card_start >= 0x04000000)
+           || (mem->static_start & 0xfff)                /* 4KByte resolution */
+           || (mem->card_start & 0xfff))
+               return -EINVAL;
+
+       if((reg = m8xx_get_graycode(PCMCIA_MEM_WIN_SIZE)) == -1) {
+               printk( "Cannot set size to 0x%08x.\n", PCMCIA_MEM_WIN_SIZE);
+               return -EINVAL;
+       }
+       reg <<= 27;
+
+       winnr = (lsock * PCMCIA_MEM_WIN_NO) + mem->map;
+
+       /* Setup the window in the pcmcia controller */
+
+       w = (void *) &((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pbr0;
+       w += winnr;
+
+       reg |= lsock << 2;
+
+       reg |= m8xx_get_speed(mem->speed, 0);
+
+       if(mem->flags & MAP_ATTRIB)
+               reg |=  M8XX_PCMCIA_POR_ATTRMEM;
+
+       if(mem->flags & MAP_WRPROT)
+               reg |= M8XX_PCMCIA_POR_WRPROT;
+
+       if(mem->flags & MAP_16BIT)
+               reg |= M8XX_PCMCIA_POR_16BIT;
+
+       if(mem->flags & MAP_ACTIVE)
+               reg |= M8XX_PCMCIA_POR_VALID;
+
+       out_be32(&w->or, reg);
+
+       dprintk("Socket %u: Mapped memory window %u at %#8.8x, "
+             "OR = %#8.8x.\n", lsock, mem->map, w->br, w->or);
+
+       if(mem->flags & MAP_ACTIVE) {
+               /* get the new base address */
+               mem->static_start = PCMCIA_MEM_WIN_BASE +
+                       (PCMCIA_MEM_WIN_SIZE * winnr)
+                       + mem->card_start;
+       }
+
+       dprintk("SetMemMap(%d, %d, %#2.2x, %d ns, "
+             "%#5.5lx, %#5.5x)\n", lsock, mem->map, mem->flags,
+             mem->speed, mem->static_start, mem->card_start);
+
+       /* copy the struct and modify the copy */
+
+       old = &s->mem_win[mem->map];
+
+       *old = *mem;
+       old->flags &= (MAP_ATTRIB
+                      | MAP_WRPROT
+                      | MAP_16BIT
+                      | MAP_ACTIVE);
+
+       return 0;
+}
+
+static int m8xx_sock_init(struct pcmcia_socket *sock)
+{
+       int i;
+       pccard_io_map io = { 0, 0, 0, 0, 1 };
+       pccard_mem_map mem = { 0, 0, 0, 0, 0, 0 };
+
+       dprintk( "sock_init(%d)\n", s);
+
+       m8xx_set_socket(sock, &dead_socket);
+       for (i = 0; i < PCMCIA_IO_WIN_NO; i++) {
+               io.map = i;
+               m8xx_set_io_map(sock, &io);
+       }
+       for (i = 0; i < PCMCIA_MEM_WIN_NO; i++) {
+               mem.map = i;
+               m8xx_set_mem_map(sock, &mem);
+       }
+
+       return 0;
+
+}
+
+static int m8xx_suspend(struct pcmcia_socket *sock)
+{
+       return m8xx_set_socket(sock, &dead_socket);
+}
+
+static struct pccard_operations m8xx_services = {
+       .init   = m8xx_sock_init,
+       .suspend = m8xx_suspend,
+       .get_status = m8xx_get_status,
+       .get_socket = m8xx_get_socket,
+       .set_socket = m8xx_set_socket,
+       .set_io_map = m8xx_set_io_map,
+       .set_mem_map = m8xx_set_mem_map,
+};
+
+static int __init m8xx_init(void)
+{
+       struct pcmcia_win *w;
+       unsigned int i,m;
+
+       pcmcia_info("%s\n", version);
+
+       if (driver_register(&m8xx_driver))
+               return -1;
+
+       pcmcia_info(PCMCIA_BOARD_MSG " using " PCMCIA_SLOT_MSG
+                   " with IRQ %u.\n", pcmcia_schlvl);
+
+       /* Configure Status change interrupt */
+
+       if(request_irq(pcmcia_schlvl, m8xx_interrupt, 0,
+                         "m8xx_pcmcia", NULL)) {
+               pcmcia_error("Cannot allocate IRQ %u for SCHLVL!\n",
+                            pcmcia_schlvl);
+               return -1;
+       }
+
+       w = (void *) &((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pbr0;
+
+       out_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pscr,
+               M8XX_PCMCIA_MASK(0)| M8XX_PCMCIA_MASK(1));
+
+       out_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_per,
+               in_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_per) &
+               ~(M8XX_PCMCIA_MASK(0)| M8XX_PCMCIA_MASK(1)));
+
+/* connect interrupt and disable CxOE */
+
+       out_be32(M8XX_PGCRX(0), M8XX_PGCRX_CXOE | (mk_int_int_mask(pcmcia_schlvl) << 16));
+       out_be32(M8XX_PGCRX(1), M8XX_PGCRX_CXOE | (mk_int_int_mask(pcmcia_schlvl) << 16));
+
+/* intialize the fixed memory windows */
+
+       for(i = 0; i < PCMCIA_SOCKETS_NO; i++){
+               for(m = 0; m < PCMCIA_MEM_WIN_NO; m++) {
+                       out_be32(&w->br, PCMCIA_MEM_WIN_BASE +
+                               (PCMCIA_MEM_WIN_SIZE
+                                * (m + i * PCMCIA_MEM_WIN_NO)));
+
+                       out_be32(&w->or, 0);  /* set to not valid */
+
+                       w++;
+               }
+       }
+
+/* turn off voltage */
+       voltage_set(0, 0, 0);
+       voltage_set(1, 0, 0);
+
+/* Enable external hardware */
+       hardware_enable(0);
+       hardware_enable(1);
+
+       platform_device_register(&m8xx_device);
+
+       for (i = 0 ; i < PCMCIA_SOCKETS_NO; i++) {
+               socket[i].slot = i;
+               socket[i].socket.owner = THIS_MODULE;
+               socket[i].socket.features = SS_CAP_PCCARD | SS_CAP_MEM_ALIGN | SS_CAP_STATIC_MAP;
+               socket[i].socket.irq_mask = 0x000;
+               socket[i].socket.map_size = 0x1000;
+               socket[i].socket.io_offset = 0;
+               socket[i].socket.pci_irq = i  ? 7 : 9;
+               socket[i].socket.ops = &m8xx_services;
+               socket[i].socket.resource_ops = &pccard_nonstatic_ops;
+               socket[i].socket.cb_dev = NULL;
+               socket[i].socket.dev.dev = &m8xx_device.dev;
+       }
+
+       for (i = 0; i < PCMCIA_SOCKETS_NO; i++)
+               pcmcia_register_socket(&socket[i].socket);
+
+       return 0;
+}
+
+static void __exit m8xx_exit(void)
+{
+       int i;
+
+       for (i = 0; i < PCMCIA_SOCKETS_NO; i++)
+               pcmcia_unregister_socket(&socket[i].socket);
+
+       m8xx_shutdown();
+
+       platform_device_unregister(&m8xx_device);
+       driver_unregister(&m8xx_driver);
+}
+
+module_init(m8xx_init);
+module_exit(m8xx_exit);