lochnagar-regulator.c 7.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285
  1. // SPDX-License-Identifier: GPL-2.0
  2. //
  3. // Lochnagar regulator driver
  4. //
  5. // Copyright (c) 2017-2018 Cirrus Logic, Inc. and
  6. // Cirrus Logic International Semiconductor Ltd.
  7. //
  8. // Author: Charles Keepax <ckeepax@opensource.cirrus.com>
  9. #include <linux/bitops.h>
  10. #include <linux/device.h>
  11. #include <linux/err.h>
  12. #include <linux/module.h>
  13. #include <linux/mutex.h>
  14. #include <linux/of.h>
  15. #include <linux/of_device.h>
  16. #include <linux/platform_device.h>
  17. #include <linux/regmap.h>
  18. #include <linux/regulator/driver.h>
  19. #include <linux/regulator/machine.h>
  20. #include <linux/regulator/of_regulator.h>
  21. #include <linux/mfd/lochnagar.h>
  22. #include <linux/mfd/lochnagar1_regs.h>
  23. #include <linux/mfd/lochnagar2_regs.h>
  24. static const struct regulator_ops lochnagar_micvdd_ops = {
  25. .enable = regulator_enable_regmap,
  26. .disable = regulator_disable_regmap,
  27. .is_enabled = regulator_is_enabled_regmap,
  28. .list_voltage = regulator_list_voltage_linear_range,
  29. .map_voltage = regulator_map_voltage_linear_range,
  30. .get_voltage_sel = regulator_get_voltage_sel_regmap,
  31. .set_voltage_sel = regulator_set_voltage_sel_regmap,
  32. };
  33. static const struct linear_range lochnagar_micvdd_ranges[] = {
  34. REGULATOR_LINEAR_RANGE(1000000, 0, 0xC, 50000),
  35. REGULATOR_LINEAR_RANGE(1700000, 0xD, 0x1F, 100000),
  36. };
  37. static int lochnagar_micbias_enable(struct regulator_dev *rdev)
  38. {
  39. struct lochnagar *lochnagar = rdev_get_drvdata(rdev);
  40. int ret;
  41. mutex_lock(&lochnagar->analogue_config_lock);
  42. ret = regulator_enable_regmap(rdev);
  43. if (ret < 0)
  44. goto err;
  45. ret = lochnagar_update_config(lochnagar);
  46. err:
  47. mutex_unlock(&lochnagar->analogue_config_lock);
  48. return ret;
  49. }
  50. static int lochnagar_micbias_disable(struct regulator_dev *rdev)
  51. {
  52. struct lochnagar *lochnagar = rdev_get_drvdata(rdev);
  53. int ret;
  54. mutex_lock(&lochnagar->analogue_config_lock);
  55. ret = regulator_disable_regmap(rdev);
  56. if (ret < 0)
  57. goto err;
  58. ret = lochnagar_update_config(lochnagar);
  59. err:
  60. mutex_unlock(&lochnagar->analogue_config_lock);
  61. return ret;
  62. }
  63. static const struct regulator_ops lochnagar_micbias_ops = {
  64. .enable = lochnagar_micbias_enable,
  65. .disable = lochnagar_micbias_disable,
  66. .is_enabled = regulator_is_enabled_regmap,
  67. };
  68. static const struct regulator_ops lochnagar_vddcore_ops = {
  69. .enable = regulator_enable_regmap,
  70. .disable = regulator_disable_regmap,
  71. .is_enabled = regulator_is_enabled_regmap,
  72. .list_voltage = regulator_list_voltage_linear_range,
  73. .map_voltage = regulator_map_voltage_linear_range,
  74. .get_voltage_sel = regulator_get_voltage_sel_regmap,
  75. .set_voltage_sel = regulator_set_voltage_sel_regmap,
  76. };
  77. static const struct linear_range lochnagar_vddcore_ranges[] = {
  78. REGULATOR_LINEAR_RANGE(600000, 0, 0x7, 0),
  79. REGULATOR_LINEAR_RANGE(600000, 0x8, 0x41, 12500),
  80. };
  81. enum lochnagar_regulators {
  82. LOCHNAGAR_MICVDD,
  83. LOCHNAGAR_MIC1VDD,
  84. LOCHNAGAR_MIC2VDD,
  85. LOCHNAGAR_VDDCORE,
  86. };
  87. static int lochnagar_micbias_of_parse(struct device_node *np,
  88. const struct regulator_desc *desc,
  89. struct regulator_config *config)
  90. {
  91. struct lochnagar *lochnagar = config->driver_data;
  92. int shift = (desc->id - LOCHNAGAR_MIC1VDD) *
  93. LOCHNAGAR2_P2_MICBIAS_SRC_SHIFT;
  94. int mask = LOCHNAGAR2_P1_MICBIAS_SRC_MASK << shift;
  95. unsigned int val;
  96. int ret;
  97. ret = of_property_read_u32(np, "cirrus,micbias-input", &val);
  98. if (ret >= 0) {
  99. mutex_lock(&lochnagar->analogue_config_lock);
  100. ret = regmap_update_bits(lochnagar->regmap,
  101. LOCHNAGAR2_ANALOGUE_PATH_CTRL2,
  102. mask, val << shift);
  103. mutex_unlock(&lochnagar->analogue_config_lock);
  104. if (ret < 0) {
  105. dev_err(lochnagar->dev,
  106. "Failed to update micbias source: %d\n", ret);
  107. return ret;
  108. }
  109. }
  110. return 0;
  111. }
  112. static const struct regulator_desc lochnagar_regulators[] = {
  113. [LOCHNAGAR_MICVDD] = {
  114. .name = "MICVDD",
  115. .supply_name = "SYSVDD",
  116. .type = REGULATOR_VOLTAGE,
  117. .n_voltages = 32,
  118. .ops = &lochnagar_micvdd_ops,
  119. .id = LOCHNAGAR_MICVDD,
  120. .of_match = of_match_ptr("MICVDD"),
  121. .enable_reg = LOCHNAGAR2_MICVDD_CTRL1,
  122. .enable_mask = LOCHNAGAR2_MICVDD_REG_ENA_MASK,
  123. .vsel_reg = LOCHNAGAR2_MICVDD_CTRL2,
  124. .vsel_mask = LOCHNAGAR2_MICVDD_VSEL_MASK,
  125. .linear_ranges = lochnagar_micvdd_ranges,
  126. .n_linear_ranges = ARRAY_SIZE(lochnagar_micvdd_ranges),
  127. .enable_time = 3000,
  128. .ramp_delay = 1000,
  129. .owner = THIS_MODULE,
  130. },
  131. [LOCHNAGAR_MIC1VDD] = {
  132. .name = "MIC1VDD",
  133. .supply_name = "MICBIAS1",
  134. .type = REGULATOR_VOLTAGE,
  135. .ops = &lochnagar_micbias_ops,
  136. .id = LOCHNAGAR_MIC1VDD,
  137. .of_match = of_match_ptr("MIC1VDD"),
  138. .of_parse_cb = lochnagar_micbias_of_parse,
  139. .enable_reg = LOCHNAGAR2_ANALOGUE_PATH_CTRL2,
  140. .enable_mask = LOCHNAGAR2_P1_INPUT_BIAS_ENA_MASK,
  141. .owner = THIS_MODULE,
  142. },
  143. [LOCHNAGAR_MIC2VDD] = {
  144. .name = "MIC2VDD",
  145. .supply_name = "MICBIAS2",
  146. .type = REGULATOR_VOLTAGE,
  147. .ops = &lochnagar_micbias_ops,
  148. .id = LOCHNAGAR_MIC2VDD,
  149. .of_match = of_match_ptr("MIC2VDD"),
  150. .of_parse_cb = lochnagar_micbias_of_parse,
  151. .enable_reg = LOCHNAGAR2_ANALOGUE_PATH_CTRL2,
  152. .enable_mask = LOCHNAGAR2_P2_INPUT_BIAS_ENA_MASK,
  153. .owner = THIS_MODULE,
  154. },
  155. [LOCHNAGAR_VDDCORE] = {
  156. .name = "VDDCORE",
  157. .supply_name = "SYSVDD",
  158. .type = REGULATOR_VOLTAGE,
  159. .n_voltages = 66,
  160. .ops = &lochnagar_vddcore_ops,
  161. .id = LOCHNAGAR_VDDCORE,
  162. .of_match = of_match_ptr("VDDCORE"),
  163. .enable_reg = LOCHNAGAR2_VDDCORE_CDC_CTRL1,
  164. .enable_mask = LOCHNAGAR2_VDDCORE_CDC_REG_ENA_MASK,
  165. .vsel_reg = LOCHNAGAR2_VDDCORE_CDC_CTRL2,
  166. .vsel_mask = LOCHNAGAR2_VDDCORE_CDC_VSEL_MASK,
  167. .linear_ranges = lochnagar_vddcore_ranges,
  168. .n_linear_ranges = ARRAY_SIZE(lochnagar_vddcore_ranges),
  169. .enable_time = 3000,
  170. .ramp_delay = 1000,
  171. .off_on_delay = 15000,
  172. .owner = THIS_MODULE,
  173. },
  174. };
  175. static const struct of_device_id lochnagar_of_match[] = {
  176. {
  177. .compatible = "cirrus,lochnagar2-micvdd",
  178. .data = &lochnagar_regulators[LOCHNAGAR_MICVDD],
  179. },
  180. {
  181. .compatible = "cirrus,lochnagar2-mic1vdd",
  182. .data = &lochnagar_regulators[LOCHNAGAR_MIC1VDD],
  183. },
  184. {
  185. .compatible = "cirrus,lochnagar2-mic2vdd",
  186. .data = &lochnagar_regulators[LOCHNAGAR_MIC2VDD],
  187. },
  188. {
  189. .compatible = "cirrus,lochnagar2-vddcore",
  190. .data = &lochnagar_regulators[LOCHNAGAR_VDDCORE],
  191. },
  192. {}
  193. };
  194. MODULE_DEVICE_TABLE(of, lochnagar_of_match);
  195. static int lochnagar_regulator_probe(struct platform_device *pdev)
  196. {
  197. struct device *dev = &pdev->dev;
  198. struct lochnagar *lochnagar = dev_get_drvdata(dev->parent);
  199. struct regulator_config config = { };
  200. const struct of_device_id *of_id;
  201. const struct regulator_desc *desc;
  202. struct regulator_dev *rdev;
  203. int ret;
  204. config.dev = dev;
  205. config.regmap = lochnagar->regmap;
  206. config.driver_data = lochnagar;
  207. of_id = of_match_device(lochnagar_of_match, dev);
  208. if (!of_id)
  209. return -EINVAL;
  210. desc = of_id->data;
  211. rdev = devm_regulator_register(dev, desc, &config);
  212. if (IS_ERR(rdev)) {
  213. ret = PTR_ERR(rdev);
  214. dev_err(dev, "Failed to register %s regulator: %d\n",
  215. desc->name, ret);
  216. return ret;
  217. }
  218. return 0;
  219. }
  220. static struct platform_driver lochnagar_regulator_driver = {
  221. .driver = {
  222. .name = "lochnagar-regulator",
  223. .of_match_table = of_match_ptr(lochnagar_of_match),
  224. },
  225. .probe = lochnagar_regulator_probe,
  226. };
  227. module_platform_driver(lochnagar_regulator_driver);
  228. MODULE_AUTHOR("Charles Keepax <ckeepax@opensource.cirrus.com>");
  229. MODULE_DESCRIPTION("Regulator driver for Cirrus Logic Lochnagar Board");
  230. MODULE_LICENSE("GPL v2");
  231. MODULE_ALIAS("platform:lochnagar-regulator");