pxa2xx_sharpsl.c 6.9 KB

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