sa1111_generic.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:4k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * linux/drivers/pcmcia/sa1100_sa1111.c
  3.  *
  4.  * We implement the generic parts of a SA1111 PCMCIA driver.  This
  5.  * basically means we handle everything except controlling the
  6.  * power.  Power is machine specific...
  7.  */
  8. #include <linux/kernel.h>
  9. #include <linux/sched.h>
  10. #include <linux/ioport.h>
  11. #include <asm/hardware.h>
  12. #include <asm/hardware/sa1111.h>
  13. #include <asm/irq.h>
  14. #include "sa1100_generic.h"
  15. #include "sa1111_generic.h"
  16. static struct irqs {
  17. int irq;
  18. const char *str;
  19. } irqs[] = {
  20. { S0_CD_VALID,    "SA1111 PCMCIA card detect" },
  21. { S0_BVD1_STSCHG, "SA1111 PCMCIA BVD1"        },
  22. { S1_CD_VALID,    "SA1111 CF card detect"     },
  23. { S1_BVD1_STSCHG, "SA1111 CF BVD1"            },
  24. };
  25. int sa1111_pcmcia_init(struct pcmcia_init *init)
  26. {
  27. int i, ret;
  28. if (!request_mem_region(_PCCR, 512, "PCMCIA"))
  29. return -1;
  30. INTPOL1 |= SA1111_IRQMASK_HI(S0_CD_VALID) |
  31.    SA1111_IRQMASK_HI(S1_CD_VALID) |
  32.    SA1111_IRQMASK_HI(S0_BVD1_STSCHG) |
  33.    SA1111_IRQMASK_HI(S1_BVD1_STSCHG);
  34. for (i = ret = 0; i < ARRAY_SIZE(irqs); i++) {
  35. ret = request_irq(irqs[i].irq, init->handler, SA_INTERRUPT,
  36.   irqs[i].str, NULL);
  37. if (ret)
  38. break;
  39. }
  40. if (i < ARRAY_SIZE(irqs)) {
  41. printk(KERN_ERR "sa1111_pcmcia: unable to grab IRQ%d (%d)n",
  42. irqs[i].irq, ret);
  43. while (i--)
  44. free_irq(irqs[i].irq, NULL);
  45. release_mem_region(_PCCR, 16);
  46. }
  47. return ret ? -1 : 2;
  48. }
  49. int sa1111_pcmcia_shutdown(void)
  50. {
  51. int i;
  52. for (i = 0; i < ARRAY_SIZE(irqs); i++)
  53. free_irq(irqs[i].irq, NULL);
  54. INTPOL1 &= ~(SA1111_IRQMASK_HI(S0_CD_VALID) |
  55.      SA1111_IRQMASK_HI(S1_CD_VALID) |
  56.      SA1111_IRQMASK_HI(S0_BVD1_STSCHG) |
  57.      SA1111_IRQMASK_HI(S1_BVD1_STSCHG));
  58. release_mem_region(_PCCR, 512);
  59. return 0;
  60. }
  61. int sa1111_pcmcia_socket_state(struct pcmcia_state_array *state)
  62. {
  63. unsigned long status;
  64. if (state->size < 2)
  65. return -1;
  66. status = PCSR;
  67. state->state[0].detect = status & PCSR_S0_DETECT ? 0 : 1;
  68. state->state[0].ready  = status & PCSR_S0_READY  ? 1 : 0;
  69. state->state[0].bvd1   = status & PCSR_S0_BVD1   ? 1 : 0;
  70. state->state[0].bvd2   = status & PCSR_S0_BVD2   ? 1 : 0;
  71. state->state[0].wrprot = status & PCSR_S0_WP     ? 1 : 0;
  72. state->state[0].vs_3v  = status & PCSR_S0_VS1    ? 0 : 1;
  73. state->state[0].vs_Xv  = status & PCSR_S0_VS2    ? 0 : 1;
  74. state->state[1].detect = status & PCSR_S1_DETECT ? 0 : 1;
  75. state->state[1].ready  = status & PCSR_S1_READY  ? 1 : 0;
  76. state->state[1].bvd1   = status & PCSR_S1_BVD1   ? 1 : 0;
  77. state->state[1].bvd2   = status & PCSR_S1_BVD2   ? 1 : 0;
  78. state->state[1].wrprot = status & PCSR_S1_WP     ? 1 : 0;
  79. state->state[1].vs_3v  = status & PCSR_S1_VS1    ? 0 : 1;
  80. state->state[1].vs_Xv  = status & PCSR_S1_VS2    ? 0 : 1;
  81. return 1;
  82. }
  83. int sa1111_pcmcia_get_irq_info(struct pcmcia_irq_info *info)
  84. {
  85. int ret = 0;
  86. switch (info->sock) {
  87. case 0: info->irq = S0_READY_NINT; break;
  88. case 1: info->irq = S1_READY_NINT; break;
  89. default: ret = 1;
  90. }
  91. return ret;
  92. }
  93. int sa1111_pcmcia_configure_socket(const struct pcmcia_configure *conf)
  94. {
  95. unsigned int rst, flt, wait, pse, irq, pccr_mask;
  96. unsigned long flags;
  97. switch (conf->sock) {
  98. case 0:
  99. rst = PCCR_S0_RST;
  100. flt = PCCR_S0_FLT;
  101. wait = PCCR_S0_PWAITEN;
  102. pse = PCCR_S0_PSE;
  103. irq = S0_READY_NINT;
  104. break;
  105. case 1:
  106. rst = PCCR_S1_RST;
  107. flt = PCCR_S1_FLT;
  108. wait = PCCR_S1_PWAITEN;
  109. pse = PCCR_S1_PSE;
  110. irq = S1_READY_NINT;
  111. break;
  112. default:
  113. return -1;
  114. }
  115. switch (conf->vcc) {
  116. case 0:
  117. pccr_mask = 0;
  118. break;
  119. case 33:
  120. pccr_mask = wait;
  121. break;
  122. case 50:
  123. pccr_mask = pse | wait;
  124. break;
  125. default:
  126. printk(KERN_ERR "sa1111_pcmcia: unrecognised VCC %un",
  127. conf->vcc);
  128. return -1;
  129. }
  130. if (conf->reset)
  131. pccr_mask |= rst;
  132. if (conf->output)
  133. pccr_mask |= flt;
  134. local_irq_save(flags);
  135. PCCR = (PCCR & ~(pse | flt | wait | rst)) | pccr_mask;
  136. local_irq_restore(flags);
  137. if (conf->irq)
  138. enable_irq(irq);
  139. else
  140. disable_irq(irq);
  141. return 0;
  142. }
  143. int sa1111_pcmcia_socket_init(int sock)
  144. {
  145. return 0;
  146. }
  147. int sa1111_pcmcia_socket_suspend(int sock)
  148. {
  149. return 0;
  150. }