board/netta/pcmcia.c - uboot/qsr1000 - Git at Google

 #include <common.h>
 #include <mpc8xx.h>
 #include <pcmcia.h>

 #undef	CONFIG_PCMCIA

 #if defined(CONFIG_CMD_PCMCIA)
 #define	CONFIG_PCMCIA
 #endif

 #if defined(CONFIG_CMD_IDE) && defined(CONFIG_IDE_8xx_PCCARD)
 #define	CONFIG_PCMCIA
 #endif

 #ifdef	CONFIG_PCMCIA

 /* some sane bit macros */
 #define _BD(_b)				(1U << (31-(_b)))
 #define _BDR(_l, _h)			(((((1U << (31-(_l))) - 1) << 1) | 1) & ~((1U << (31-(_h))) - 1))

 #define _BW(_b)				(1U << (15-(_b)))
 #define _BWR(_l, _h)			(((((1U << (15-(_l))) - 1) << 1) | 1) & ~((1U << (15-(_h))) - 1))

 #define _BB(_b)				(1U << (7-(_b)))
 #define _BBR(_l, _h)			(((((1U << (7-(_l))) - 1) << 1) | 1) & ~((1U << (7-(_h))) - 1))

 #define _B(_b)				_BD(_b)
 #define _BR(_l, _h)			_BDR(_l, _h)

 #define PCMCIA_BOARD_MSG "NETTA"

 static const unsigned short vppd_masks[2] = { _BW(14), _BW(15) };

 static void cfg_vppd(int no)
 {
 	volatile immap_t *immap = (immap_t *)CONFIG_SYS_IMMR;
 	unsigned short mask;

 	if ((unsigned int)no >= sizeof(vppd_masks)/sizeof(vppd_masks[0]))
 		return;

 	mask = vppd_masks[no];

 	immap->im_ioport.iop_papar &= ~mask;
 	immap->im_ioport.iop_paodr &= ~mask;
 	immap->im_ioport.iop_padir |=  mask;
 }

 static void set_vppd(int no, int what)
 {
 	volatile immap_t *immap = (immap_t *)CONFIG_SYS_IMMR;
 	unsigned short mask;

 	if ((unsigned int)no >= sizeof(vppd_masks)/sizeof(vppd_masks[0]))
 		return;

 	mask = vppd_masks[no];

 	if (what)
 		immap->im_ioport.iop_padat |= mask;
 	else
 		immap->im_ioport.iop_padat &= ~mask;
 }

 static const unsigned short vccd_masks[2] = { _BW(10), _BW(6) };

 static void cfg_vccd(int no)
 {
 	volatile immap_t *immap = (immap_t *)CONFIG_SYS_IMMR;
 	unsigned short mask;

 	if ((unsigned int)no >= sizeof(vccd_masks)/sizeof(vccd_masks[0]))
 		return;

 	mask = vccd_masks[no];

 	immap->im_ioport.iop_papar &= ~mask;
 	immap->im_ioport.iop_paodr &= ~mask;
 	immap->im_ioport.iop_padir |=  mask;
 }

 static void set_vccd(int no, int what)
 {
 	volatile immap_t *immap = (immap_t *)CONFIG_SYS_IMMR;
 	unsigned short mask;

 	if ((unsigned int)no >= sizeof(vccd_masks)/sizeof(vccd_masks[0]))
 		return;

 	mask = vccd_masks[no];

 	if (what)
 		immap->im_ioport.iop_padat |= mask;
 	else
 		immap->im_ioport.iop_padat &= ~mask;
 }

 static const unsigned short oc_mask = _BW(8);

 static void cfg_oc(void)
 {
 	volatile immap_t *immap = (immap_t *)CONFIG_SYS_IMMR;
 	unsigned short mask = oc_mask;

 	immap->im_ioport.iop_pcdir &= ~mask;
 	immap->im_ioport.iop_pcso  &= ~mask;
 	immap->im_ioport.iop_pcint &= ~mask;
 	immap->im_ioport.iop_pcpar &= ~mask;
 }

 static int get_oc(void)
 {
 	volatile immap_t *immap = (immap_t *)CONFIG_SYS_IMMR;
 	unsigned short mask = oc_mask;
 	int what;

 	what = !!(immap->im_ioport.iop_pcdat & mask);;
 	return what;
 }

 static const unsigned short shdn_mask = _BW(12);

 static void cfg_shdn(void)
 {
 	volatile immap_t *immap = (immap_t *)CONFIG_SYS_IMMR;
 	unsigned short mask;

 	mask = shdn_mask;

 	immap->im_ioport.iop_papar &= ~mask;
 	immap->im_ioport.iop_paodr &= ~mask;
 	immap->im_ioport.iop_padir |=  mask;
 }

 static void set_shdn(int what)
 {
 	volatile immap_t *immap = (immap_t *)CONFIG_SYS_IMMR;
 	unsigned short mask;

 	mask = shdn_mask;

 	if (what)
 		immap->im_ioport.iop_padat |= mask;
 	else
 		immap->im_ioport.iop_padat &= ~mask;
 }

 static void cfg_ports (void)
 {
 	volatile immap_t	*immap;
 	volatile cpm8xx_t	*cp;

 	immap = (immap_t *)CONFIG_SYS_IMMR;
 	cp    = (cpm8xx_t *)(&(((immap_t *)CONFIG_SYS_IMMR)->im_cpm));


 	cfg_vppd(0); cfg_vppd(1);	/* VPPD0,VPPD1 VAVPP => Hi-Z */
 	cfg_vccd(0); cfg_vccd(1);	/* 3V and 5V off */
 	cfg_shdn();
 	cfg_oc();

 	/*
 	* Configure Port A for TPS2211 PC-Card Power-Interface Switch
 	*
 	* Switch off all voltages, assert shutdown
 	*/
 	set_vppd(0, 1); set_vppd(1, 1);
 	set_vccd(0, 0); set_vccd(1, 0);
 	set_shdn(1);

 	udelay(100000);
 }

 int pcmcia_hardware_enable(int slot)
 {
 	volatile immap_t	*immap;
 	volatile cpm8xx_t	*cp;
 	volatile pcmconf8xx_t	*pcmp;
 	volatile sysconf8xx_t	*sysp;
 	uint reg, pipr, mask;
 	int i;

 	debug ("hardware_enable: " PCMCIA_BOARD_MSG " Slot %c\n", 'A'+slot);

 	udelay(10000);

 	immap = (immap_t *)CONFIG_SYS_IMMR;
 	sysp  = (sysconf8xx_t *)(&(((immap_t *)CONFIG_SYS_IMMR)->im_siu_conf));
 	pcmp  = (pcmconf8xx_t *)(&(((immap_t *)CONFIG_SYS_IMMR)->im_pcmcia));
 	cp    = (cpm8xx_t *)(&(((immap_t *)CONFIG_SYS_IMMR)->im_cpm));

 	/* Configure Ports for TPS2211A PC-Card Power-Interface Switch */
 	cfg_ports ();

 	/* clear interrupt state, and disable interrupts */
 	pcmp->pcmc_pscr =  PCMCIA_MASK(_slot_);
 	pcmp->pcmc_per &= ~PCMCIA_MASK(_slot_);

 	/*
 	* Disable interrupts, DMA, and PCMCIA buffers
 	* (isolate the interface) and assert RESET signal
 	*/
 	debug ("Disable PCMCIA buffers and assert RESET\n");
 	reg  = 0;
 	reg |= __MY_PCMCIA_GCRX_CXRESET;	/* active high */
 	reg |= __MY_PCMCIA_GCRX_CXOE;		/* active low  */
 	PCMCIA_PGCRX(_slot_) = reg;

 	udelay(500);

 	/*
 	* Make sure there is a card in the slot, then configure the interface.
 	*/
 	udelay(10000);
 	debug ("[%d] %s: PIPR(%p)=0x%x\n",
 	       __LINE__,__FUNCTION__,
 	       &(pcmp->pcmc_pipr),pcmp->pcmc_pipr);
 	if (pcmp->pcmc_pipr & (0x18000000 >> (slot << 4))) {
 		printf ("   No Card found\n");
 		return (1);
 	}

 	/*
 	* Power On: Set VAVCC to 3.3V or 5V, set VAVPP to Hi-Z
 	*/
 	mask = PCMCIA_VS1(slot) | PCMCIA_VS2(slot);
 	pipr = pcmp->pcmc_pipr;
 	debug ("PIPR: 0x%x ==> VS1=o%s, VS2=o%s\n",
 	       pipr,
 	       (reg&PCMCIA_VS1(slot))?"n":"ff",
 	       (reg&PCMCIA_VS2(slot))?"n":"ff");

 	if ((pipr & mask) == mask) {
 		set_vppd(0, 1); set_vppd(1, 1);		/* VAVPP => Hi-Z */
 		set_vccd(0, 0); set_vccd(1, 1);		/* 5V on, 3V off */
 		puts (" 5.0V card found: ");
 	} else {
 		set_vppd(0, 1); set_vppd(1, 1);		/* VAVPP => Hi-Z */
 		set_vccd(0, 1); set_vccd(1, 0);		/* 5V off, 3V on */
 		puts (" 3.3V card found: ");
 	}

 	/*  Wait 500 ms; use this to check for over-current */
 	for (i=0; i<5000; ++i) {
 		if (!get_oc()) {
 			printf ("   *** Overcurrent - Safety shutdown ***\n");
 			set_vccd(0, 0); set_vccd(1, 0);		/* VAVPP => Hi-Z */
 			return (1);
 		}
 		udelay (100);
 	}

 	debug ("Enable PCMCIA buffers and stop RESET\n");
 	reg  =  PCMCIA_PGCRX(_slot_);
 	reg &= ~__MY_PCMCIA_GCRX_CXRESET;	/* active high */
 	reg &= ~__MY_PCMCIA_GCRX_CXOE;		/* active low  */
 	PCMCIA_PGCRX(_slot_) = reg;

 	udelay(250000);	/* some cards need >150 ms to come up :-( */

 	debug ("# hardware_enable done\n");

 	return (0);
 }


 #if defined(CONFIG_CMD_PCMCIA)
 int pcmcia_hardware_disable(int slot)
 {
 	volatile immap_t	*immap;
 	volatile pcmconf8xx_t	*pcmp;
 	u_long reg;

 	debug ("hardware_disable: " PCMCIA_BOARD_MSG " Slot %c\n", 'A'+slot);

 	immap = (immap_t *)CONFIG_SYS_IMMR;
 	pcmp  = (pcmconf8xx_t *)(&(((immap_t *)CONFIG_SYS_IMMR)->im_pcmcia));

 	/* Configure PCMCIA General Control Register */
 	debug ("Disable PCMCIA buffers and assert RESET\n");
 	reg  = 0;
 	reg |= __MY_PCMCIA_GCRX_CXRESET;	/* active high */
 	reg |= __MY_PCMCIA_GCRX_CXOE;		/* active low  */
 	PCMCIA_PGCRX(_slot_) = reg;

 	/* All voltages off / Hi-Z */
 	set_vppd(0, 1); set_vppd(1, 1);
 	set_vccd(0, 1); set_vccd(1, 1);

 	udelay(10000);

 	return (0);
 }
 #endif


 int pcmcia_voltage_set(int slot, int vcc, int vpp)
 {
 	volatile immap_t	*immap;
 	volatile cpm8xx_t	*cp;
 	volatile pcmconf8xx_t	*pcmp;
 	u_long reg;
 	ushort sreg;

 	debug ("voltage_set: "
 			PCMCIA_BOARD_MSG
 			" Slot %c, Vcc=%d.%d, Vpp=%d.%d\n",
 	'A'+slot, vcc/10, vcc%10, vpp/10, vcc%10);

 	immap = (immap_t *)CONFIG_SYS_IMMR;
 	cp    = (cpm8xx_t *)(&(((immap_t *)CONFIG_SYS_IMMR)->im_cpm));
 	pcmp  = (pcmconf8xx_t *)(&(((immap_t *)CONFIG_SYS_IMMR)->im_pcmcia));
 	/*
 	* Disable PCMCIA buffers (isolate the interface)
 	* and assert RESET signal
 	*/
 	debug ("Disable PCMCIA buffers and assert RESET\n");
 	reg  = PCMCIA_PGCRX(_slot_);
 	reg |= __MY_PCMCIA_GCRX_CXRESET;	/* active high */
 	reg |= __MY_PCMCIA_GCRX_CXOE;		/* active low  */
 	PCMCIA_PGCRX(_slot_) = reg;
 	udelay(500);

 	/*
 	* Configure Port C pins for
 	* 5 Volts Enable and 3 Volts enable,
 	* Turn all power pins to Hi-Z
 	*/
 	debug ("PCMCIA power OFF\n");
 	cfg_ports ();	/* Enables switch, but all in Hi-Z */

 	sreg  = immap->im_ioport.iop_pcdat;
 	set_vppd(0, 1); set_vppd(1, 1);

 	switch(vcc) {
 		case  0:
 			break;	/* Switch off		*/

 		case 33:
 			set_vccd(0, 1); set_vccd(1, 0);
 			break;

 		case 50:
 			set_vccd(0, 0); set_vccd(1, 1);
 			break;

 		default:
 			goto done;
 	}

 	/* Checking supported voltages */

 	debug ("PIPR: 0x%x --> %s\n",
 	       pcmp->pcmc_pipr,
 	       (pcmp->pcmc_pipr & 0x00008000) ? "only 5 V" : "can do 3.3V");

 done:
 			debug ("Enable PCMCIA buffers and stop RESET\n");
 	reg  =  PCMCIA_PGCRX(_slot_);
 	reg &= ~__MY_PCMCIA_GCRX_CXRESET;	/* active high */
 	reg &= ~__MY_PCMCIA_GCRX_CXOE;		/* active low  */
 	PCMCIA_PGCRX(_slot_) = reg;
 	udelay(500);

 	debug ("voltage_set: " PCMCIA_BOARD_MSG " Slot %c, DONE\n",
 	       slot+'A');
 	return (0);
 }

 #endif	/* CONFIG_PCMCIA */
	#include <common.h>
	#include <mpc8xx.h>
	#include <pcmcia.h>

	#undef CONFIG_PCMCIA

	#if defined(CONFIG_CMD_PCMCIA)
	#define CONFIG_PCMCIA
	#endif

	#if defined(CONFIG_CMD_IDE) && defined(CONFIG_IDE_8xx_PCCARD)
	#define CONFIG_PCMCIA
	#endif

	#ifdef CONFIG_PCMCIA

	/* some sane bit macros */
	#define _BD(_b) (1U << (31-(_b)))
	#define _BDR(_l, _h) (((((1U << (31-(_l))) - 1) << 1) \| 1) & ~((1U << (31-(_h))) - 1))

	#define _BW(_b) (1U << (15-(_b)))
	#define _BWR(_l, _h) (((((1U << (15-(_l))) - 1) << 1) \| 1) & ~((1U << (15-(_h))) - 1))

	#define _BB(_b) (1U << (7-(_b)))
	#define _BBR(_l, _h) (((((1U << (7-(_l))) - 1) << 1) \| 1) & ~((1U << (7-(_h))) - 1))

	#define _B(_b) _BD(_b)
	#define _BR(_l, _h) _BDR(_l, _h)

	#define PCMCIA_BOARD_MSG "NETTA"

	static const unsigned short vppd_masks[2] = { _BW(14), _BW(15) };

	static void cfg_vppd(int no)
	{
	volatile immap_t immap = (immap_t )CONFIG_SYS_IMMR;
	unsigned short mask;

	if ((unsigned int)no >= sizeof(vppd_masks)/sizeof(vppd_masks[0]))
	return;

	mask = vppd_masks[no];

	immap->im_ioport.iop_papar &= ~mask;
	immap->im_ioport.iop_paodr &= ~mask;
	immap->im_ioport.iop_padir \|= mask;
	}

	static void set_vppd(int no, int what)
	{
	volatile immap_t immap = (immap_t )CONFIG_SYS_IMMR;
	unsigned short mask;

	if ((unsigned int)no >= sizeof(vppd_masks)/sizeof(vppd_masks[0]))
	return;

	mask = vppd_masks[no];

	if (what)
	immap->im_ioport.iop_padat \|= mask;
	else
	immap->im_ioport.iop_padat &= ~mask;
	}

	static const unsigned short vccd_masks[2] = { _BW(10), _BW(6) };

	static void cfg_vccd(int no)
	{
	volatile immap_t immap = (immap_t )CONFIG_SYS_IMMR;
	unsigned short mask;

	if ((unsigned int)no >= sizeof(vccd_masks)/sizeof(vccd_masks[0]))
	return;

	mask = vccd_masks[no];

	immap->im_ioport.iop_papar &= ~mask;
	immap->im_ioport.iop_paodr &= ~mask;
	immap->im_ioport.iop_padir \|= mask;
	}

	static void set_vccd(int no, int what)
	{
	volatile immap_t immap = (immap_t )CONFIG_SYS_IMMR;
	unsigned short mask;

	if ((unsigned int)no >= sizeof(vccd_masks)/sizeof(vccd_masks[0]))
	return;

	mask = vccd_masks[no];

	if (what)
	immap->im_ioport.iop_padat \|= mask;
	else
	immap->im_ioport.iop_padat &= ~mask;
	}

	static const unsigned short oc_mask = _BW(8);

	static void cfg_oc(void)
	{
	volatile immap_t immap = (immap_t )CONFIG_SYS_IMMR;
	unsigned short mask = oc_mask;

	immap->im_ioport.iop_pcdir &= ~mask;
	immap->im_ioport.iop_pcso &= ~mask;
	immap->im_ioport.iop_pcint &= ~mask;
	immap->im_ioport.iop_pcpar &= ~mask;
	}

	static int get_oc(void)
	{
	volatile immap_t immap = (immap_t )CONFIG_SYS_IMMR;
	unsigned short mask = oc_mask;
	int what;

	what = !!(immap->im_ioport.iop_pcdat & mask);;
	return what;
	}

	static const unsigned short shdn_mask = _BW(12);

	static void cfg_shdn(void)
	{
	volatile immap_t immap = (immap_t )CONFIG_SYS_IMMR;
	unsigned short mask;

	mask = shdn_mask;

	immap->im_ioport.iop_papar &= ~mask;
	immap->im_ioport.iop_paodr &= ~mask;
	immap->im_ioport.iop_padir \|= mask;
	}

	static void set_shdn(int what)
	{
	volatile immap_t immap = (immap_t )CONFIG_SYS_IMMR;
	unsigned short mask;

	mask = shdn_mask;

	if (what)
	immap->im_ioport.iop_padat \|= mask;
	else
	immap->im_ioport.iop_padat &= ~mask;
	}

	static void cfg_ports (void)
	{
	volatile immap_t *immap;
	volatile cpm8xx_t *cp;

	immap = (immap_t *)CONFIG_SYS_IMMR;
	cp = (cpm8xx_t )(&(((immap_t )CONFIG_SYS_IMMR)->im_cpm));


	cfg_vppd(0); cfg_vppd(1); /* VPPD0,VPPD1 VAVPP => Hi-Z */
	cfg_vccd(0); cfg_vccd(1); /* 3V and 5V off */
	cfg_shdn();
	cfg_oc();

	/*
	* Configure Port A for TPS2211 PC-Card Power-Interface Switch
	*
	* Switch off all voltages, assert shutdown
	*/
	set_vppd(0, 1); set_vppd(1, 1);
	set_vccd(0, 0); set_vccd(1, 0);
	set_shdn(1);

	udelay(100000);
	}

	int pcmcia_hardware_enable(int slot)
	{
	volatile immap_t *immap;
	volatile cpm8xx_t *cp;
	volatile pcmconf8xx_t *pcmp;
	volatile sysconf8xx_t *sysp;
	uint reg, pipr, mask;
	int i;

	debug ("hardware_enable: " PCMCIA_BOARD_MSG " Slot %c\n", 'A'+slot);

	udelay(10000);

	immap = (immap_t *)CONFIG_SYS_IMMR;
	sysp = (sysconf8xx_t )(&(((immap_t )CONFIG_SYS_IMMR)->im_siu_conf));
	pcmp = (pcmconf8xx_t )(&(((immap_t )CONFIG_SYS_IMMR)->im_pcmcia));
	cp = (cpm8xx_t )(&(((immap_t )CONFIG_SYS_IMMR)->im_cpm));

	/* Configure Ports for TPS2211A PC-Card Power-Interface Switch */
	cfg_ports ();

	/* clear interrupt state, and disable interrupts */
	pcmp->pcmc_pscr = PCMCIA_MASK(_slot_);
	pcmp->pcmc_per &= ~PCMCIA_MASK(_slot_);

	/*
	* Disable interrupts, DMA, and PCMCIA buffers
	* (isolate the interface) and assert RESET signal
	*/
	debug ("Disable PCMCIA buffers and assert RESET\n");
	reg = 0;
	reg \|= __MY_PCMCIA_GCRX_CXRESET; /* active high */
	reg \|= __MY_PCMCIA_GCRX_CXOE; /* active low */
	PCMCIA_PGCRX(_slot_) = reg;

	udelay(500);

	/*
	* Make sure there is a card in the slot, then configure the interface.
	*/
	udelay(10000);
	debug ("[%d] %s: PIPR(%p)=0x%x\n",
	__LINE__,__FUNCTION__,
	&(pcmp->pcmc_pipr),pcmp->pcmc_pipr);
	if (pcmp->pcmc_pipr & (0x18000000 >> (slot << 4))) {
	printf (" No Card found\n");
	return (1);
	}

	/*
	* Power On: Set VAVCC to 3.3V or 5V, set VAVPP to Hi-Z
	*/
	mask = PCMCIA_VS1(slot) \| PCMCIA_VS2(slot);
	pipr = pcmp->pcmc_pipr;
	debug ("PIPR: 0x%x ==> VS1=o%s, VS2=o%s\n",
	pipr,
	(reg&PCMCIA_VS1(slot))?"n":"ff",
	(reg&PCMCIA_VS2(slot))?"n":"ff");

	if ((pipr & mask) == mask) {
	set_vppd(0, 1); set_vppd(1, 1); /* VAVPP => Hi-Z */
	set_vccd(0, 0); set_vccd(1, 1); /* 5V on, 3V off */
	puts (" 5.0V card found: ");
	} else {
	set_vppd(0, 1); set_vppd(1, 1); /* VAVPP => Hi-Z */
	set_vccd(0, 1); set_vccd(1, 0); /* 5V off, 3V on */
	puts (" 3.3V card found: ");
	}

	/* Wait 500 ms; use this to check for over-current */
	for (i=0; i<5000; ++i) {
	if (!get_oc()) {
	printf (" * Overcurrent - Safety shutdown *\n");
	set_vccd(0, 0); set_vccd(1, 0); /* VAVPP => Hi-Z */
	return (1);
	}
	udelay (100);
	}

	debug ("Enable PCMCIA buffers and stop RESET\n");
	reg = PCMCIA_PGCRX(_slot_);
	reg &= ~__MY_PCMCIA_GCRX_CXRESET; /* active high */
	reg &= ~__MY_PCMCIA_GCRX_CXOE; /* active low */
	PCMCIA_PGCRX(_slot_) = reg;

	udelay(250000); /* some cards need >150 ms to come up :-( */

	debug ("# hardware_enable done\n");

	return (0);
	}


	#if defined(CONFIG_CMD_PCMCIA)
	int pcmcia_hardware_disable(int slot)
	{
	volatile immap_t *immap;
	volatile pcmconf8xx_t *pcmp;
	u_long reg;

	debug ("hardware_disable: " PCMCIA_BOARD_MSG " Slot %c\n", 'A'+slot);

	immap = (immap_t *)CONFIG_SYS_IMMR;
	pcmp = (pcmconf8xx_t )(&(((immap_t )CONFIG_SYS_IMMR)->im_pcmcia));

	/* Configure PCMCIA General Control Register */
	debug ("Disable PCMCIA buffers and assert RESET\n");
	reg = 0;
	reg \|= __MY_PCMCIA_GCRX_CXRESET; /* active high */
	reg \|= __MY_PCMCIA_GCRX_CXOE; /* active low */
	PCMCIA_PGCRX(_slot_) = reg;

	/* All voltages off / Hi-Z */
	set_vppd(0, 1); set_vppd(1, 1);
	set_vccd(0, 1); set_vccd(1, 1);

	udelay(10000);

	return (0);
	}
	#endif


	int pcmcia_voltage_set(int slot, int vcc, int vpp)
	{
	volatile immap_t *immap;
	volatile cpm8xx_t *cp;
	volatile pcmconf8xx_t *pcmp;
	u_long reg;
	ushort sreg;

	debug ("voltage_set: "
	PCMCIA_BOARD_MSG
	" Slot %c, Vcc=%d.%d, Vpp=%d.%d\n",
	'A'+slot, vcc/10, vcc%10, vpp/10, vcc%10);

	immap = (immap_t *)CONFIG_SYS_IMMR;
	cp = (cpm8xx_t )(&(((immap_t )CONFIG_SYS_IMMR)->im_cpm));
	pcmp = (pcmconf8xx_t )(&(((immap_t )CONFIG_SYS_IMMR)->im_pcmcia));
	/*
	* Disable PCMCIA buffers (isolate the interface)
	* and assert RESET signal
	*/
	debug ("Disable PCMCIA buffers and assert RESET\n");
	reg = PCMCIA_PGCRX(_slot_);
	reg \|= __MY_PCMCIA_GCRX_CXRESET; /* active high */
	reg \|= __MY_PCMCIA_GCRX_CXOE; /* active low */
	PCMCIA_PGCRX(_slot_) = reg;
	udelay(500);

	/*
	* Configure Port C pins for
	* 5 Volts Enable and 3 Volts enable,
	* Turn all power pins to Hi-Z
	*/
	debug ("PCMCIA power OFF\n");
	cfg_ports (); /* Enables switch, but all in Hi-Z */

	sreg = immap->im_ioport.iop_pcdat;
	set_vppd(0, 1); set_vppd(1, 1);

	switch(vcc) {
	case 0:
	break; /* Switch off */

	case 33:
	set_vccd(0, 1); set_vccd(1, 0);
	break;

	case 50:
	set_vccd(0, 0); set_vccd(1, 1);
	break;

	default:
	goto done;
	}

	/* Checking supported voltages */

	debug ("PIPR: 0x%x --> %s\n",
	pcmp->pcmc_pipr,
	(pcmp->pcmc_pipr & 0x00008000) ? "only 5 V" : "can do 3.3V");

	done:
	debug ("Enable PCMCIA buffers and stop RESET\n");
	reg = PCMCIA_PGCRX(_slot_);
	reg &= ~__MY_PCMCIA_GCRX_CXRESET; /* active high */
	reg &= ~__MY_PCMCIA_GCRX_CXOE; /* active low */
	PCMCIA_PGCRX(_slot_) = reg;
	udelay(500);

	debug ("voltage_set: " PCMCIA_BOARD_MSG " Slot %c, DONE\n",
	slot+'A');
	return (0);
	}

	#endif /* CONFIG_PCMCIA */