pcmcia: pxa2xx/vpac270: free gpios on exist rather than requesting
[linux-2.6.git] / drivers / pcmcia / m8xx_pcmcia.c
index 6d9f71c..271a590 100644 (file)
@@ -1,7 +1,7 @@
 /*
  * m8xx_pcmcia.c - Linux PCMCIA socket driver for the mpc8xx series.
  *
- * (C) 1999-2000 Magnus Damm <damm@bitsmart.com>
+ * (C) 1999-2000 Magnus Damm <damm@opensource.se>
  * (C) 2001-2002 Montavista Software, Inc.
  *     <mlocke@mvista.com>
  *
@@ -9,6 +9,9 @@
  *     <oliver.kurth@cyclades.de>
  * Further fixes, v2.6 kernel port
  *     <marcelo.tosatti@cyclades.com>
+ * 
+ * Some fixes, additions (C) 2005-2007 Montavista Software, Inc.
+ *     <vbordug@ru.mvista.com>
  *
  * "The ExCA standard specifies that socket controllers should provide
  * two IO and five memory windows per socket, which can be independently
 #include <linux/fcntl.h>
 #include <linux/string.h>
 
-#include <asm/io.h>
-#include <asm/bitops.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 <linux/platform_device.h>
+#include <linux/fsl_devices.h>
+#include <linux/bitops.h>
+#include <linux/of_device.h>
+#include <linux/of_platform.h>
 
+#include <asm/io.h>
+#include <asm/system.h>
+#include <asm/time.h>
 #include <asm/mpc8xx.h>
 #include <asm/8xx_immap.h>
 #include <asm/irq.h>
+#include <asm/fs_pd.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)
 
@@ -97,13 +90,18 @@ MODULE_LICENSE("Dual MPL/GPL");
 #endif
 #endif
 
+#if defined(CONFIG_MPC885ADS)
+#define CONFIG_PCMCIA_SLOT_A
+#define PCMCIA_GLITCHY_CD
+#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) */
+#endif                         /* !defined(CONFIG_PCMCIA_SLOT_A) && !defined(CONFIG_PCMCIA_SLOT_B) */
 
 #if defined(CONFIG_PCMCIA_SLOT_A) && defined(CONFIG_PCMCIA_SLOT_B)
 
@@ -136,30 +134,20 @@ MODULE_LICENSE("Dual MPL/GPL");
 
 /* ------------------------------------------------------------------------- */
 
-#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      */
-
+#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       */
 /* ------------------------------------------------------------------------- */
 
-/* 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;
+static int pcmcia_schlvl;
 
+static DEFINE_SPINLOCK(events_lock);
 
 #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
-};
+static u32 *m8xx_pgcrx[2];
 
 /*
  * This structure is used to address each window in the PCMCIA controller.
@@ -169,8 +157,8 @@ static u32 *m8xx_pgcrx[2] = {
  */
 
 struct pcmcia_win {
-       u32     br;
-       u32     or;
+       u32 br;
+       u32 or;
 };
 
 /*
@@ -214,22 +202,27 @@ struct pcmcia_win {
 
 /* we keep one lookup table per socket to check flags */
 
-#define PCMCIA_EVENTS_MAX 5  /* 4 max at a time + termination */
+#define PCMCIA_EVENTS_MAX 5    /* 4 max at a time + termination */
 
 struct event_table {
        u32 regbit;
        u32 eventbit;
 };
 
+static const char driver_name[] = "m8xx-pcmcia";
+
 struct socket_info {
-       void    (*handler)(void *info, u32 events);
-       void    *info;
+       void (*handler) (void *info, u32 events);
+       void *info;
 
        u32 slot;
+       pcmconf8xx_t *pcmcia;
+       u32 bus_freq;
+       int hwirq;
 
        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 pccard_io_map io_win[PCMCIA_IO_WIN_NO];
        struct event_table events[PCMCIA_EVENTS_MAX];
        struct pcmcia_socket socket;
 };
