mirror of
				https://github.com/smaeul/u-boot.git
				synced 2025-11-03 21:48:15 +00:00 
			
		
		
		
	Fix: pcmcia.c: In function 'cfg_ports': pcmcia.c:151:21: warning: variable 'cp' set but not used [-Wunused-but-set-variable] pcmcia.c:150:20: warning: variable 'immap' set but not used [-Wunused-but-set-variable] pcmcia.c: In function 'pcmcia_hardware_enable': pcmcia.c:179:25: warning: variable 'sysp' set but not used [-Wunused-but-set-variable] pcmcia.c:177:21: warning: variable 'cp' set but not used [-Wunused-but-set-variable] pcmcia.c:176:20: warning: variable 'immap' set but not used [-Wunused-but-set-variable] pcmcia.c: In function 'pcmcia_hardware_disable': pcmcia.c:271:25: warning: variable 'pcmp' set but not used [-Wunused-but-set-variable] pcmcia.c:270:20: warning: variable 'immap' set but not used [-Wunused-but-set-variable] pcmcia.c: In function 'pcmcia_voltage_set': pcmcia.c:303:9: warning: variable 'sreg' set but not used [-Wunused-but-set-variable] pcmcia.c:300:21: warning: variable 'cp' set but not used [-Wunused-but-set-variable] Signed-off-by: Wolfgang Denk <wd@denx.de>
		
			
				
	
	
		
			347 lines
		
	
	
		
			7.8 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			347 lines
		
	
	
		
			7.8 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
#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)
 | 
						|
{
 | 
						|
	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 pcmconf8xx_t	*pcmp;
 | 
						|
	uint reg, pipr, mask;
 | 
						|
	int i;
 | 
						|
 | 
						|
	debug ("hardware_enable: " PCMCIA_BOARD_MSG " Slot %c\n", 'A'+slot);
 | 
						|
 | 
						|
	udelay(10000);
 | 
						|
 | 
						|
	pcmp  = (pcmconf8xx_t *)(&(((immap_t *)CONFIG_SYS_IMMR)->im_pcmcia));
 | 
						|
 | 
						|
	/* 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)
 | 
						|
{
 | 
						|
	u_long reg;
 | 
						|
 | 
						|
	debug ("hardware_disable: " PCMCIA_BOARD_MSG " Slot %c\n", 'A'+slot);
 | 
						|
 | 
						|
	/* 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 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);
 | 
						|
 | 
						|
	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 */
 | 
						|
 | 
						|
	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 */
 |