drivers/pcmcia/sa1100_graphicsmaster.c

   1 /*
   2  * drivers/pcmcia/sa1100_graphicsmaster.c
   3  *
   4  * PCMCIA implementation routines for GraphicsMaster
   5  *
   6  * 9/18/01 Woojung
   7  *         Fixed wrong PCMCIA voltage setting
   8  * 7/5/01 Woojung Huh <whuh@applieddata.net>
   9  *
  10  */
  11 #include <linux/module.h>
  12 #include <linux/kernel.h>
  13 #include <linux/sched.h>
  14 #include <linux/device.h>
  15 #include <linux/init.h>
  16
  17 #include <asm/hardware.h>
  18 #include <asm/mach-types.h>
  19
  20 #include "sa1111_generic.h"
  21
  22 static int graphicsmaster_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
  23 {
  24   int return_val=0;
  25
  26   /* Set GPIO_A<3:0> to be outputs for PCMCIA/CF power controller: */
  27   PA_DDR &= ~(GPIO_GPIO0 | GPIO_GPIO1 | GPIO_GPIO2 | GPIO_GPIO3);
  28
  29   /* Disable Power 3.3V/5V for PCMCIA/CF */
  30   PA_DWR |= GPIO_GPIO0 | GPIO_GPIO1 | GPIO_GPIO2 | GPIO_GPIO3;
  31
  32   /* why? */
  33   MECR = 0x09430943;
  34
  35   return sa1111_pcmcia_hwinit(skt);
  36 }
  37
  38 static int
  39 graphicsmaster_pcmcia_configure_socket(struct soc_pcmcia_socket *skt,
  40                                        const socket_state_t *state)
  41 {
  42         unsigned int pa_dwr_mask, pa_dwr_set;
  43         int ret;
  44
  45         switch (skt->nr) {
  46         case 0:
  47                 pa_dwr_mask = GPIO_GPIO0 | GPIO_GPIO1;
  48
  49                 switch (state->Vcc) {
  50                 default:
  51                 case 0:  pa_dwr_set = GPIO_GPIO0 | GPIO_GPIO1;  break;
  52                 case 33: pa_dwr_set = GPIO_GPIO1;               break;
  53                 case 50: pa_dwr_set = GPIO_GPIO0;               break;
  54                 }
  55                 break;
  56
  57         case 1:
  58                 pa_dwr_mask = GPIO_GPIO2 | GPIO_GPIO3;
  59
  60                 switch (state->Vcc) {
  61                 default:
  62                 case 0:  pa_dwr_set = GPIO_GPIO2 | GPIO_GPIO3;  break;
  63                 case 33: pa_dwr_set = GPIO_GPIO3;               break;
  64                 case 50: pa_dwr_set = GPIO_GPIO2;               break;
  65                 }
  66                 break;
  67         }
  68
  69         if (state->Vpp != state->Vcc && state->Vpp != 0) {
  70                 printk(KERN_ERR "%s(): CF slot cannot support Vpp %u\n",
  71                         __FUNCTION__, state->Vpp);
  72                 return -1;
  73         }
  74
  75         ret = sa1111_pcmcia_configure_socket(skt, state);
  76         if (ret == 0) {
  77                 unsigned long flags;
  78
  79                 local_irq_save(flags);
  80                 PA_DWR = (PA_DWR & ~pa_dwr_mask) | pa_dwr_set;
  81                 local_irq_restore(flags);
  82         }
  83
  84         return ret;
  85 }
  86
  87 static struct pcmcia_low_level graphicsmaster_pcmcia_ops = {
  88         .owner                  = THIS_MODULE,
  89         .hw_init                = graphicsmaster_pcmcia_init,
  90         .hw_shutdown            = sa1111_pcmcia_hw_shutdown,
  91         .socket_state           = sa1111_pcmcia_socket_state,
  92         .configure_socket       = graphicsmaster_pcmcia_configure_socket,
  93
  94         .socket_init            = sa1111_pcmcia_socket_init,
  95         .socket_suspend         = sa1111_pcmcia_socket_suspend,
  96 };
  97
  98 int __init pcmcia_graphicsmaster_init(struct device *dev)
  99 {
 100         int ret = -ENODEV;
 101
 102         if (machine_is_graphicsmaster())
 103                 ret = sa11xx_drv_pcmcia_probe(dev, &graphicsmaster_pcmcia_ops, 0, 2);
 104
 105         return ret;
 106 }