#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#define PCMCIA_BOARD_MSG "KUP"#define KUP4K_PCMCIA_B_3V3 (0x00020000)int pcmcia_hardware_enable(int slot){	volatile immap_t	*immap;	volatile cpm8xx_t	*cp;	volatile pcmconf8xx_t	*pcmp;	volatile sysconf8xx_t	*sysp;	uint reg, mask;	debug ("hardware_enable: " PCMCIA_BOARD_MSG " Slot %c\n", 'A'+slot);	udelay(10000);	immap = (immap_t *)CFG_IMMR;	sysp  = (sysconf8xx_t *)(&(((immap_t *)CFG_IMMR)->im_siu_conf));	pcmp  = (pcmconf8xx_t *)(&(((immap_t *)CFG_IMMR)->im_pcmcia));	cp    = (cpm8xx_t *)(&(((immap_t *)CFG_IMMR)->im_cpm));	/*	* Configure SIUMCR to enable PCMCIA port B	* (VFLS[0:1] are not used for debugging, we connect FRZ# instead)	*/	sysp->sc_siumcr &= ~SIUMCR_DBGC11;	/* set DBGC to 00 */	/* 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(2500);	/*	* Configure Port B pins for	* 3 Volts enable	*/	if (slot) { /* Slot A is built-in */		cp->cp_pbdir |=  KUP4K_PCMCIA_B_3V3;		cp->cp_pbpar &= ~KUP4K_PCMCIA_B_3V3;		/* remove all power */		cp->cp_pbdat |=  KUP4K_PCMCIA_B_3V3; /* active low */	}	/*	* 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.	*/	printf("%s  Slot %c:", slot ? "" : "\n", 'A' + slot);	mask = PCMCIA_VS1(slot) | PCMCIA_VS2(slot);	reg  = pcmp->pcmc_pipr;	debug ("PIPR: 0x%x ==> VS1=o%s, VS2=o%s\n",	       reg,	       (reg&PCMCIA_VS1(slot))?"n":"ff",	       (reg&PCMCIA_VS2(slot))?"n":"ff");	if ((reg & mask) == mask) {		puts (" 5.0V card found: NOT SUPPORTED !!!\n");	} else {		if(slot)			cp->cp_pbdat &= ~KUP4K_PCMCIA_B_3V3;		puts (" 3.3V card found: ");	}#if 0	/*  VCC switch error flag, PCMCIA slot INPACK_ pin */	cp->cp_pbdir &= ~(0x0020 | 0x0010);	cp->cp_pbpar &= ~(0x0020 | 0x0010);	udelay(500000);#endif	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 cpm8xx_t	*cp;	volatile pcmconf8xx_t	*pcmp;	u_long reg;	debug ("hardware_disable: " PCMCIA_BOARD_MSG " Slot %c\n", 'A'+slot);	immap = (immap_t *)CFG_IMMR;	pcmp = (pcmconf8xx_t *)(&(((immap_t *)CFG_IMMR)->im_pcmcia));	cp    = (cpm8xx_t *)(&(((immap_t *)CFG_IMMR)->im_cpm));	/* remove all power */	if (slot)		cp->cp_pbdat |= KUP4K_PCMCIA_B_3V3;	/* 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;	udelay(10000);	return (0);}#endifint pcmcia_voltage_set(int slot, int vcc, int vpp){	volatile immap_t	*immap;	volatile cpm8xx_t	*cp;	volatile pcmconf8xx_t	*pcmp;	u_long reg;	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);	if (!slot) /* Slot A is not configurable */		return 0;	immap = (immap_t *)CFG_IMMR;	pcmp = (pcmconf8xx_t *)(&(((immap_t *)CFG_IMMR)->im_pcmcia));	cp    = (cpm8xx_t *)(&(((immap_t *)CFG_IMMR)->im_cpm));	/*	* 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);	debug ("PCMCIA power OFF\n");	/*	* Configure Port B pins for	* 3 Volts enable	*/	cp->cp_pbdir |=  KUP4K_PCMCIA_B_3V3;	cp->cp_pbpar &= ~KUP4K_PCMCIA_B_3V3;	/* remove all power */	cp->cp_pbdat |=  KUP4K_PCMCIA_B_3V3; /* active low */	switch(vcc) {		case  0:		break;		case 33:			cp->cp_pbdat &= ~KUP4K_PCMCIA_B_3V3;			debug ("PCMCIA powered at 3.3V\n");			break;		case 50:			debug ("PCMCIA: 5Volt vcc not supported\n");			break;		default:			puts("PCMCIA: vcc not supported");			break;	}	udelay(10000);	/* Checking supported voltages */	debug ("PIPR: 0x%x --> %s\n",	       pcmp->pcmc_pipr,	       (pcmp->pcmc_pipr & (0x80000000 >> (slot << 4)))			       ? "only 5 V --> NOT SUPPORTED"	: "can do 3.3V");	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 */