371 lines
8.6 KiB
C
371 lines
8.6 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)
|
|
{
|
|
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 */
|