sa1111_jornada720.c 3.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * drivers/pcmcia/sa1100_jornada720.c
  4. *
  5. * Jornada720 PCMCIA specific routines
  6. *
  7. */
  8. #include <linux/module.h>
  9. #include <linux/device.h>
  10. #include <linux/errno.h>
  11. #include <linux/gpio/consumer.h>
  12. #include <linux/init.h>
  13. #include <linux/io.h>
  14. #include <mach/hardware.h>
  15. #include <asm/mach-types.h>
  16. #include "sa1111_generic.h"
  17. /*
  18. * Socket 0 power: GPIO A0
  19. * Socket 0 3V: GPIO A2
  20. * Socket 1 power: GPIO A1 & GPIO A3
  21. * Socket 1 3V: GPIO A3
  22. * Does Socket 1 3V actually do anything?
  23. */
  24. enum {
  25. J720_GPIO_PWR,
  26. J720_GPIO_3V,
  27. J720_GPIO_MAX,
  28. };
  29. struct jornada720_data {
  30. struct gpio_desc *gpio[J720_GPIO_MAX];
  31. };
  32. static int jornada720_pcmcia_hw_init(struct soc_pcmcia_socket *skt)
  33. {
  34. struct device *dev = skt->socket.dev.parent;
  35. struct jornada720_data *j;
  36. j = devm_kzalloc(dev, sizeof(*j), GFP_KERNEL);
  37. if (!j)
  38. return -ENOMEM;
  39. j->gpio[J720_GPIO_PWR] = devm_gpiod_get(dev, skt->nr ? "s1-power" :
  40. "s0-power", GPIOD_OUT_LOW);
  41. if (IS_ERR(j->gpio[J720_GPIO_PWR]))
  42. return PTR_ERR(j->gpio[J720_GPIO_PWR]);
  43. j->gpio[J720_GPIO_3V] = devm_gpiod_get(dev, skt->nr ? "s1-3v" :
  44. "s0-3v", GPIOD_OUT_LOW);
  45. if (IS_ERR(j->gpio[J720_GPIO_3V]))
  46. return PTR_ERR(j->gpio[J720_GPIO_3V]);
  47. skt->driver_data = j;
  48. return 0;
  49. }
  50. static int
  51. jornada720_pcmcia_configure_socket(struct soc_pcmcia_socket *skt, const socket_state_t *state)
  52. {
  53. struct jornada720_data *j = skt->driver_data;
  54. DECLARE_BITMAP(values, J720_GPIO_MAX) = { 0, };
  55. int ret;
  56. printk(KERN_INFO "%s(): config socket %d vcc %d vpp %d\n", __func__,
  57. skt->nr, state->Vcc, state->Vpp);
  58. switch (skt->nr) {
  59. case 0:
  60. switch (state->Vcc) {
  61. default:
  62. case 0:
  63. __assign_bit(J720_GPIO_PWR, values, 0);
  64. __assign_bit(J720_GPIO_3V, values, 0);
  65. break;
  66. case 33:
  67. __assign_bit(J720_GPIO_PWR, values, 1);
  68. __assign_bit(J720_GPIO_3V, values, 1);
  69. break;
  70. case 50:
  71. __assign_bit(J720_GPIO_PWR, values, 1);
  72. __assign_bit(J720_GPIO_3V, values, 0);
  73. break;
  74. }
  75. break;
  76. case 1:
  77. switch (state->Vcc) {
  78. default:
  79. case 0:
  80. __assign_bit(J720_GPIO_PWR, values, 0);
  81. __assign_bit(J720_GPIO_3V, values, 0);
  82. break;
  83. case 33:
  84. case 50:
  85. __assign_bit(J720_GPIO_PWR, values, 1);
  86. __assign_bit(J720_GPIO_3V, values, 1);
  87. break;
  88. }
  89. break;
  90. default:
  91. return -1;
  92. }
  93. if (state->Vpp != state->Vcc && state->Vpp != 0) {
  94. printk(KERN_ERR "%s(): slot cannot support VPP %u\n",
  95. __func__, state->Vpp);
  96. return -EPERM;
  97. }
  98. ret = sa1111_pcmcia_configure_socket(skt, state);
  99. if (ret == 0)
  100. ret = gpiod_set_array_value_cansleep(J720_GPIO_MAX, j->gpio,
  101. NULL, values);
  102. return ret;
  103. }
  104. static struct pcmcia_low_level jornada720_pcmcia_ops = {
  105. .owner = THIS_MODULE,
  106. .hw_init = jornada720_pcmcia_hw_init,
  107. .configure_socket = jornada720_pcmcia_configure_socket,
  108. .first = 0,
  109. .nr = 2,
  110. };
  111. int pcmcia_jornada720_init(struct sa1111_dev *sadev)
  112. {
  113. /* Fixme: why messing around with SA11x0's GPIO1? */
  114. GRER |= 0x00000002;
  115. sa11xx_drv_pcmcia_ops(&jornada720_pcmcia_ops);
  116. return sa1111_pcmcia_add(sadev, &jornada720_pcmcia_ops,
  117. sa11xx_drv_pcmcia_add_one);
  118. }