sa1100_simpad.c 2.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134
  1. /*
  2. * drivers/pcmcia/sa1100_simpad.c
  3. *
  4. * PCMCIA implementation routines for simpad
  5. *
  6. */
  7. #include <linux/module.h>
  8. #include <linux/kernel.h>
  9. #include <linux/device.h>
  10. #include <linux/init.h>
  11. #include <asm/hardware.h>
  12. #include <asm/mach-types.h>
  13. #include <asm/irq.h>
  14. #include <asm/arch/simpad.h>
  15. #include "sa1100_generic.h"
  16. extern long get_cs3_shadow(void);
  17. extern void set_cs3_bit(int value);
  18. extern void clear_cs3_bit(int value);
  19. static struct pcmcia_irqs irqs[] = {
  20. { 1, IRQ_GPIO_CF_CD, "CF_CD" },
  21. };
  22. static int simpad_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
  23. {
  24. clear_cs3_bit(VCC_3V_EN|VCC_5V_EN|EN0|EN1);
  25. skt->irq = IRQ_GPIO_CF_IRQ;
  26. return soc_pcmcia_request_irqs(skt, irqs, ARRAY_SIZE(irqs));
  27. }
  28. static void simpad_pcmcia_hw_shutdown(struct soc_pcmcia_socket *skt)
  29. {
  30. soc_pcmcia_free_irqs(skt, irqs, ARRAY_SIZE(irqs));
  31. /* Disable CF bus: */
  32. //set_cs3_bit(PCMCIA_BUFF_DIS);
  33. clear_cs3_bit(PCMCIA_RESET);
  34. }
  35. static void
  36. simpad_pcmcia_socket_state(struct soc_pcmcia_socket *skt,
  37. struct pcmcia_state *state)
  38. {
  39. unsigned long levels = GPLR;
  40. long cs3reg = get_cs3_shadow();
  41. state->detect=((levels & GPIO_CF_CD)==0)?1:0;
  42. state->ready=(levels & GPIO_CF_IRQ)?1:0;
  43. state->bvd1=1; /* Not available on Simpad. */
  44. state->bvd2=1; /* Not available on Simpad. */
  45. state->wrprot=0; /* Not available on Simpad. */
  46. if((cs3reg & 0x0c) == 0x0c) {
  47. state->vs_3v=0;
  48. state->vs_Xv=0;
  49. } else {
  50. state->vs_3v=1;
  51. state->vs_Xv=0;
  52. }
  53. }
  54. static int
  55. simpad_pcmcia_configure_socket(struct soc_pcmcia_socket *skt,
  56. const socket_state_t *state)
  57. {
  58. unsigned long flags;
  59. local_irq_save(flags);
  60. /* Murphy: see table of MIC2562a-1 */
  61. switch (state->Vcc) {
  62. case 0:
  63. clear_cs3_bit(VCC_3V_EN|VCC_5V_EN|EN0|EN1);
  64. break;
  65. case 33:
  66. clear_cs3_bit(VCC_3V_EN|EN1);
  67. set_cs3_bit(VCC_5V_EN|EN0);
  68. break;
  69. case 50:
  70. clear_cs3_bit(VCC_5V_EN|EN1);
  71. set_cs3_bit(VCC_3V_EN|EN0);
  72. break;
  73. default:
  74. printk(KERN_ERR "%s(): unrecognized Vcc %u\n",
  75. __FUNCTION__, state->Vcc);
  76. clear_cs3_bit(VCC_3V_EN|VCC_5V_EN|EN0|EN1);
  77. local_irq_restore(flags);
  78. return -1;
  79. }
  80. local_irq_restore(flags);
  81. return 0;
  82. }
  83. static void simpad_pcmcia_socket_init(struct soc_pcmcia_socket *skt)
  84. {
  85. soc_pcmcia_enable_irqs(skt, irqs, ARRAY_SIZE(irqs));
  86. }
  87. static void simpad_pcmcia_socket_suspend(struct soc_pcmcia_socket *skt)
  88. {
  89. soc_pcmcia_disable_irqs(skt, irqs, ARRAY_SIZE(irqs));
  90. set_cs3_bit(PCMCIA_RESET);
  91. }
  92. static struct pcmcia_low_level simpad_pcmcia_ops = {
  93. .owner = THIS_MODULE,
  94. .hw_init = simpad_pcmcia_hw_init,
  95. .hw_shutdown = simpad_pcmcia_hw_shutdown,
  96. .socket_state = simpad_pcmcia_socket_state,
  97. .configure_socket = simpad_pcmcia_configure_socket,
  98. .socket_init = simpad_pcmcia_socket_init,
  99. .socket_suspend = simpad_pcmcia_socket_suspend,
  100. };
  101. int __init pcmcia_simpad_init(struct device *dev)
  102. {
  103. int ret = -ENODEV;
  104. if (machine_is_simpad())
  105. ret = sa11xx_drv_pcmcia_probe(dev, &simpad_pcmcia_ops, 1, 1);
  106. return ret;
  107. }