sa1111_generic.c 4.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195
  1. /*
  2. * linux/drivers/pcmcia/sa1111_generic.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/module.h>
  9. #include <linux/kernel.h>
  10. #include <linux/ioport.h>
  11. #include <linux/device.h>
  12. #include <linux/interrupt.h>
  13. #include <linux/init.h>
  14. #include <pcmcia/ss.h>
  15. #include <asm/hardware.h>
  16. #include <asm/hardware/sa1111.h>
  17. #include <asm/io.h>
  18. #include <asm/irq.h>
  19. #include "sa1111_generic.h"
  20. static struct pcmcia_irqs irqs[] = {
  21. { 0, IRQ_S0_CD_VALID, "SA1111 PCMCIA card detect" },
  22. { 0, IRQ_S0_BVD1_STSCHG, "SA1111 PCMCIA BVD1" },
  23. { 1, IRQ_S1_CD_VALID, "SA1111 CF card detect" },
  24. { 1, IRQ_S1_BVD1_STSCHG, "SA1111 CF BVD1" },
  25. };
  26. int sa1111_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
  27. {
  28. if (skt->irq == NO_IRQ)
  29. skt->irq = skt->nr ? IRQ_S1_READY_NINT : IRQ_S0_READY_NINT;
  30. return soc_pcmcia_request_irqs(skt, irqs, ARRAY_SIZE(irqs));
  31. }
  32. void sa1111_pcmcia_hw_shutdown(struct soc_pcmcia_socket *skt)
  33. {
  34. soc_pcmcia_free_irqs(skt, irqs, ARRAY_SIZE(irqs));
  35. }
  36. void sa1111_pcmcia_socket_state(struct soc_pcmcia_socket *skt, struct pcmcia_state *state)
  37. {
  38. struct sa1111_dev *sadev = SA1111_DEV(skt->dev);
  39. unsigned long status = sa1111_readl(sadev->mapbase + SA1111_PCSR);
  40. switch (skt->nr) {
  41. case 0:
  42. state->detect = status & PCSR_S0_DETECT ? 0 : 1;
  43. state->ready = status & PCSR_S0_READY ? 1 : 0;
  44. state->bvd1 = status & PCSR_S0_BVD1 ? 1 : 0;
  45. state->bvd2 = status & PCSR_S0_BVD2 ? 1 : 0;
  46. state->wrprot = status & PCSR_S0_WP ? 1 : 0;
  47. state->vs_3v = status & PCSR_S0_VS1 ? 0 : 1;
  48. state->vs_Xv = status & PCSR_S0_VS2 ? 0 : 1;
  49. break;
  50. case 1:
  51. state->detect = status & PCSR_S1_DETECT ? 0 : 1;
  52. state->ready = status & PCSR_S1_READY ? 1 : 0;
  53. state->bvd1 = status & PCSR_S1_BVD1 ? 1 : 0;
  54. state->bvd2 = status & PCSR_S1_BVD2 ? 1 : 0;
  55. state->wrprot = status & PCSR_S1_WP ? 1 : 0;
  56. state->vs_3v = status & PCSR_S1_VS1 ? 0 : 1;
  57. state->vs_Xv = status & PCSR_S1_VS2 ? 0 : 1;
  58. break;
  59. }
  60. }
  61. int sa1111_pcmcia_configure_socket(struct soc_pcmcia_socket *skt, const socket_state_t *state)
  62. {
  63. struct sa1111_dev *sadev = SA1111_DEV(skt->dev);
  64. unsigned int pccr_skt_mask, pccr_set_mask, val;
  65. unsigned long flags;
  66. switch (skt->nr) {
  67. case 0:
  68. pccr_skt_mask = PCCR_S0_RST|PCCR_S0_FLT|PCCR_S0_PWAITEN|PCCR_S0_PSE;
  69. break;
  70. case 1:
  71. pccr_skt_mask = PCCR_S1_RST|PCCR_S1_FLT|PCCR_S1_PWAITEN|PCCR_S1_PSE;
  72. break;
  73. default:
  74. return -1;
  75. }
  76. pccr_set_mask = 0;
  77. if (state->Vcc != 0)
  78. pccr_set_mask |= PCCR_S0_PWAITEN|PCCR_S1_PWAITEN;
  79. if (state->Vcc == 50)
  80. pccr_set_mask |= PCCR_S0_PSE|PCCR_S1_PSE;
  81. if (state->flags & SS_RESET)
  82. pccr_set_mask |= PCCR_S0_RST|PCCR_S1_RST;
  83. if (state->flags & SS_OUTPUT_ENA)
  84. pccr_set_mask |= PCCR_S0_FLT|PCCR_S1_FLT;
  85. local_irq_save(flags);
  86. val = sa1111_readl(sadev->mapbase + SA1111_PCCR);
  87. val &= ~pccr_skt_mask;
  88. val |= pccr_set_mask & pccr_skt_mask;
  89. sa1111_writel(val, sadev->mapbase + SA1111_PCCR);
  90. local_irq_restore(flags);
  91. return 0;
  92. }
  93. void sa1111_pcmcia_socket_init(struct soc_pcmcia_socket *skt)
  94. {
  95. soc_pcmcia_enable_irqs(skt, irqs, ARRAY_SIZE(irqs));
  96. }
  97. void sa1111_pcmcia_socket_suspend(struct soc_pcmcia_socket *skt)
  98. {
  99. soc_pcmcia_disable_irqs(skt, irqs, ARRAY_SIZE(irqs));
  100. }
  101. static int pcmcia_probe(struct sa1111_dev *dev)
  102. {
  103. void __iomem *base;
  104. if (!request_mem_region(dev->res.start, 512,
  105. SA1111_DRIVER_NAME(dev)))
  106. return -EBUSY;
  107. base = dev->mapbase;
  108. /*
  109. * Initialise the suspend state.
  110. */
  111. sa1111_writel(PCSSR_S0_SLEEP | PCSSR_S1_SLEEP, base + SA1111_PCSSR);
  112. sa1111_writel(PCCR_S0_FLT | PCCR_S1_FLT, base + SA1111_PCCR);
  113. #ifdef CONFIG_SA1100_BADGE4
  114. pcmcia_badge4_init(&dev->dev);
  115. #endif
  116. #ifdef CONFIG_SA1100_JORNADA720
  117. pcmcia_jornada720_init(&dev->dev);
  118. #endif
  119. #ifdef CONFIG_ARCH_LUBBOCK
  120. pcmcia_lubbock_init(dev);
  121. #endif
  122. #ifdef CONFIG_ASSABET_NEPONSET
  123. pcmcia_neponset_init(dev);
  124. #endif
  125. return 0;
  126. }
  127. static int __devexit pcmcia_remove(struct sa1111_dev *dev)
  128. {
  129. soc_common_drv_pcmcia_remove(&dev->dev);
  130. release_mem_region(dev->res.start, 512);
  131. return 0;
  132. }
  133. static int pcmcia_suspend(struct sa1111_dev *dev, pm_message_t state)
  134. {
  135. return pcmcia_socket_dev_suspend(&dev->dev, state);
  136. }
  137. static int pcmcia_resume(struct sa1111_dev *dev)
  138. {
  139. return pcmcia_socket_dev_resume(&dev->dev);
  140. }
  141. static struct sa1111_driver pcmcia_driver = {
  142. .drv = {
  143. .name = "sa1111-pcmcia",
  144. },
  145. .devid = SA1111_DEVID_PCMCIA,
  146. .probe = pcmcia_probe,
  147. .remove = __devexit_p(pcmcia_remove),
  148. .suspend = pcmcia_suspend,
  149. .resume = pcmcia_resume,
  150. };
  151. static int __init sa1111_drv_pcmcia_init(void)
  152. {
  153. return sa1111_driver_register(&pcmcia_driver);
  154. }
  155. static void __exit sa1111_drv_pcmcia_exit(void)
  156. {
  157. sa1111_driver_unregister(&pcmcia_driver);
  158. }
  159. fs_initcall(sa1111_drv_pcmcia_init);
  160. module_exit(sa1111_drv_pcmcia_exit);
  161. MODULE_DESCRIPTION("SA1111 PCMCIA card socket driver");
  162. MODULE_LICENSE("GPL");