Subversion Repositories or1k

/*

 * drivers/pcmcia/sa1100_cerf.c

 *

 * PCMCIA implementation routines for CerfBoard

 * Based off the Assabet.

 *

 */

#include <linux/kernel.h>

#include <linux/sched.h>

#include <asm/hardware.h>

#include <asm/irq.h>

#include "sa1100_generic.h"

#ifdef CONFIG_SA1100_CERF_CPLD

#define CERF_SOCKET     0

#else

#define CERF_SOCKET     1

#endif

static struct irqs {

        int irq;

        unsigned int gpio;

        const char *str;

} irqs[] = {

        { IRQ_GPIO_CF_CD,   GPIO_CF_CD,   "CF_CD"   },

        { IRQ_GPIO_CF_BVD2, GPIO_CF_BVD2, "CF_BVD2" },

        { IRQ_GPIO_CF_BVD1, GPIO_CF_BVD1, "CF_BVD1" }

};

static int cerf_pcmcia_init(struct pcmcia_init *init)

{

  int i, res;

  set_GPIO_IRQ_edge( GPIO_CF_IRQ, GPIO_FALLING_EDGE );

  for (i = 0; i < ARRAY_SIZE(irqs); i++) {

    set_GPIO_IRQ_edge(irqs[i].gpio, GPIO_NO_EDGES);

    res = request_irq(irqs[i].irq, init->handler, SA_INTERRUPT,

                      irqs[i].str, NULL);

    if (res)

      goto irq_err;

  }

  return 2;

 irq_err:

  printk(KERN_ERR "%s: Request for IRQ%d failed\n", __FUNCTION__, irqs[i].irq);

  while (i--)

    free_irq(irqs[i].irq, NULL);

  return -1;

}

static int cerf_pcmcia_shutdown(void)

{

  int i;

  for (i = 0; i < ARRAY_SIZE(irqs); i++)

    free_irq(irqs[i].irq, NULL);

  return 0;

}

static int cerf_pcmcia_socket_state(struct pcmcia_state_array

                                       *state_array){

  unsigned long levels;

  int i = CERF_SOCKET;

  if(state_array->size<2) return -1;

  levels=GPLR;

  state_array->state[i].detect=((levels & GPIO_CF_CD)==0)?1:0;

  state_array->state[i].ready=(levels & GPIO_CF_IRQ)?1:0;

  state_array->state[i].bvd1=(levels & GPIO_CF_BVD1)?1:0;

  state_array->state[i].bvd2=(levels & GPIO_CF_BVD2)?1:0;

  state_array->state[i].wrprot=0;

  state_array->state[i].vs_3v=1;

  state_array->state[i].vs_Xv=0;

  return 1;

}

static int cerf_pcmcia_get_irq_info(struct pcmcia_irq_info *info){

  if(info->sock>1) return -1;

  if (info->sock == CERF_SOCKET)

    info->irq=IRQ_GPIO_CF_IRQ;

  return 0;

}

static int cerf_pcmcia_configure_socket(const struct pcmcia_configure

                                           *configure)

{

  if(configure->sock>1)

    return -1;

  if (configure->sock != CERF_SOCKET)

    return 0;

  switch(configure->vcc){

  case 0:

    break;

  case 50:

  case 33:

#ifdef CONFIG_SA1100_CERF_CPLD

     GPCR = GPIO_PWR_SHUTDOWN;

#endif

     break;

  default:

    printk(KERN_ERR "%s(): unrecognized Vcc %u\n", __FUNCTION__,

           configure->vcc);

    return -1;

  }

  if(configure->reset)

  {

#ifdef CONFIG_SA1100_CERF_CPLD

    GPSR = GPIO_CF_RESET;

#endif

  }

  else

  {

#ifdef CONFIG_SA1100_CERF_CPLD

    GPCR = GPIO_CF_RESET;

#endif

  }

  return 0;

}

static int cerf_pcmcia_socket_init(int sock)

{

  int i;

  if (sock == CERF_SOCKET)

    for (i = 0; i < ARRAY_SIZE(irqs); i++)

      set_GPIO_IRQ_edge(irqs[i].gpio, GPIO_BOTH_EDGES);

  return 0;

}

static int cerf_pcmcia_socket_suspend(int sock)

{

  int i;

  if (sock == CERF_SOCKET)

    for (i = 0; i < ARRAY_SIZE(irqs); i++)

      set_GPIO_IRQ_edge(irqs[i].gpio, GPIO_NO_EDGES);

  return 0;

}

struct pcmcia_low_level cerf_pcmcia_ops = {

  init:                 cerf_pcmcia_init,

  shutdown:             cerf_pcmcia_shutdown,

  socket_state:         cerf_pcmcia_socket_state,

  get_irq_info:         cerf_pcmcia_get_irq_info,

  configure_socket:     cerf_pcmcia_configure_socket,

  socket_init:          cerf_pcmcia_socket_init,

  socket_suspend:       cerf_pcmcia_socket_suspend,

};