@@ -243,8 +236,7 @@ static struct socket_info socket[PCMCIA_SOCKETS_NO];
 
 #define M8XX_SIZES_NO 32
 
-static const u32 m8xx_size_to_gray[M8XX_SIZES_NO] =
-{
+static const u32 m8xx_size_to_gray[M8XX_SIZES_NO] = {
        0x00000001, 0x00000002, 0x00000008, 0x00000004,
        0x00000080, 0x00000040, 0x00000010, 0x00000020,
        0x00008000, 0x00004000, 0x00001000, 0x00002000,
@@ -258,9 +250,9 @@ static const u32 m8xx_size_to_gray[M8XX_SIZES_NO] =
 
 /* ------------------------------------------------------------------------- */
 
-static irqreturn_t m8xx_interrupt(int irq, void *dev, struct pt_regs *regs);
+static irqreturn_t m8xx_interrupt(int irq, void *dev);
 
-#define PCMCIA_BMT_LIMIT (15*4)  /* Bus Monitor Timeout value */
+#define PCMCIA_BMT_LIMIT (15*4)        /* Bus Monitor Timeout value */
 
 /* ------------------------------------------------------------------------- */
 /* board specific stuff:                                                     */
@@ -284,8 +276,9 @@ static int voltage_set(int slot, int vcc, int vpp)
 {
        u32 reg = 0;
 
-       switch(vcc) {
-       case 0: break;
+       switch (vcc) {
+       case 0:
+               break;
        case 33:
                reg |= BCSR1_PCVCTL4;
                break;
@@ -296,11 +289,12 @@ static int voltage_set(int slot, int vcc, int vpp)
                return 1;
        }
 
-       switch(vpp) {
-       case 0: break;
+       switch (vpp) {
+       case 0:
+               break;
        case 33:
        case 50:
-               if(vcc == vpp)
+               if (vcc == vpp)
                        reg |= BCSR1_PCVCTL6;
                else
                        return 1;
@@ -311,25 +305,29 @@ static int voltage_set(int slot, int vcc, int vpp)
                return 1;
        }
 
-       if(!((vcc == 50) || (vcc == 0)))
+       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));
+       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);
+       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 */
+#define hardware_enable(_slot_)        /* No hardware to enable */
+#define hardware_disable(_slot_)       /* No hardware to disable */
 
-#endif /* CONFIG_RPXCLASSIC */
+#endif                         /* CONFIG_RPXCLASSIC */
 
 /* FADS Boards from Motorola                                               */
 
@@ -341,43 +339,45 @@ 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 (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:
+       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));
+       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);
+       out_be32((u32 *) BCSR1, in_be32((u32 *) BCSR1) | reg);
 
        return 0;
 }
@@ -386,12 +386,36 @@ static int voltage_set(int slot, int vcc, int vpp)
 
 static void hardware_enable(int slot)
 {
-       out_be32(&((u32 *)BCSR1), in_be32(&((u32 *)BCSR1)) & ~BCSR1_PCCEN);
+       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);
+       out_be32((u32 *) BCSR1, in_be32((u32 *) BCSR1) | BCSR1_PCCEN);
+}
+
+#endif
+
+/* MPC885ADS Boards */
+
+#if defined(CONFIG_MPC885ADS)
+
+#define PCMCIA_BOARD_MSG "MPC885ADS"
+#define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
+
+static inline void hardware_enable(int slot)
+{
+       m8xx_pcmcia_ops.hw_ctrl(slot, 1);
+}
+
+static inline void hardware_disable(int slot)
+{
+       m8xx_pcmcia_ops.hw_ctrl(slot, 0);
+}
+
+static inline int voltage_set(int slot, int vcc, int vpp)
+{
+       return m8xx_pcmcia_ops.voltage_set(slot, vcc, vpp);
 }
 
 #endif
@@ -407,52 +431,53 @@ 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 (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:
+       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));
+       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);
+       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 */
+#define hardware_enable(_slot_)        /* No hardware to enable */
+#define hardware_disable(_slot_)       /* No hardware to disable */
 
