pxa2xx_sharpsl.c 7.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285
  1. /*
  2. * Sharp SL-C7xx Series PCMCIA routines
  3. *
  4. * Copyright (c) 2004-2005 Richard Purdie
  5. *
  6. * Based on Sharp's 2.4 kernel patches and pxa2xx_mainstone.c
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License version 2 as
  10. * published by the Free Software Foundation.
  11. *
  12. */
  13. #include <linux/module.h>
  14. #include <linux/init.h>
  15. #include <linux/kernel.h>
  16. #include <linux/errno.h>
  17. #include <linux/interrupt.h>
  18. #include <linux/platform_device.h>
  19. #include <asm/mach-types.h>
  20. #include <asm/hardware.h>
  21. #include <asm/irq.h>
  22. #include <asm/hardware/scoop.h>
  23. #include "soc_common.h"
  24. #define NO_KEEP_VS 0x0001
  25. #define SCOOP_DEV platform_scoop_config->devs
  26. static void sharpsl_pcmcia_init_reset(struct soc_pcmcia_socket *skt)
  27. {
  28. struct scoop_pcmcia_dev *scoopdev = &SCOOP_DEV[skt->nr];
  29. reset_scoop(scoopdev->dev);
  30. /* Shared power controls need to be handled carefully */
  31. if (platform_scoop_config->power_ctrl)
  32. platform_scoop_config->power_ctrl(scoopdev->dev, 0x0000, skt->nr);
  33. else
  34. write_scoop_reg(scoopdev->dev, SCOOP_CPR, 0x0000);
  35. scoopdev->keep_vs = NO_KEEP_VS;
  36. scoopdev->keep_rd = 0;
  37. }
  38. static int sharpsl_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
  39. {
  40. int ret;
  41. if (platform_scoop_config->pcmcia_init)
  42. platform_scoop_config->pcmcia_init();
  43. /* Register interrupts */
  44. if (SCOOP_DEV[skt->nr].cd_irq >= 0) {
  45. struct pcmcia_irqs cd_irq;
  46. cd_irq.sock = skt->nr;
  47. cd_irq.irq = SCOOP_DEV[skt->nr].cd_irq;
  48. cd_irq.str = SCOOP_DEV[skt->nr].cd_irq_str;
  49. ret = soc_pcmcia_request_irqs(skt, &cd_irq, 1);
  50. if (ret) {
  51. printk(KERN_ERR "Request for Compact Flash IRQ failed\n");
  52. return ret;
  53. }
  54. }
  55. skt->irq = SCOOP_DEV[skt->nr].irq;
  56. return 0;
  57. }
  58. static void sharpsl_pcmcia_hw_shutdown(struct soc_pcmcia_socket *skt)
  59. {
  60. if (SCOOP_DEV[skt->nr].cd_irq >= 0) {
  61. struct pcmcia_irqs cd_irq;
  62. cd_irq.sock = skt->nr;
  63. cd_irq.irq = SCOOP_DEV[skt->nr].cd_irq;
  64. cd_irq.str = SCOOP_DEV[skt->nr].cd_irq_str;
  65. soc_pcmcia_free_irqs(skt, &cd_irq, 1);
  66. }
  67. }
  68. static void sharpsl_pcmcia_socket_state(struct soc_pcmcia_socket *skt,
  69. struct pcmcia_state *state)
  70. {
  71. unsigned short cpr, csr;
  72. struct device *scoop = SCOOP_DEV[skt->nr].dev;
  73. cpr = read_scoop_reg(SCOOP_DEV[skt->nr].dev, SCOOP_CPR);
  74. write_scoop_reg(scoop, SCOOP_IRM, 0x00FF);
  75. write_scoop_reg(scoop, SCOOP_ISR, 0x0000);
  76. write_scoop_reg(scoop, SCOOP_IRM, 0x0000);
  77. csr = read_scoop_reg(scoop, SCOOP_CSR);
  78. if (csr & 0x0004) {
  79. /* card eject */
  80. write_scoop_reg(scoop, SCOOP_CDR, 0x0000);
  81. SCOOP_DEV[skt->nr].keep_vs = NO_KEEP_VS;
  82. }
  83. else if (!(SCOOP_DEV[skt->nr].keep_vs & NO_KEEP_VS)) {
  84. /* keep vs1,vs2 */
  85. write_scoop_reg(scoop, SCOOP_CDR, 0x0000);
  86. csr |= SCOOP_DEV[skt->nr].keep_vs;
  87. }
  88. else if (cpr & 0x0003) {
  89. /* power on */
  90. write_scoop_reg(scoop, SCOOP_CDR, 0x0000);
  91. SCOOP_DEV[skt->nr].keep_vs = (csr & 0x00C0);
  92. }
  93. else {
  94. /* card detect */
  95. if ((machine_is_spitz() || machine_is_borzoi()) && skt->nr == 1) {
  96. write_scoop_reg(scoop, SCOOP_CDR, 0x0000);
  97. } else {
  98. write_scoop_reg(scoop, SCOOP_CDR, 0x0002);
  99. }
  100. }
  101. state->detect = (csr & 0x0004) ? 0 : 1;
  102. state->ready = (csr & 0x0002) ? 1 : 0;
  103. state->bvd1 = (csr & 0x0010) ? 1 : 0;
  104. state->bvd2 = (csr & 0x0020) ? 1 : 0;
  105. state->wrprot = (csr & 0x0008) ? 1 : 0;
  106. state->vs_3v = (csr & 0x0040) ? 0 : 1;
  107. state->vs_Xv = (csr & 0x0080) ? 0 : 1;
  108. if ((cpr & 0x0080) && ((cpr & 0x8040) != 0x8040)) {
  109. printk(KERN_ERR "sharpsl_pcmcia_socket_state(): CPR=%04X, Low voltage!\n", cpr);
  110. }
  111. }
  112. static int sharpsl_pcmcia_configure_socket(struct soc_pcmcia_socket *skt,
  113. const socket_state_t *state)
  114. {
  115. unsigned long flags;
  116. struct device *scoop = SCOOP_DEV[skt->nr].dev;
  117. unsigned short cpr, ncpr, ccr, nccr, mcr, nmcr, imr, nimr;
  118. switch (state->Vcc) {
  119. case 0: break;
  120. case 33: break;
  121. case 50: break;
  122. default:
  123. printk(KERN_ERR "sharpsl_pcmcia_configure_socket(): bad Vcc %u\n", state->Vcc);
  124. return -1;
  125. }
  126. if ((state->Vpp!=state->Vcc) && (state->Vpp!=0)) {
  127. printk(KERN_ERR "CF slot cannot support Vpp %u\n", state->Vpp);
  128. return -1;
  129. }
  130. local_irq_save(flags);
  131. nmcr = (mcr = read_scoop_reg(scoop, SCOOP_MCR)) & ~0x0010;
  132. ncpr = (cpr = read_scoop_reg(scoop, SCOOP_CPR)) & ~0x0083;
  133. nccr = (ccr = read_scoop_reg(scoop, SCOOP_CCR)) & ~0x0080;
  134. nimr = (imr = read_scoop_reg(scoop, SCOOP_IMR)) & ~0x003E;
  135. if ((machine_is_spitz() || machine_is_borzoi() || machine_is_akita()) && skt->nr == 0) {
  136. ncpr |= (state->Vcc == 33) ? 0x0002 :
  137. (state->Vcc == 50) ? 0x0002 : 0;
  138. } else {
  139. ncpr |= (state->Vcc == 33) ? 0x0001 :
  140. (state->Vcc == 50) ? 0x0002 : 0;
  141. }
  142. nmcr |= (state->flags&SS_IOCARD) ? 0x0010 : 0;
  143. ncpr |= (state->flags&SS_OUTPUT_ENA) ? 0x0080 : 0;
  144. nccr |= (state->flags&SS_RESET)? 0x0080: 0;
  145. nimr |= ((skt->status&SS_DETECT) ? 0x0004 : 0)|
  146. ((skt->status&SS_READY) ? 0x0002 : 0)|
  147. ((skt->status&SS_BATDEAD)? 0x0010 : 0)|
  148. ((skt->status&SS_BATWARN)? 0x0020 : 0)|
  149. ((skt->status&SS_STSCHG) ? 0x0010 : 0)|
  150. ((skt->status&SS_WRPROT) ? 0x0008 : 0);
  151. if (!(ncpr & 0x0003)) {
  152. SCOOP_DEV[skt->nr].keep_rd = 0;
  153. } else if (!SCOOP_DEV[skt->nr].keep_rd) {
  154. if (nccr & 0x0080)
  155. SCOOP_DEV[skt->nr].keep_rd = 1;
  156. else
  157. nccr |= 0x0080;
  158. }
  159. if (mcr != nmcr)
  160. write_scoop_reg(scoop, SCOOP_MCR, nmcr);
  161. if (cpr != ncpr) {
  162. if (platform_scoop_config->power_ctrl)
  163. platform_scoop_config->power_ctrl(scoop, ncpr , skt->nr);
  164. else
  165. write_scoop_reg(scoop, SCOOP_CPR, ncpr);
  166. }
  167. if (ccr != nccr)
  168. write_scoop_reg(scoop, SCOOP_CCR, nccr);
  169. if (imr != nimr)
  170. write_scoop_reg(scoop, SCOOP_IMR, nimr);
  171. local_irq_restore(flags);
  172. return 0;
  173. }
  174. static void sharpsl_pcmcia_socket_init(struct soc_pcmcia_socket *skt)
  175. {
  176. sharpsl_pcmcia_init_reset(skt);
  177. /* Enable interrupt */
  178. write_scoop_reg(SCOOP_DEV[skt->nr].dev, SCOOP_IMR, 0x00C0);
  179. write_scoop_reg(SCOOP_DEV[skt->nr].dev, SCOOP_MCR, 0x0101);
  180. SCOOP_DEV[skt->nr].keep_vs = NO_KEEP_VS;
  181. }
  182. static void sharpsl_pcmcia_socket_suspend(struct soc_pcmcia_socket *skt)
  183. {
  184. sharpsl_pcmcia_init_reset(skt);
  185. }
  186. static struct pcmcia_low_level sharpsl_pcmcia_ops = {
  187. .owner = THIS_MODULE,
  188. .hw_init = sharpsl_pcmcia_hw_init,
  189. .hw_shutdown = sharpsl_pcmcia_hw_shutdown,
  190. .socket_state = sharpsl_pcmcia_socket_state,
  191. .configure_socket = sharpsl_pcmcia_configure_socket,
  192. .socket_init = sharpsl_pcmcia_socket_init,
  193. .socket_suspend = sharpsl_pcmcia_socket_suspend,
  194. .first = 0,
  195. .nr = 0,
  196. };
  197. #ifdef CONFIG_SA1100_COLLIE
  198. #include "sa11xx_base.h"
  199. int __init pcmcia_collie_init(struct device *dev)
  200. {
  201. int ret = -ENODEV;
  202. if (machine_is_collie())
  203. ret = sa11xx_drv_pcmcia_probe(dev, &sharpsl_pcmcia_ops, 0, 1);
  204. return ret;
  205. }
  206. #else
  207. static struct platform_device *sharpsl_pcmcia_device;
  208. static int __init sharpsl_pcmcia_init(void)
  209. {
  210. int ret;
  211. sharpsl_pcmcia_ops.nr = platform_scoop_config->num_devs;
  212. sharpsl_pcmcia_device = platform_device_alloc("pxa2xx-pcmcia", -1);
  213. if (!sharpsl_pcmcia_device)
  214. return -ENOMEM;
  215. sharpsl_pcmcia_device->dev.platform_data = &sharpsl_pcmcia_ops;
  216. sharpsl_pcmcia_device->dev.parent = platform_scoop_config->devs[0].dev;
  217. ret = platform_device_add(sharpsl_pcmcia_device);
  218. if (ret)
  219. platform_device_put(sharpsl_pcmcia_device);
  220. return ret;
  221. }
  222. static void __exit sharpsl_pcmcia_exit(void)
  223. {
  224. platform_device_unregister(sharpsl_pcmcia_device);
  225. }
  226. fs_initcall(sharpsl_pcmcia_init);
  227. module_exit(sharpsl_pcmcia_exit);
  228. #endif
  229. MODULE_DESCRIPTION("Sharp SL Series PCMCIA Support");
  230. MODULE_LICENSE("GPL");