aat2870-regulator.c 4.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * linux/drivers/regulator/aat2870-regulator.c
  4. *
  5. * Copyright (c) 2011, NVIDIA Corporation.
  6. * Author: Jin Park <jinyoungp@nvidia.com>
  7. */
  8. #include <linux/kernel.h>
  9. #include <linux/init.h>
  10. #include <linux/err.h>
  11. #include <linux/module.h>
  12. #include <linux/slab.h>
  13. #include <linux/platform_device.h>
  14. #include <linux/regulator/driver.h>
  15. #include <linux/regulator/machine.h>
  16. #include <linux/mfd/aat2870.h>
  17. struct aat2870_regulator {
  18. struct aat2870_data *aat2870;
  19. struct regulator_desc desc;
  20. u8 enable_addr;
  21. u8 enable_shift;
  22. u8 enable_mask;
  23. u8 voltage_addr;
  24. u8 voltage_shift;
  25. u8 voltage_mask;
  26. };
  27. static int aat2870_ldo_set_voltage_sel(struct regulator_dev *rdev,
  28. unsigned selector)
  29. {
  30. struct aat2870_regulator *ri = rdev_get_drvdata(rdev);
  31. struct aat2870_data *aat2870 = ri->aat2870;
  32. return aat2870->update(aat2870, ri->voltage_addr, ri->voltage_mask,
  33. selector << ri->voltage_shift);
  34. }
  35. static int aat2870_ldo_get_voltage_sel(struct regulator_dev *rdev)
  36. {
  37. struct aat2870_regulator *ri = rdev_get_drvdata(rdev);
  38. struct aat2870_data *aat2870 = ri->aat2870;
  39. u8 val;
  40. int ret;
  41. ret = aat2870->read(aat2870, ri->voltage_addr, &val);
  42. if (ret)
  43. return ret;
  44. return (val & ri->voltage_mask) >> ri->voltage_shift;
  45. }
  46. static int aat2870_ldo_enable(struct regulator_dev *rdev)
  47. {
  48. struct aat2870_regulator *ri = rdev_get_drvdata(rdev);
  49. struct aat2870_data *aat2870 = ri->aat2870;
  50. return aat2870->update(aat2870, ri->enable_addr, ri->enable_mask,
  51. ri->enable_mask);
  52. }
  53. static int aat2870_ldo_disable(struct regulator_dev *rdev)
  54. {
  55. struct aat2870_regulator *ri = rdev_get_drvdata(rdev);
  56. struct aat2870_data *aat2870 = ri->aat2870;
  57. return aat2870->update(aat2870, ri->enable_addr, ri->enable_mask, 0);
  58. }
  59. static int aat2870_ldo_is_enabled(struct regulator_dev *rdev)
  60. {
  61. struct aat2870_regulator *ri = rdev_get_drvdata(rdev);
  62. struct aat2870_data *aat2870 = ri->aat2870;
  63. u8 val;
  64. int ret;
  65. ret = aat2870->read(aat2870, ri->enable_addr, &val);
  66. if (ret)
  67. return ret;
  68. return val & ri->enable_mask ? 1 : 0;
  69. }
  70. static const struct regulator_ops aat2870_ldo_ops = {
  71. .list_voltage = regulator_list_voltage_table,
  72. .map_voltage = regulator_map_voltage_ascend,
  73. .set_voltage_sel = aat2870_ldo_set_voltage_sel,
  74. .get_voltage_sel = aat2870_ldo_get_voltage_sel,
  75. .enable = aat2870_ldo_enable,
  76. .disable = aat2870_ldo_disable,
  77. .is_enabled = aat2870_ldo_is_enabled,
  78. };
  79. static const unsigned int aat2870_ldo_voltages[] = {
  80. 1200000, 1300000, 1500000, 1600000,
  81. 1800000, 2000000, 2200000, 2500000,
  82. 2600000, 2700000, 2800000, 2900000,
  83. 3000000, 3100000, 3200000, 3300000,
  84. };
  85. #define AAT2870_LDO(ids) \
  86. { \
  87. .desc = { \
  88. .name = #ids, \
  89. .id = AAT2870_ID_##ids, \
  90. .n_voltages = ARRAY_SIZE(aat2870_ldo_voltages), \
  91. .volt_table = aat2870_ldo_voltages, \
  92. .ops = &aat2870_ldo_ops, \
  93. .type = REGULATOR_VOLTAGE, \
  94. .owner = THIS_MODULE, \
  95. }, \
  96. }
  97. static struct aat2870_regulator aat2870_regulators[] = {
  98. AAT2870_LDO(LDOA),
  99. AAT2870_LDO(LDOB),
  100. AAT2870_LDO(LDOC),
  101. AAT2870_LDO(LDOD),
  102. };
  103. static struct aat2870_regulator *aat2870_get_regulator(int id)
  104. {
  105. struct aat2870_regulator *ri = NULL;
  106. int i;
  107. for (i = 0; i < ARRAY_SIZE(aat2870_regulators); i++) {
  108. ri = &aat2870_regulators[i];
  109. if (ri->desc.id == id)
  110. break;
  111. }
  112. if (i == ARRAY_SIZE(aat2870_regulators))
  113. return NULL;
  114. ri->enable_addr = AAT2870_LDO_EN;
  115. ri->enable_shift = id - AAT2870_ID_LDOA;
  116. ri->enable_mask = 0x1 << ri->enable_shift;
  117. ri->voltage_addr = (id - AAT2870_ID_LDOA) / 2 ?
  118. AAT2870_LDO_CD : AAT2870_LDO_AB;
  119. ri->voltage_shift = (id - AAT2870_ID_LDOA) % 2 ? 0 : 4;
  120. ri->voltage_mask = 0xF << ri->voltage_shift;
  121. return ri;
  122. }
  123. static int aat2870_regulator_probe(struct platform_device *pdev)
  124. {
  125. struct aat2870_regulator *ri;
  126. struct regulator_config config = { };
  127. struct regulator_dev *rdev;
  128. ri = aat2870_get_regulator(pdev->id);
  129. if (!ri) {
  130. dev_err(&pdev->dev, "Invalid device ID, %d\n", pdev->id);
  131. return -EINVAL;
  132. }
  133. ri->aat2870 = dev_get_drvdata(pdev->dev.parent);
  134. config.dev = &pdev->dev;
  135. config.driver_data = ri;
  136. config.init_data = dev_get_platdata(&pdev->dev);
  137. rdev = devm_regulator_register(&pdev->dev, &ri->desc, &config);
  138. if (IS_ERR(rdev)) {
  139. dev_err(&pdev->dev, "Failed to register regulator %s\n",
  140. ri->desc.name);
  141. return PTR_ERR(rdev);
  142. }
  143. platform_set_drvdata(pdev, rdev);
  144. return 0;
  145. }
  146. static struct platform_driver aat2870_regulator_driver = {
  147. .driver = {
  148. .name = "aat2870-regulator",
  149. },
  150. .probe = aat2870_regulator_probe,
  151. };
  152. static int __init aat2870_regulator_init(void)
  153. {
  154. return platform_driver_register(&aat2870_regulator_driver);
  155. }
  156. subsys_initcall(aat2870_regulator_init);
  157. static void __exit aat2870_regulator_exit(void)
  158. {
  159. platform_driver_unregister(&aat2870_regulator_driver);
  160. }
  161. module_exit(aat2870_regulator_exit);
  162. MODULE_DESCRIPTION("AnalogicTech AAT2870 Regulator");
  163. MODULE_LICENSE("GPL");
  164. MODULE_AUTHOR("Jin Park <jinyoungp@nvidia.com>");
  165. MODULE_ALIAS("platform:aat2870-regulator");