-#endif /* CONFIG_MBX */
+#endif                         /* CONFIG_MBX */
 
 #if defined(CONFIG_PRxK)
 #include <asm/cpld.h>
@@ -466,43 +491,46 @@ static int voltage_set(int slot, int vcc, int vpp)
        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 (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:
+       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)))) {
+       if (reg !=
+           (regread & ((PCMCIA_VCC_MASK | PCMCIA_VPP_MASK) >> (slot << 2)))) {
                /* enable new powersettings */
-               regread = regread & ~((PCMCIA_VCC_MASK | PCMCIA_VPP_MASK) >> (slot << 2));
+               regread =
+                   regread & ~((PCMCIA_VCC_MASK | PCMCIA_VPP_MASK) >>
+                               (slot << 2));
                out_8(&ccpld->fpga_pc_ctl, reg | regread);
                msleep(100);
        }
@@ -511,79 +539,38 @@ static int voltage_set(int slot, int vcc, int vpp)
 }
 
 #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);
+#define hardware_enable(_slot_)        /* No hardware to enable */
+#define hardware_disable(_slot_)       /* No hardware to disable */
 
-               /* disable external hardware */
-               hardware_disable(i);
-       }
-
-       free_irq(pcmcia_schlvl, NULL);
-}
-
-static struct device_driver m8xx_driver = {
-        .name = "m8xx-pcmcia",
-        .bus = &platform_bus_type,
-        .suspend = pcmcia_socket_dev_suspend,
-        .resume = pcmcia_socket_dev_resume,
-};
-
-static struct platform_device m8xx_device = {
-        .name = "m8xx-pcmcia",
-        .id = 0,
-};
+#endif                         /* CONFIG_PRxK */
 
 static u32 pending_events[PCMCIA_SOCKETS_NO];
-static spinlock_t pending_event_lock = SPIN_LOCK_UNLOCKED;
+static DEFINE_SPINLOCK(pending_event_lock);
 
