Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 | /* * drivers/pcmcia/sa1100_jornada720.c * * Jornada720 PCMCIA specific routines * */ #include <linux/kernel.h> #include <linux/sched.h> #include <asm/hardware.h> #include "sa1100_generic.h" #include "sa1111_generic.h" #define SOCKET0_POWER GPIO_GPIO0 #define SOCKET0_3V GPIO_GPIO2 #define SOCKET1_POWER (GPIO_GPIO1 | GPIO_GPIO3) #warning *** Does SOCKET1_3V actually do anything? #define SOCKET1_3V GPIO_GPIO3 static int jornada720_pcmcia_init(struct pcmcia_init *init) { /* * What is all this crap for? */ GRER |= 0x00000002; /* Set GPIO_A<3:1> to be outputs for PCMCIA/CF power controller: */ PA_DDR = 0; PA_DWR = 0; PA_SDR = 0; PA_SSR = 0; PB_DDR = 0; PB_DWR = 0x01; PB_SDR = 0; PB_SSR = 0; PC_DDR = 0x88; PC_DWR = 0x20; PC_SDR = 0; PC_SSR = 0; return sa1111_pcmcia_init(init); } static int jornada720_pcmcia_configure_socket(const struct pcmcia_configure *conf) { unsigned int pa_dwr_mask, pa_dwr_set; int ret; printk("%s(): config socket %d vcc %d vpp %d\n", __FUNCTION__, conf->sock, conf->vcc, conf->vpp); switch (conf->sock) { case 0: pa_dwr_mask = SOCKET0_POWER | SOCKET0_3V; switch (conf->vcc) { default: case 0: pa_dwr_set = 0; break; case 33: pa_dwr_set = SOCKET0_POWER | SOCKET0_3V; break; case 50: pa_dwr_set = SOCKET0_POWER; break; } break; case 1: pa_dwr_mask = SOCKET1_POWER; switch (conf->vcc) { default: case 0: pa_dwr_set = 0; break; case 33: pa_dwr_set = SOCKET1_POWER; break; case 50: pa_dwr_set = SOCKET1_POWER; break; } break; } if (conf->vpp != conf->vcc && conf->vpp != 0) { printk(KERN_ERR "%s(): slot cannot support VPP %u\n", __FUNCTION__, conf->vpp); return -1; } ret = sa1111_pcmcia_configure_socket(conf); if (ret == 0) { unsigned long flags; local_irq_save(flags); PA_DWR = (PA_DWR & ~pa_dwr_mask) | pa_dwr_set; locla_irq_restore(flags); } return ret; } struct pcmcia_low_level jornada720_pcmcia_ops = { init: jornada720_pcmcia_init, shutdown: sa1111_pcmcia_shutdown, socket_state: sa1111_pcmcia_socket_state, get_irq_info: sa1111_pcmcia_get_irq_info, configure_socket: jornada720_pcmcia_configure_socket, socket_init: sa1111_pcmcia_socket_init, socket_suspend: sa1111_pcmcia_socket_suspend, }; |