Viewing file: sa1100_pfs168.c (5.78 KB) -rw-r--r-- Select action/file-type: (+) | (+) | (+) | Code (+) | Session (+) | (+) | SDB (+) | (+) | (+) | (+) | (+) | (+) |
#warning "REVISIT_PFS168: Need to verify and test GPIO power encodings." /* * drivers/pcmcia/sa1100_pfs168.c * * PFS168 PCMCIA specific routines * */ #include <linux/kernel.h> #include <linux/sched.h>
#include <asm/delay.h> #include <asm/hardware.h> #include <asm/irq.h> #include <asm/arch/pcmcia.h>
static int pfs168_pcmcia_init(struct pcmcia_init *init){ int return_val=0;
/* TPS2211 to standby mode: */ PA_DWR &= ~(GPIO_GPIO0 | GPIO_GPIO1 | GPIO_GPIO2 | GPIO_GPIO3);
/* Set GPIO_A<3:0> to be outputs for PCMCIA (socket 0) power controller: */ PA_DDR &= ~(GPIO_GPIO0 | GPIO_GPIO1 | GPIO_GPIO2 | GPIO_GPIO3);
INTPOL1 |= (1 << (S0_READY_NINT - SA1111_IRQ(32))) | (1 << (S1_READY_NINT - SA1111_IRQ(32))) | (1 << (S0_CD_VALID - SA1111_IRQ(32))) | (1 << (S1_CD_VALID - SA1111_IRQ(32))) | (1 << (S0_BVD1_STSCHG - SA1111_IRQ(32))) | (1 << (S1_BVD1_STSCHG - SA1111_IRQ(32)));
return_val+=request_irq(S0_CD_VALID, init->handler, SA_INTERRUPT, "PFS168 PCMCIA (0) CD", NULL); return_val+=request_irq(S1_CD_VALID, init->handler, SA_INTERRUPT, "PFS168 CF (1) CD", NULL); return_val+=request_irq(S0_BVD1_STSCHG, init->handler, SA_INTERRUPT, "PFS168 PCMCIA (0) BVD1", NULL); return_val+=request_irq(S1_BVD1_STSCHG, init->handler, SA_INTERRUPT, "PFS168 CF (1) BVD1", NULL);
return (return_val<0) ? -1 : 2; }
static int pfs168_pcmcia_shutdown(void){
free_irq(S0_CD_VALID, NULL); free_irq(S1_CD_VALID, NULL); free_irq(S0_BVD1_STSCHG, NULL); free_irq(S1_BVD1_STSCHG, NULL);
INTPOL1 &= ~((1 << (S0_CD_VALID - SA1111_IRQ(32))) | (1 << (S1_CD_VALID - SA1111_IRQ(32))) | (1 << (S0_BVD1_STSCHG - SA1111_IRQ(32))) | (1 << (S1_BVD1_STSCHG - SA1111_IRQ(32))));
return 0; }
static int pfs168_pcmcia_socket_state(struct pcmcia_state_array *state_array){ unsigned long status; int return_val=1;
if(state_array->size<2) return -1;
memset(state_array->state, 0, (state_array->size)*sizeof(struct pcmcia_state));
status=PCSR;
state_array->state[0].detect=((status & PCSR_S0_DETECT)==0)?1:0;
state_array->state[0].ready=((status & PCSR_S0_READY)==0)?0:1;
state_array->state[0].bvd1=((status & PCSR_S0_BVD1)==0)?0:1;
state_array->state[0].bvd2=((status & PCSR_S0_BVD2)==0)?0:1;
state_array->state[0].wrprot=((status & PCSR_S0_WP)==0)?0:1;
state_array->state[0].vs_3v=((status & PCSR_S0_VS1)==0)?1:0;
state_array->state[0].vs_Xv=((status & PCSR_S0_VS2)==0)?1:0;
state_array->state[1].detect=((status & PCSR_S1_DETECT)==0)?1:0;
state_array->state[1].ready=((status & PCSR_S1_READY)==0)?0:1;
state_array->state[1].bvd1=((status & PCSR_S1_BVD1)==0)?0:1;
state_array->state[1].bvd2=((status & PCSR_S1_BVD2)==0)?0:1;
state_array->state[1].wrprot=((status & PCSR_S1_WP)==0)?0:1;
state_array->state[1].vs_3v=((status & PCSR_S1_VS1)==0)?1:0;
state_array->state[1].vs_Xv=((status & PCSR_S1_VS2)==0)?1:0;
return return_val; }
static int pfs168_pcmcia_get_irq_info(struct pcmcia_irq_info *info){
switch(info->sock){ case 0: info->irq=S0_READY_NINT; break;
case 1: info->irq=S1_READY_NINT; break;
default: return -1; }
return 0; }
static int pfs168_pcmcia_configure_socket(const struct pcmcia_configure *configure){ unsigned long pccr=PCCR, gpio=PA_DWR;
/* PFS168 uses the Texas Instruments TPS2211 for PCMCIA (socket 0) voltage control only, * with the following connections: * * TPS2211 PFS168 * * -VCCD0 SA-1111 GPIO A<0> * -VCCD0 SA-1111 GPIO A<1> * VPPD0 SA-1111 GPIO A<2> * VPPD0 SA-1111 GPIO A<2> * */
switch(configure->sock){ case 0:
switch(configure->vcc){ case 0: pccr = (pccr & ~PCCR_S0_FLT); gpio &= ~(GPIO_GPIO0 | GPIO_GPIO1); break;
case 33: pccr = (pccr & ~PCCR_S0_PSE) | PCCR_S0_FLT | PCCR_S0_PWAITEN; gpio = (gpio & ~(GPIO_GPIO0 | GPIO_GPIO1)) | GPIO_GPIO0; break;
case 50: pccr = (pccr | PCCR_S0_PSE | PCCR_S0_FLT | PCCR_S0_PWAITEN); gpio = (gpio & ~(GPIO_GPIO0 | GPIO_GPIO1)) | GPIO_GPIO1; break;
default: printk(KERN_ERR "%s(): unrecognized Vcc %u\n", __FUNCTION__, configure->vcc); return -1; }
switch(configure->vpp){ case 0: gpio &= ~(GPIO_GPIO2 | GPIO_GPIO3); break;
case 120: printk(KERN_ERR "%s(): PFS-168 does not support Vpp %uV\n", __FUNCTION__, configure->vpp/10); return -1; break;
default: if(configure->vpp == configure->vcc) gpio = (gpio & ~(GPIO_GPIO2 | GPIO_GPIO3)) | GPIO_GPIO3; else { printk(KERN_ERR "%s(): unrecognized Vpp %u\n", __FUNCTION__, configure->vpp); return -1; } }
pccr = (configure->reset)?(pccr | PCCR_S0_RST):(pccr & ~PCCR_S0_RST);
PA_DWR = gpio;
break;
case 1: switch(configure->vcc){ case 0: pccr = (pccr & ~PCCR_S1_FLT); break;
case 33: pccr = (pccr & ~PCCR_S1_PSE) | PCCR_S1_FLT | PCCR_S1_PWAITEN; break;
case 50: printk(KERN_ERR "%s(): PFS-168 CompactFlash socket does not support Vcc %uV\n", __FUNCTION__, configure->vcc/10); return -1; break;
default: printk(KERN_ERR "%s(): unrecognized Vcc %u\n", __FUNCTION__, configure->vcc); return -1; }
if(configure->vpp!=configure->vcc && configure->vpp!=0){ printk(KERN_ERR "%s(): CompactFlash socket does not support Vpp %uV\n", __FUNCTION__, configure->vpp/10); return -1; }
pccr = (configure->reset)?(pccr | PCCR_S1_RST):(pccr & ~PCCR_S1_RST);
break;
default: return -1; }
PCCR = pccr;
return 0; }
struct pcmcia_low_level pfs168_pcmcia_ops = { pfs168_pcmcia_init, pfs168_pcmcia_shutdown, pfs168_pcmcia_socket_state, pfs168_pcmcia_get_irq_info, pfs168_pcmcia_configure_socket };
|