sa1111_generic.c 6.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * linux/drivers/pcmcia/sa1111_generic.c
  4. *
  5. * We implement the generic parts of a SA1111 PCMCIA driver. This
  6. * basically means we handle everything except controlling the
  7. * power. Power is machine specific...
  8. */
  9. #include <linux/module.h>
  10. #include <linux/kernel.h>
  11. #include <linux/ioport.h>
  12. #include <linux/device.h>
  13. #include <linux/interrupt.h>
  14. #include <linux/init.h>
  15. #include <linux/io.h>
  16. #include <linux/slab.h>
  17. #include <pcmcia/ss.h>
  18. #include <mach/hardware.h>
  19. #include <asm/hardware/sa1111.h>
  20. #include <asm/mach-types.h>
  21. #include <asm/irq.h>
  22. #include "sa1111_generic.h"
  23. /*
  24. * These are offsets from the above base.
  25. */
  26. #define PCCR 0x0000
  27. #define PCSSR 0x0004
  28. #define PCSR 0x0008
  29. #define PCSR_S0_READY (1<<0)
  30. #define PCSR_S1_READY (1<<1)
  31. #define PCSR_S0_DETECT (1<<2)
  32. #define PCSR_S1_DETECT (1<<3)
  33. #define PCSR_S0_VS1 (1<<4)
  34. #define PCSR_S0_VS2 (1<<5)
  35. #define PCSR_S1_VS1 (1<<6)
  36. #define PCSR_S1_VS2 (1<<7)
  37. #define PCSR_S0_WP (1<<8)
  38. #define PCSR_S1_WP (1<<9)
  39. #define PCSR_S0_BVD1 (1<<10)
  40. #define PCSR_S0_BVD2 (1<<11)
  41. #define PCSR_S1_BVD1 (1<<12)
  42. #define PCSR_S1_BVD2 (1<<13)
  43. #define PCCR_S0_RST (1<<0)
  44. #define PCCR_S1_RST (1<<1)
  45. #define PCCR_S0_FLT (1<<2)
  46. #define PCCR_S1_FLT (1<<3)
  47. #define PCCR_S0_PWAITEN (1<<4)
  48. #define PCCR_S1_PWAITEN (1<<5)
  49. #define PCCR_S0_PSE (1<<6)
  50. #define PCCR_S1_PSE (1<<7)
  51. #define PCSSR_S0_SLEEP (1<<0)
  52. #define PCSSR_S1_SLEEP (1<<1)
  53. #define IDX_IRQ_S0_READY_NINT (0)
  54. #define IDX_IRQ_S0_CD_VALID (1)
  55. #define IDX_IRQ_S0_BVD1_STSCHG (2)
  56. #define IDX_IRQ_S1_READY_NINT (3)
  57. #define IDX_IRQ_S1_CD_VALID (4)
  58. #define IDX_IRQ_S1_BVD1_STSCHG (5)
  59. #define NUM_IRQS (6)
  60. void sa1111_pcmcia_socket_state(struct soc_pcmcia_socket *skt, struct pcmcia_state *state)
  61. {
  62. struct sa1111_pcmcia_socket *s = to_skt(skt);
  63. u32 status = readl_relaxed(s->dev->mapbase + PCSR);
  64. switch (skt->nr) {
  65. case 0:
  66. state->detect = status & PCSR_S0_DETECT ? 0 : 1;
  67. state->ready = status & PCSR_S0_READY ? 1 : 0;
  68. state->bvd1 = status & PCSR_S0_BVD1 ? 1 : 0;
  69. state->bvd2 = status & PCSR_S0_BVD2 ? 1 : 0;
  70. state->wrprot = status & PCSR_S0_WP ? 1 : 0;
  71. state->vs_3v = status & PCSR_S0_VS1 ? 0 : 1;
  72. state->vs_Xv = status & PCSR_S0_VS2 ? 0 : 1;
  73. break;
  74. case 1:
  75. state->detect = status & PCSR_S1_DETECT ? 0 : 1;
  76. state->ready = status & PCSR_S1_READY ? 1 : 0;
  77. state->bvd1 = status & PCSR_S1_BVD1 ? 1 : 0;
  78. state->bvd2 = status & PCSR_S1_BVD2 ? 1 : 0;
  79. state->wrprot = status & PCSR_S1_WP ? 1 : 0;
  80. state->vs_3v = status & PCSR_S1_VS1 ? 0 : 1;
  81. state->vs_Xv = status & PCSR_S1_VS2 ? 0 : 1;
  82. break;
  83. }
  84. }
  85. int sa1111_pcmcia_configure_socket(struct soc_pcmcia_socket *skt, const socket_state_t *state)
  86. {
  87. struct sa1111_pcmcia_socket *s = to_skt(skt);
  88. u32 pccr_skt_mask, pccr_set_mask, val;
  89. unsigned long flags;
  90. switch (skt->nr) {
  91. case 0:
  92. pccr_skt_mask = PCCR_S0_RST|PCCR_S0_FLT|PCCR_S0_PWAITEN|PCCR_S0_PSE;
  93. break;
  94. case 1:
  95. pccr_skt_mask = PCCR_S1_RST|PCCR_S1_FLT|PCCR_S1_PWAITEN|PCCR_S1_PSE;
  96. break;
  97. default:
  98. return -1;
  99. }
  100. pccr_set_mask = 0;
  101. if (state->Vcc != 0)
  102. pccr_set_mask |= PCCR_S0_PWAITEN|PCCR_S1_PWAITEN;
  103. if (state->Vcc == 50)
  104. pccr_set_mask |= PCCR_S0_PSE|PCCR_S1_PSE;
  105. if (state->flags & SS_RESET)
  106. pccr_set_mask |= PCCR_S0_RST|PCCR_S1_RST;
  107. if (state->flags & SS_OUTPUT_ENA)
  108. pccr_set_mask |= PCCR_S0_FLT|PCCR_S1_FLT;
  109. local_irq_save(flags);
  110. val = readl_relaxed(s->dev->mapbase + PCCR);
  111. val &= ~pccr_skt_mask;
  112. val |= pccr_set_mask & pccr_skt_mask;
  113. writel_relaxed(val, s->dev->mapbase + PCCR);
  114. local_irq_restore(flags);
  115. return 0;
  116. }
  117. int sa1111_pcmcia_add(struct sa1111_dev *dev, struct pcmcia_low_level *ops,
  118. int (*add)(struct soc_pcmcia_socket *))
  119. {
  120. struct sa1111_pcmcia_socket *s;
  121. struct clk *clk;
  122. int i, ret = 0, irqs[NUM_IRQS];
  123. clk = devm_clk_get(&dev->dev, NULL);
  124. if (IS_ERR(clk))
  125. return PTR_ERR(clk);
  126. for (i = 0; i < NUM_IRQS; i++) {
  127. irqs[i] = sa1111_get_irq(dev, i);
  128. if (irqs[i] <= 0)
  129. return irqs[i] ? : -ENXIO;
  130. }
  131. ops->socket_state = sa1111_pcmcia_socket_state;
  132. for (i = 0; i < ops->nr; i++) {
  133. s = kzalloc(sizeof(*s), GFP_KERNEL);
  134. if (!s)
  135. return -ENOMEM;
  136. s->soc.nr = ops->first + i;
  137. s->soc.clk = clk;
  138. soc_pcmcia_init_one(&s->soc, ops, &dev->dev);
  139. s->dev = dev;
  140. if (s->soc.nr) {
  141. s->soc.socket.pci_irq = irqs[IDX_IRQ_S1_READY_NINT];
  142. s->soc.stat[SOC_STAT_CD].irq = irqs[IDX_IRQ_S1_CD_VALID];
  143. s->soc.stat[SOC_STAT_CD].name = "SA1111 CF card detect";
  144. s->soc.stat[SOC_STAT_BVD1].irq = irqs[IDX_IRQ_S1_BVD1_STSCHG];
  145. s->soc.stat[SOC_STAT_BVD1].name = "SA1111 CF BVD1";
  146. } else {
  147. s->soc.socket.pci_irq = irqs[IDX_IRQ_S0_READY_NINT];
  148. s->soc.stat[SOC_STAT_CD].irq = irqs[IDX_IRQ_S0_CD_VALID];
  149. s->soc.stat[SOC_STAT_CD].name = "SA1111 PCMCIA card detect";
  150. s->soc.stat[SOC_STAT_BVD1].irq = irqs[IDX_IRQ_S0_BVD1_STSCHG];
  151. s->soc.stat[SOC_STAT_BVD1].name = "SA1111 PCMCIA BVD1";
  152. }
  153. ret = add(&s->soc);
  154. if (ret == 0) {
  155. s->next = dev_get_drvdata(&dev->dev);
  156. dev_set_drvdata(&dev->dev, s);
  157. } else
  158. kfree(s);
  159. }
  160. return ret;
  161. }
  162. static int pcmcia_probe(struct sa1111_dev *dev)
  163. {
  164. void __iomem *base;
  165. int ret;
  166. ret = sa1111_enable_device(dev);
  167. if (ret)
  168. return ret;
  169. dev_set_drvdata(&dev->dev, NULL);
  170. if (!request_mem_region(dev->res.start, 512, SA1111_DRIVER_NAME(dev))) {
  171. sa1111_disable_device(dev);
  172. return -EBUSY;
  173. }
  174. base = dev->mapbase;
  175. /*
  176. * Initialise the suspend state.
  177. */
  178. writel_relaxed(PCSSR_S0_SLEEP | PCSSR_S1_SLEEP, base + PCSSR);
  179. writel_relaxed(PCCR_S0_FLT | PCCR_S1_FLT, base + PCCR);
  180. ret = -ENODEV;
  181. #ifdef CONFIG_SA1100_BADGE4
  182. if (machine_is_badge4())
  183. ret = pcmcia_badge4_init(dev);
  184. #endif
  185. #ifdef CONFIG_SA1100_JORNADA720
  186. if (machine_is_jornada720())
  187. ret = pcmcia_jornada720_init(dev);
  188. #endif
  189. #ifdef CONFIG_ARCH_LUBBOCK
  190. if (machine_is_lubbock())
  191. ret = pcmcia_lubbock_init(dev);
  192. #endif
  193. #ifdef CONFIG_ASSABET_NEPONSET
  194. if (machine_is_assabet())
  195. ret = pcmcia_neponset_init(dev);
  196. #endif
  197. if (ret) {
  198. release_mem_region(dev->res.start, 512);
  199. sa1111_disable_device(dev);
  200. }
  201. return ret;
  202. }
  203. static int pcmcia_remove(struct sa1111_dev *dev)
  204. {
  205. struct sa1111_pcmcia_socket *next, *s = dev_get_drvdata(&dev->dev);
  206. dev_set_drvdata(&dev->dev, NULL);
  207. for (; s; s = next) {
  208. next = s->next;
  209. soc_pcmcia_remove_one(&s->soc);
  210. kfree(s);
  211. }
  212. release_mem_region(dev->res.start, 512);
  213. sa1111_disable_device(dev);
  214. return 0;
  215. }
  216. static struct sa1111_driver pcmcia_driver = {
  217. .drv = {
  218. .name = "sa1111-pcmcia",
  219. },
  220. .devid = SA1111_DEVID_PCMCIA,
  221. .probe = pcmcia_probe,
  222. .remove = pcmcia_remove,
  223. };
  224. static int __init sa1111_drv_pcmcia_init(void)
  225. {
  226. return sa1111_driver_register(&pcmcia_driver);
  227. }
  228. static void __exit sa1111_drv_pcmcia_exit(void)
  229. {
  230. sa1111_driver_unregister(&pcmcia_driver);
  231. }
  232. fs_initcall(sa1111_drv_pcmcia_init);
  233. module_exit(sa1111_drv_pcmcia_exit);
  234. MODULE_DESCRIPTION("SA1111 PCMCIA card socket driver");
  235. MODULE_LICENSE("GPL");