htc-pasic3.c 4.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Core driver for HTC PASIC3 LED/DS1WM chip.
  4. *
  5. * Copyright (C) 2006 Philipp Zabel <philipp.zabel@gmail.com>
  6. */
  7. #include <linux/init.h>
  8. #include <linux/module.h>
  9. #include <linux/platform_device.h>
  10. #include <linux/gpio.h>
  11. #include <linux/io.h>
  12. #include <linux/irq.h>
  13. #include <linux/interrupt.h>
  14. #include <linux/mfd/core.h>
  15. #include <linux/mfd/ds1wm.h>
  16. #include <linux/mfd/htc-pasic3.h>
  17. #include <linux/slab.h>
  18. struct pasic3_data {
  19. void __iomem *mapping;
  20. unsigned int bus_shift;
  21. };
  22. #define REG_ADDR 5
  23. #define REG_DATA 6
  24. #define READ_MODE 0x80
  25. /*
  26. * write to a secondary register on the PASIC3
  27. */
  28. void pasic3_write_register(struct device *dev, u32 reg, u8 val)
  29. {
  30. struct pasic3_data *asic = dev_get_drvdata(dev);
  31. int bus_shift = asic->bus_shift;
  32. void __iomem *addr = asic->mapping + (REG_ADDR << bus_shift);
  33. void __iomem *data = asic->mapping + (REG_DATA << bus_shift);
  34. __raw_writeb(~READ_MODE & reg, addr);
  35. __raw_writeb(val, data);
  36. }
  37. EXPORT_SYMBOL(pasic3_write_register); /* for leds-pasic3 */
  38. /*
  39. * read from a secondary register on the PASIC3
  40. */
  41. u8 pasic3_read_register(struct device *dev, u32 reg)
  42. {
  43. struct pasic3_data *asic = dev_get_drvdata(dev);
  44. int bus_shift = asic->bus_shift;
  45. void __iomem *addr = asic->mapping + (REG_ADDR << bus_shift);
  46. void __iomem *data = asic->mapping + (REG_DATA << bus_shift);
  47. __raw_writeb(READ_MODE | reg, addr);
  48. return __raw_readb(data);
  49. }
  50. EXPORT_SYMBOL(pasic3_read_register); /* for leds-pasic3 */
  51. /*
  52. * LEDs
  53. */
  54. static struct mfd_cell led_cell __initdata = {
  55. .name = "leds-pasic3",
  56. };
  57. /*
  58. * DS1WM
  59. */
  60. static int ds1wm_enable(struct platform_device *pdev)
  61. {
  62. struct device *dev = pdev->dev.parent;
  63. int c;
  64. c = pasic3_read_register(dev, 0x28);
  65. pasic3_write_register(dev, 0x28, c & 0x7f);
  66. dev_dbg(dev, "DS1WM OWM_EN low (active) %02x\n", c & 0x7f);
  67. return 0;
  68. }
  69. static int ds1wm_disable(struct platform_device *pdev)
  70. {
  71. struct device *dev = pdev->dev.parent;
  72. int c;
  73. c = pasic3_read_register(dev, 0x28);
  74. pasic3_write_register(dev, 0x28, c | 0x80);
  75. dev_dbg(dev, "DS1WM OWM_EN high (inactive) %02x\n", c | 0x80);
  76. return 0;
  77. }
  78. static struct ds1wm_driver_data ds1wm_pdata = {
  79. .active_high = 0,
  80. .reset_recover_delay = 1,
  81. };
  82. static struct resource ds1wm_resources[] __initdata = {
  83. [0] = {
  84. .start = 0,
  85. .flags = IORESOURCE_MEM,
  86. },
  87. [1] = {
  88. .start = 0,
  89. .end = 0,
  90. .flags = IORESOURCE_IRQ,
  91. },
  92. };
  93. static const struct mfd_cell ds1wm_cell __initconst = {
  94. .name = "ds1wm",
  95. .enable = ds1wm_enable,
  96. .disable = ds1wm_disable,
  97. .platform_data = &ds1wm_pdata,
  98. .pdata_size = sizeof(ds1wm_pdata),
  99. .num_resources = 2,
  100. .resources = ds1wm_resources,
  101. };
  102. static int __init pasic3_probe(struct platform_device *pdev)
  103. {
  104. struct pasic3_platform_data *pdata = dev_get_platdata(&pdev->dev);
  105. struct device *dev = &pdev->dev;
  106. struct pasic3_data *asic;
  107. struct resource *r;
  108. int ret;
  109. int irq = 0;
  110. r = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
  111. if (r) {
  112. ds1wm_resources[1].flags = IORESOURCE_IRQ | (r->flags &
  113. (IORESOURCE_IRQ_HIGHEDGE | IORESOURCE_IRQ_LOWEDGE));
  114. irq = r->start;
  115. }
  116. r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  117. if (!r)
  118. return -ENXIO;
  119. if (!request_mem_region(r->start, resource_size(r), "pasic3"))
  120. return -EBUSY;
  121. asic = devm_kzalloc(dev, sizeof(struct pasic3_data), GFP_KERNEL);
  122. if (!asic)
  123. return -ENOMEM;
  124. platform_set_drvdata(pdev, asic);
  125. asic->mapping = ioremap(r->start, resource_size(r));
  126. if (!asic->mapping) {
  127. dev_err(dev, "couldn't ioremap PASIC3\n");
  128. return -ENOMEM;
  129. }
  130. /* calculate bus shift from mem resource */
  131. asic->bus_shift = (resource_size(r) - 5) >> 3;
  132. if (pdata && pdata->clock_rate) {
  133. ds1wm_pdata.clock_rate = pdata->clock_rate;
  134. /* the first 5 PASIC3 registers control the DS1WM */
  135. ds1wm_resources[0].end = (5 << asic->bus_shift) - 1;
  136. ret = mfd_add_devices(&pdev->dev, pdev->id,
  137. &ds1wm_cell, 1, r, irq, NULL);
  138. if (ret < 0)
  139. dev_warn(dev, "failed to register DS1WM\n");
  140. }
  141. if (pdata && pdata->led_pdata) {
  142. led_cell.platform_data = pdata->led_pdata;
  143. led_cell.pdata_size = sizeof(struct pasic3_leds_machinfo);
  144. ret = mfd_add_devices(&pdev->dev, pdev->id, &led_cell, 1, r,
  145. 0, NULL);
  146. if (ret < 0)
  147. dev_warn(dev, "failed to register LED device\n");
  148. }
  149. return 0;
  150. }
  151. static int pasic3_remove(struct platform_device *pdev)
  152. {
  153. struct pasic3_data *asic = platform_get_drvdata(pdev);
  154. struct resource *r;
  155. mfd_remove_devices(&pdev->dev);
  156. iounmap(asic->mapping);
  157. r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  158. release_mem_region(r->start, resource_size(r));
  159. return 0;
  160. }
  161. MODULE_ALIAS("platform:pasic3");
  162. static struct platform_driver pasic3_driver = {
  163. .driver = {
  164. .name = "pasic3",
  165. },
  166. .remove = pasic3_remove,
  167. };
  168. module_platform_driver_probe(pasic3_driver, pasic3_probe);
  169. MODULE_AUTHOR("Philipp Zabel <philipp.zabel@gmail.com>");
  170. MODULE_DESCRIPTION("Core driver for HTC PASIC3");
  171. MODULE_LICENSE("GPL");