/*
   * m8xx_pcmcia.c - Linux PCMCIA socket driver for the mpc8xx series.
   *
   * (C) 1999-2000 Magnus Damm <damm@opensource.se>
   * (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>
   * 
   * 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
   * 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 <linux/kernel.h>
  #include <linux/errno.h>
  #include <linux/timer.h>
  #include <linux/ioport.h>
  #include <linux/delay.h>
  #include <linux/interrupt.h>
  #include <linux/fsl_devices.h>
  #include <linux/bitops.h>
  #include <linux/of_address.h>
  #include <linux/of_device.h>
  #include <linux/of_irq.h>
  #include <linux/of_platform.h>
  
  #include <asm/io.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/ss.h>
  
  #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 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
  
  #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) */
  
  #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       */
  /* ------------------------------------------------------------------------- */
  
  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];
  
  /*
   * 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;
  };
  
  static const char driver_name[] = "m8xx-pcmcia";
  
  struct socket_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 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);
  
  #define PCMCIA_BMT_LIMIT (15*4)	/* Bus Monitor Timeout value */
  
  /* 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
  
  /* 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
  
  #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 u32 pending_events[PCMCIA_SOCKETS_NO];
  static DEFINE_SPINLOCK(pending_event_lock);
  
  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;
  
  	pr_debug("m8xx_pcmcia: Interrupt!
  ");
  	/* get interrupt sources */
  
  	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++) {
  		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!
  ",
  			   (pipr & (M8XX_PCMCIA_CD2(i)
  			   | M8XX_PCMCIA_CD1(i)))); */
  		}
  #endif
  
  		/* call the handler */
  
  		pr_debug("m8xx_pcmcia: slot %u: events = 0x%02x, pscr = 0x%08x, "
  			"pipr = 0x%08x
  ", 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(&pcmcia->pcmc_per, per);
  
  			if (events)
  				pcmcia_parse_events(&socket[i].socket, events);
  		}
  	}
  
  	/* clear the interrupt sources */
  	out_be32(&pcmcia->pcmc_pscr, pscr);
  
  	pr_debug("m8xx_pcmcia: Interrupt done.
  ");
  
  	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 bus_freq)
  {
  	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 = ((bus_freq / 1000) * ns) / 1000;
  	clocks = (clocks * ADJ) / (100 * 1000);
  	if (clocks >= PCMCIA_BMT_LIMIT) {
  		printk("Max access time limit reached
  ");
  		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;
  	pcmconf8xx_t *pcmcia = s->pcmcia;
  
  	pipr = in_be32(&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 */
  		};
  	}
  
  	pr_debug("m8xx_pcmcia: GetStatus(%d) = %#2.2x
  ", lsock, *value);
  	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;
  	pcmconf8xx_t *pcmcia = socket[0].pcmcia;
  
  	pr_debug("m8xx_pcmcia: SetSocket(%d, flags %#3.3x, Vcc %d, Vpp %d, "
  		"io_irq %d, csc_mask %#2.2x)
  ", 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 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 */
  	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(s->hwirq) << 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(&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 |=
  	    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);
  
  	/* 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;
  	pcmconf8xx_t *pcmcia = s->pcmcia;
  
  #define M8XX_SIZE (io->stop - io->start + 1)
  #define M8XX_BASE (PCMCIA_IO_WIN_BASE + io->start)
  
  	pr_debug("m8xx_pcmcia: SetIOMap(%d, %d, %#2.2x, %d ns, "
  		"%#4.4llx-%#4.4llx)
  ", 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)
  		return -EINVAL;
  
  	if (io->flags & MAP_ACTIVE) {
  
  		pr_debug("m8xx_pcmcia: io->flags & MAP_ACTIVE
  ");
  
  		winnr = (PCMCIA_MEM_WIN_NO * PCMCIA_SOCKETS_NO)
  		    + (lsock * PCMCIA_IO_WIN_NO) + io->map;
  
  		/* setup registers */
  
  		w = (void *)&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, s->bus_freq);
  
  		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);
  
  		pr_debug("m8xx_pcmcia: Socket %u: Mapped io window %u at "
  			"%#8.8x, OR = %#8.8x.
  ", 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 *)&pcmcia->pcmc_pbr0;
  		w += winnr;
  
  		out_be32(&w->or, 0);	/* turn off window */
  		out_be32(&w->br, 0);	/* turn off base address */
  
  		pr_debug("m8xx_pcmcia: Socket %u: Unmapped io window %u at "
  			"%#8.8x, OR = %#8.8x.
  ", 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);
  	pr_debug("m8xx_pcmcia: SetIOMap exit
  ");
  
  	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;
  	pcmconf8xx_t *pcmcia = s->pcmcia;
  
  	pr_debug("m8xx_pcmcia: SetMemMap(%d, %d, %#2.2x, %d ns, "
  		"%#5.5llx, %#5.5x)
  ", 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->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.
  ", 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 *)&pcmcia->pcmc_pbr0;
  	w += winnr;
  
  	reg |= lsock << 2;
  
  	reg |= m8xx_get_speed(mem->speed, 0, s->bus_freq);
  
  	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);
  
  	pr_debug("m8xx_pcmcia: Socket %u: Mapped memory window %u at %#8.8x, "
  		"OR = %#8.8x.
  ", 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;
  	}
  
  	pr_debug("m8xx_pcmcia: SetMemMap(%d, %d, %#2.2x, %d ns, "
  		"%#5.5llx, %#5.5x)
  ", 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);
  
  	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 };
  
  	pr_debug("m8xx_pcmcia: sock_init(%d)
  ", 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_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_sock_suspend,
  	.get_status = m8xx_get_status,
  	.set_socket = m8xx_set_socket,
  	.set_io_map = m8xx_set_io_map,
  	.set_mem_map = m8xx_set_mem_map,
  };
  
  static int __init m8xx_probe(struct platform_device *ofdev)
  {
  	struct pcmcia_win *w;
  	unsigned int i, m, hwirq;
  	pcmconf8xx_t *pcmcia;
  	int status;
  	struct device_node *np = ofdev->dev.of_node;
  
  	pcmcia_info("%s
  ", version);
  
  	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  (%d). 
  ", pcmcia_schlvl, hwirq);
  
  	/* Configure Status change interrupt */
  
  	if (request_irq(pcmcia_schlvl, m8xx_interrupt, IRQF_SHARED,
  			driver_name, socket)) {
  		pcmcia_error("Cannot allocate IRQ %u for SCHLVL!
  ",
  			     pcmcia_schlvl);
  		iounmap(pcmcia);
  		return -1;
  	}
  
  	w = (void *)&pcmcia->pcmc_pbr0;
  
  	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));
  
  	/* 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));
  
  	/* initialize 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);
  
  	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 = pcmcia_schlvl;
  		socket[i].socket.ops = &m8xx_services;
  		socket[i].socket.resource_ops = &pccard_iodyn_ops;
  		socket[i].socket.cb_dev = NULL;
  		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++) {
  		status = pcmcia_register_socket(&socket[i].socket);
  		if (status < 0)
  			pcmcia_error("Socket register failed
  ");
  	}
  
  	return 0;
  }
  
  static int m8xx_remove(struct platform_device *ofdev)
  {
  	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,
  };
  
  module_platform_driver(m8xx_pcmcia_driver);