-static irqreturn_t m8xx_interrupt(int irq, void *dev, struct pt_regs *regs)
+static irqreturn_t m8xx_interrupt(int irq, void *dev)
 {
        struct socket_info *s;
        struct event_table *e;
        unsigned int i, events, pscr, pipr, per;
+       pcmconf8xx_t *pcmcia = socket[0].pcmcia;
 
-       dprintk("Interrupt!\n");
+       pr_debug("m8xx_pcmcia: 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);
+       pscr = in_be32(&pcmcia->pcmc_pscr);
+       pipr = in_be32(&pcmcia->pcmc_pipr);
+       per = in_be32(&pcmcia->pcmc_per);
 
-       for(i = 0; i < PCMCIA_SOCKETS_NO; i++) {
+       for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
                s = &socket[i];
                e = &s->events[0];
                events = 0;
 
-               while(e->regbit) {
-                       if(pscr & e->regbit)
+               while (e->regbit) {
+                       if (pscr & e->regbit)
                                events |= e->eventbit;
 
-                               e++;
+                       e++;
                }
 
                /*
@@ -591,13 +578,11 @@ static irqreturn_t m8xx_interrupt(int irq, void *dev, struct pt_regs *regs)
                 * 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)))
-                       {
+               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.
@@ -605,24 +590,23 @@ static irqreturn_t m8xx_interrupt(int irq, void *dev, struct pt_regs *regs)
                 * 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)) {
+               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))));*/
+                          (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);
+               pr_debug("m8xx_pcmcia: slot %u: events = 0x%02x, pscr = 0x%08x, "
+                       "pipr = 0x%08x\n", i, events, pscr, pipr);
 
-               if(events) {
+               if (events) {
                        spin_lock(&pending_event_lock);
                        pending_events[i] |= events;
                        spin_unlock(&pending_event_lock);
@@ -636,7 +620,7 @@ static irqreturn_t m8xx_interrupt(int irq, void *dev, struct pt_regs *regs)
                        per &= ~M8XX_PCMCIA_RDY_L(0);
                        per &= ~M8XX_PCMCIA_RDY_L(1);
 
-                       out_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_per, per);
+                       out_be32(&pcmcia->pcmc_per, per);
 
                        if (events)
                                pcmcia_parse_events(&socket[i].socket, events);
@@ -644,9 +628,9 @@ static irqreturn_t m8xx_interrupt(int irq, void *dev, struct pt_regs *regs)
        }
 
        /* clear the interrupt sources */
-       out_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pscr, pscr);
+       out_be32(&pcmcia->pcmc_pscr, pscr);
 
-       dprintk("Interrupt done.\n");
+       pr_debug("m8xx_pcmcia: Interrupt done.\n");
 
        return IRQ_HANDLED;
 }
@@ -655,21 +639,21 @@ static u32 m8xx_get_graycode(u32 size)
 {
        u32 k;
 
-       for(k = 0; k < M8XX_SIZES_NO; k++)
-               if(m8xx_size_to_gray[k] == size)
+       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))
+       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)
+static u32 m8xx_get_speed(u32 ns, u32 is_io, u32 bus_freq)
 {
        u32 reg, clocks, psst, psl, psht;
 
-       if(!ns) {
+       if (!ns) {
 
                /*
                 * We get called with IO maps setup to 0ns
@@ -677,10 +661,10 @@ static u32 m8xx_get_speed(u32 ns, u32 is_io)
                 * They should be 255ns.
                 */
 
-               if(is_io)
+               if (is_io)
                        ns = 255;
                else
-                       ns = 100;  /* fast memory if 0 */
+                       ns = 100;       /* fast memory if 0 */
        }
 
        /*
@@ -691,23 +675,23 @@ static u32 m8xx_get_speed(u32 ns, u32 is_io)
 
 /* how we want to adjust the timing - in percent */
 
-#define ADJ 180 /* 80 % longer accesstime - to be sure */
+#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;
+       clocks = ((bus_freq / 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 / 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 = psst << 12;
+       reg |= psl << 7;
        reg |= psht << 16;
 
        return reg;
@@ -718,11 +702,12 @@ 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;
+       pcmconf8xx_t *pcmcia = s->pcmcia;
 
-       pipr = in_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pipr);
+       pipr = in_be32(&pcmcia->pcmc_pipr);
 
-       *value  = ((pipr & (M8XX_PCMCIA_CD1(lsock)
-                           | M8XX_PCMCIA_CD2(lsock))) == 0) ? SS_DETECT : 0;
+       *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)
@@ -806,55 +791,46 @@ static int m8xx_get_status(struct pcmcia_socket *sock, unsigned int *value)
        /* read out VS1 and VS2 */
 
        reg = (pipr & M8XX_PCMCIA_VS_MASK(lsock))
-               >> M8XX_PCMCIA_VS_SHIFT(lsock);
+           >> M8XX_PCMCIA_VS_SHIFT(lsock);
 
-       if(socket_get(lsock) == PCMCIA_SOCKET_KEY_LV) {
-               switch(reg) {
+       if (socket_get(lsock) == PCMCIA_SOCKET_KEY_LV) {
+               switch (reg) {
                case 1:
                        *value |= SS_3VCARD;
-                       break; /* GND, NC - 3.3V only */
+                       break;  /* GND, NC - 3.3V only */
                case 2:
                        *value |= SS_XVCARD;
-                       break; /* NC. GND - x.xV only */
+                       break;  /* NC. GND - x.xV only */
                };
        }
 
-       dprintk("GetStatus(%d) = %#2.2x\n", lsock, *value);
+       pr_debug("m8xx_pcmcia: 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)
+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;
+       pcmconf8xx_t *pcmcia = socket[0].pcmcia;
 
-       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);
+       pr_debug("m8xx_pcmcia: 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))
+       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 */
+       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);
+               out_be32(M8XX_PGCRX(lsock),
+                        in_be32(M8XX_PGCRX(lsock)) & ~M8XX_PGCRX_CXRESET);
 
        /* ... and output enable. */
 
@@ -863,13 +839,14 @@ static int m8xx_set_socket(struct pcmcia_socket *sock, socket_state_t *state)
           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.
+          no pullups are present -> the cards act weird.
           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 */
+       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);
+               out_be32(M8XX_PGCRX(lsock),
+                        in_be32(M8XX_PGCRX(lsock)) | M8XX_PGCRX_CXOE);
 
        /*
         * We'd better turn off interrupts before
@@ -886,17 +863,17 @@ static int m8xx_set_socket(struct pcmcia_socket *sock, socket_state_t *state)
        e = &s->events[0];
        reg = 0;
 
-       if(state->csc_mask & SS_DETECT) {
+       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) {
+       if (state->flags & SS_IOCARD) {
                /*
                 * I/O card
                 */
-               if(state->csc_mask & SS_STSCHG) {
+               if (state->csc_mask & SS_STSCHG) {
                        e->eventbit = SS_STSCHG;
                        reg |= e->regbit = M8XX_PCMCIA_BVD1(lsock);
                        e++;
@@ -904,8 +881,10 @@ static int m8xx_set_socket(struct pcmcia_socket *sock, socket_state_t *state)
                /*
                 * 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);
+               if (state->io_irq) {
+                       out_be32(M8XX_PGCRX(lsock),
+                                in_be32(M8XX_PGCRX(lsock)) |
+                                mk_int_int_mask(s->hwirq) << 24);
                        /*
                         * Strange thing here:
                         * The manual does not tell us which interrupt
@@ -916,33 +895,32 @@ static int m8xx_set_socket(struct pcmcia_socket *sock, socket_state_t *state)
                         * 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 {
+               } else
+                       out_be32(M8XX_PGCRX(lsock),
+                                in_be32(M8XX_PGCRX(lsock)) & 0x00ffffff);
+       } else {
                /*
                 * Memory card
                 */
-               if(state->csc_mask & SS_BATDEAD) {
+               if (state->csc_mask & SS_BATDEAD) {
                        e->eventbit = SS_BATDEAD;
                        reg |= e->regbit = M8XX_PCMCIA_BVD1(lsock);
                        e++;
                }
-               if(state->csc_mask & SS_BATWARN) {
+               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) {
+               if (state->csc_mask & SS_READY) {
                        e->eventbit = SS_READY;
-                       reg |= e->regbit = 0; //??
+                       reg |= e->regbit = 0;   //??
                        e++;
                }
        }
 
-       e->regbit = 0;  /* terminate list */
+       e->regbit = 0;          /* terminate list */
 
        /*
         * Clear the status changed .
@@ -950,7 +928,7 @@ static int m8xx_set_socket(struct pcmcia_socket *sock, socket_state_t *state)
         * Writing ones will clear the bits.
         */
 
-       out_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pscr, reg);
+       out_be32(&pcmcia->pcmc_pscr, reg);
 
        /*
         * Write the mask.
@@ -959,15 +937,10 @@ static int m8xx_set_socket(struct pcmcia_socket *sock, socket_state_t *state)
         * 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);
+       reg |=
+           in_be32(&pcmcia->
+                   pcmc_per) & (M8XX_PCMCIA_MASK(0) | M8XX_PCMCIA_MASK(1));
+       out_be32(&pcmcia->pcmc_per, reg);
 
        spin_unlock_irqrestore(&events_lock, flags);
 
@@ -985,103 +958,106 @@ static int m8xx_set_io_map(struct pcmcia_socket *sock, struct pccard_io_map *io)
        struct socket_info *s = &socket[lsock];
        struct pcmcia_win *w;
        unsigned int reg, winnr;
+       pcmconf8xx_t *pcmcia = s->pcmcia;
 
 #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);
+       pr_debug("m8xx_pcmcia: SetIOMap(%d, %d, %#2.2x, %d ns, "
+               "%#4.4llx-%#4.4llx)\n", lsock, io->map, io->flags,
+               io->speed, (unsigned long long)io->start,
+               (unsigned long long)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)
+       if ((reg = m8xx_get_graycode(M8XX_SIZE)) == -1)
                return -EINVAL;
 
-       if(io->flags & MAP_ACTIVE) {
+       if (io->flags & MAP_ACTIVE) {
 
-               dprintk( "io->flags & MAP_ACTIVE\n");
+               pr_debug("m8xx_pcmcia: io->flags & MAP_ACTIVE\n");
 
                winnr = (PCMCIA_MEM_WIN_NO * PCMCIA_SOCKETS_NO)
-                       + (lsock * PCMCIA_IO_WIN_NO) + io->map;
+                   + (lsock * PCMCIA_IO_WIN_NO) + io->map;
 
                /* setup registers */
 
-               w = (void *) &((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pbr0;
+               w = (void *)&pcmcia->pcmc_pbr0;
                w += winnr;
 
-               out_be32(&w->or, 0); /* turn off window first */
+               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_PCMCIA_POR_IO | (lsock << 2);
 
-               reg |= m8xx_get_speed(io->speed, 1);
+               reg |= m8xx_get_speed(io->speed, 1, s->bus_freq);
 
-               if(io->flags & MAP_WRPROT)
+               if (io->flags & MAP_WRPROT)
                        reg |= M8XX_PCMCIA_POR_WRPROT;
 
-               /*if(io->flags & (MAP_16BIT | MAP_AUTOSZ))*/
-               if(io->flags & MAP_16BIT)
+               /*if(io->flags & (MAP_16BIT | MAP_AUTOSZ)) */
+               if (io->flags & MAP_16BIT)
                        reg |= M8XX_PCMCIA_POR_16BIT;
 
-               if(io->flags & MAP_ACTIVE)
+               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);
+               pr_debug("m8xx_pcmcia: 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;
+                   + (lsock * PCMCIA_IO_WIN_NO) + io->map;
 
                /* setup registers */
 
-               w = (void *) &((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pbr0;
+               w = (void *)&pcmcia->pcmc_pbr0;
                w += winnr;
 
-               out_be32(&w->or, 0); /* turn off window */
-               out_be32(&w->br, 0); /* turn off base address */
+               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);
+               pr_debug("m8xx_pcmcia: 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");
+       s->io_win[io->map].flags &= (MAP_WRPROT | MAP_16BIT | MAP_ACTIVE);
+       pr_debug("m8xx_pcmcia: SetIOMap exit\n");
 
        return 0;
 }
 
-static int m8xx_set_mem_map(struct pcmcia_socket *sock, struct pccard_mem_map *mem)
+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;
+       pcmconf8xx_t *pcmcia = s->pcmcia;
 
-       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);
+       pr_debug("m8xx_pcmcia: SetMemMap(%d, %d, %#2.2x, %d ns, "
+               "%#5.5llx, %#5.5x)\n", lsock, mem->map, mem->flags,
+               mem->speed, (unsigned long long)mem->static_start,
+               mem->card_start);
 
        if ((mem->map >= PCMCIA_MEM_WIN_NO)
-//         || ((mem->s) >= PCMCIA_MEM_WIN_SIZE)
+//          || ((mem->s) >= PCMCIA_MEM_WIN_SIZE)
            || (mem->card_start >= 0x04000000)
-           || (mem->static_start & 0xfff)                /* 4KByte resolution */
-           || (mem->card_start & 0xfff))
+           || (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);
+       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;
@@ -1090,50 +1066,48 @@ static int m8xx_set_mem_map(struct pcmcia_socket *sock, struct pccard_mem_map *m
 
        /* Setup the window in the pcmcia controller */
 
-       w = (void *) &((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pbr0;
+       w = (void *)&pcmcia->pcmc_pbr0;
        w += winnr;
 
        reg |= lsock << 2;
 
-       reg |= m8xx_get_speed(mem->speed, 0);
+       reg |= m8xx_get_speed(mem->speed, 0, s->bus_freq);
 
-       if(mem->flags & MAP_ATTRIB)
-               reg |=  M8XX_PCMCIA_POR_ATTRMEM;
+       if (mem->flags & MAP_ATTRIB)
+               reg |= M8XX_PCMCIA_POR_ATTRMEM;
 
-       if(mem->flags & MAP_WRPROT)
+       if (mem->flags & MAP_WRPROT)
                reg |= M8XX_PCMCIA_POR_WRPROT;
 
-       if(mem->flags & MAP_16BIT)
+       if (mem->flags & MAP_16BIT)
                reg |= M8XX_PCMCIA_POR_16BIT;
 
-       if(mem->flags & MAP_ACTIVE)
+       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);
+       pr_debug("m8xx_pcmcia: 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) {
+       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;
+                   (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);
+       pr_debug("m8xx_pcmcia: SetMemMap(%d, %d, %#2.2x, %d ns, "
+               "%#5.5llx, %#5.5x)\n", lsock, mem->map, mem->flags,
+               mem->speed, (unsigned long long)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);
+       old->flags &= (MAP_ATTRIB | MAP_WRPROT | MAP_16BIT | MAP_ACTIVE);
 
        return 0;
 }
@@ -1144,7 +1118,7 @@ static int m8xx_sock_init(struct pcmcia_socket *sock)
        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);
+       pr_debug("m8xx_pcmcia: sock_init(%d)\n", s);
 
        m8xx_set_socket(sock, &dead_socket);
        for (i = 0; i < PCMCIA_IO_WIN_NO; i++) {
@@ -1160,112 +1134,184 @@ static int m8xx_sock_init(struct pcmcia_socket *sock)
 
 }
 
-static int m8xx_suspend(struct pcmcia_socket *sock)
+static int m8xx_sock_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,
+       .init = m8xx_sock_init,
+       .suspend = m8xx_sock_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)
+static int __init m8xx_probe(struct platform_device *ofdev)
 {
        struct pcmcia_win *w;
-       unsigned int i,m;
+       unsigned int i, m, hwirq;
+       pcmconf8xx_t *pcmcia;
+       int status;
+       struct device_node *np = ofdev->dev.of_node;
 
        pcmcia_info("%s\n", version);
 
-       if (driver_register(&m8xx_driver))
-               return -1;
+       pcmcia = of_iomap(np, 0);
+       if (pcmcia == NULL)
+               return -EINVAL;
+
+       pcmcia_schlvl = irq_of_parse_and_map(np, 0);
+       hwirq = irq_map[pcmcia_schlvl].hwirq;
+       if (pcmcia_schlvl < 0) {
+               iounmap(pcmcia);
+               return -EINVAL;
+       }
+
+       m8xx_pgcrx[0] = &pcmcia->pcmc_pgcra;
+       m8xx_pgcrx[1] = &pcmcia->pcmc_pgcrb;
 
        pcmcia_info(PCMCIA_BOARD_MSG " using " PCMCIA_SLOT_MSG
-                   " with IRQ %u.\n", pcmcia_schlvl);
+                   " with IRQ %u  (%d). \n", pcmcia_schlvl, hwirq);
 
        /* Configure Status change interrupt */
 
-       if(request_irq(pcmcia_schlvl, m8xx_interrupt, 0,
-                         "m8xx_pcmcia", NULL)) {
+       if (request_irq(pcmcia_schlvl, m8xx_interrupt, IRQF_SHARED,
+                       driver_name, socket)) {
                pcmcia_error("Cannot allocate IRQ %u for SCHLVL!\n",
                             pcmcia_schlvl);
+               iounmap(pcmcia);
                return -1;
        }
 
-       w = (void *) &((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pbr0;
+       w = (void *)&pcmcia->pcmc_pbr0;
 
-       out_be32(&((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pscr,
-               M8XX_PCMCIA_MASK(0)| M8XX_PCMCIA_MASK(1));
+       out_be32(&pcmcia->pcmc_pscr, M8XX_PCMCIA_MASK(0) | M8XX_PCMCIA_MASK(1));
+       clrbits32(&pcmcia->pcmc_per, 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 */
 
-/* connect interrupt and disable CxOE */
+       out_be32(M8XX_PGCRX(0),
+                M8XX_PGCRX_CXOE | (mk_int_int_mask(hwirq) << 16));
+       out_be32(M8XX_PGCRX(1),
+                M8XX_PGCRX_CXOE | (mk_int_int_mask(hwirq) << 16));
 
-       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));
+       /* initialize the fixed memory windows */
 
-/* intialize the fixed memory windows */
-
-       for(i = 0; i < PCMCIA_SOCKETS_NO; i++){
-               for(m = 0; m < PCMCIA_MEM_WIN_NO; m++) {
+       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)));
+                                (PCMCIA_MEM_WIN_SIZE
+                                 * (m + i * PCMCIA_MEM_WIN_NO)));
 
-                       out_be32(&w->or, 0);  /* set to not valid */
+                       out_be32(&w->or, 0);    /* set to not valid */
 
                        w++;
                }
        }
 
-/* turn off voltage */
+       /* turn off voltage */
        voltage_set(0, 0, 0);
        voltage_set(1, 0, 0);
 
-/* Enable external hardware */
+       /* Enable external hardware */
        hardware_enable(0);
        hardware_enable(1);
 
-       platform_device_register(&m8xx_device);
-
-       for (i = 0 ; i < PCMCIA_SOCKETS_NO; i++) {
+       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.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.pci_irq = pcmcia_schlvl;
                socket[i].socket.ops = &m8xx_services;
-               socket[i].socket.resource_ops = &pccard_nonstatic_ops;
+               socket[i].socket.resource_ops = &pccard_iodyn_ops;
                socket[i].socket.cb_dev = NULL;
-               socket[i].socket.dev.dev = &m8xx_device.dev;
+               socket[i].socket.dev.parent = &ofdev->dev;
+               socket[i].pcmcia = pcmcia;
+               socket[i].bus_freq = ppc_proc_freq;
+               socket[i].hwirq = hwirq;
+
        }
 
-       for (i = 0; i < PCMCIA_SOCKETS_NO; i++)
-               pcmcia_register_socket(&socket[i].socket);
+       for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
+               status = pcmcia_register_socket(&socket[i].socket);
+               if (status < 0)
+                       pcmcia_error("Socket register failed\n");
+       }
 
        return 0;
 }
 
-static void __exit m8xx_exit(void)
+static int m8xx_remove(struct platform_device *ofdev)
 {
-       int i;
+       u32 m, i;
+       struct pcmcia_win *w;
+       pcmconf8xx_t *pcmcia = socket[0].pcmcia;
+
+       for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
+               w = (void *)&pcmcia->pcmc_pbr0;
+
+               out_be32(&pcmcia->pcmc_pscr, M8XX_PCMCIA_MASK(i));
+               out_be32(&pcmcia->pcmc_per,
+                        in_be32(&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);
+       }
        for (i = 0; i < PCMCIA_SOCKETS_NO; i++)
                pcmcia_unregister_socket(&socket[i].socket);
+       iounmap(pcmcia);
+
+       free_irq(pcmcia_schlvl, NULL);
+
+       return 0;
+}
+
+static const struct of_device_id m8xx_pcmcia_match[] = {
+       {
+        .type = "pcmcia",
+        .compatible = "fsl,pq-pcmcia",
+        },
+       {},
+};
+
+MODULE_DEVICE_TABLE(of, m8xx_pcmcia_match);
+
+static struct platform_driver m8xx_pcmcia_driver = {
+       .driver = {
+               .name = driver_name,
+               .owner = THIS_MODULE,
+               .of_match_table = m8xx_pcmcia_match,
+       },
+       .probe = m8xx_probe,
+       .remove = m8xx_remove,
+};
 
-       m8xx_shutdown();
+static int __init m8xx_init(void)
+{
+       return platform_driver_register(&m8xx_pcmcia_driver);
+}
 
-       platform_device_unregister(&m8xx_device);
-       driver_unregister(&m8xx_driver);
+static void __exit m8xx_exit(void)
+{
+       platform_driver_unregister(&m8xx_pcmcia_driver);
 }
 
 module_init(m8xx_init);