wcd934x.c 7.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302
  1. // SPDX-License-Identifier: GPL-2.0
  2. // Copyright (c) 2019, Linaro Limited
  3. #include <linux/clk.h>
  4. #include <linux/gpio.h>
  5. #include <linux/interrupt.h>
  6. #include <linux/kernel.h>
  7. #include <linux/mfd/core.h>
  8. #include <linux/mfd/wcd934x/registers.h>
  9. #include <linux/mfd/wcd934x/wcd934x.h>
  10. #include <linux/module.h>
  11. #include <linux/of_gpio.h>
  12. #include <linux/of.h>
  13. #include <linux/of_irq.h>
  14. #include <linux/platform_device.h>
  15. #include <linux/regmap.h>
  16. #include <linux/regulator/consumer.h>
  17. #include <linux/slimbus.h>
  18. static const struct mfd_cell wcd934x_devices[] = {
  19. {
  20. .name = "wcd934x-codec",
  21. }, {
  22. .name = "wcd934x-gpio",
  23. .of_compatible = "qcom,wcd9340-gpio",
  24. }, {
  25. .name = "wcd934x-soundwire",
  26. .of_compatible = "qcom,soundwire-v1.3.0",
  27. },
  28. };
  29. static const struct regmap_irq wcd934x_irqs[] = {
  30. [WCD934X_IRQ_SLIMBUS] = {
  31. .reg_offset = 0,
  32. .mask = BIT(0),
  33. .type = {
  34. .type_reg_offset = 0,
  35. .types_supported = IRQ_TYPE_EDGE_BOTH,
  36. .type_reg_mask = BIT(0),
  37. .type_level_low_val = BIT(0),
  38. .type_level_high_val = BIT(0),
  39. .type_falling_val = 0,
  40. .type_rising_val = 0,
  41. },
  42. },
  43. [WCD934X_IRQ_SOUNDWIRE] = {
  44. .reg_offset = 2,
  45. .mask = BIT(4),
  46. .type = {
  47. .type_reg_offset = 2,
  48. .types_supported = IRQ_TYPE_EDGE_BOTH,
  49. .type_reg_mask = BIT(4),
  50. .type_level_low_val = BIT(4),
  51. .type_level_high_val = BIT(4),
  52. .type_falling_val = 0,
  53. .type_rising_val = 0,
  54. },
  55. },
  56. };
  57. static const struct regmap_irq_chip wcd934x_regmap_irq_chip = {
  58. .name = "wcd934x_irq",
  59. .status_base = WCD934X_INTR_PIN1_STATUS0,
  60. .mask_base = WCD934X_INTR_PIN1_MASK0,
  61. .ack_base = WCD934X_INTR_PIN1_CLEAR0,
  62. .type_base = WCD934X_INTR_LEVEL0,
  63. .num_type_reg = 4,
  64. .type_in_mask = false,
  65. .num_regs = 4,
  66. .irqs = wcd934x_irqs,
  67. .num_irqs = ARRAY_SIZE(wcd934x_irqs),
  68. };
  69. static bool wcd934x_is_volatile_register(struct device *dev, unsigned int reg)
  70. {
  71. switch (reg) {
  72. case WCD934X_INTR_PIN1_STATUS0...WCD934X_INTR_PIN2_CLEAR3:
  73. case WCD934X_SWR_AHB_BRIDGE_RD_DATA_0:
  74. case WCD934X_SWR_AHB_BRIDGE_RD_DATA_1:
  75. case WCD934X_SWR_AHB_BRIDGE_RD_DATA_2:
  76. case WCD934X_SWR_AHB_BRIDGE_RD_DATA_3:
  77. case WCD934X_SWR_AHB_BRIDGE_ACCESS_STATUS:
  78. case WCD934X_ANA_MBHC_RESULT_3:
  79. case WCD934X_ANA_MBHC_RESULT_2:
  80. case WCD934X_ANA_MBHC_RESULT_1:
  81. case WCD934X_ANA_MBHC_MECH:
  82. case WCD934X_ANA_MBHC_ELECT:
  83. case WCD934X_ANA_MBHC_ZDET:
  84. case WCD934X_ANA_MICB2:
  85. case WCD934X_ANA_RCO:
  86. case WCD934X_ANA_BIAS:
  87. return true;
  88. default:
  89. return false;
  90. }
  91. };
  92. static const struct regmap_range_cfg wcd934x_ranges[] = {
  93. { .name = "WCD934X",
  94. .range_min = 0x0,
  95. .range_max = WCD934X_MAX_REGISTER,
  96. .selector_reg = WCD934X_SEL_REGISTER,
  97. .selector_mask = WCD934X_SEL_MASK,
  98. .selector_shift = WCD934X_SEL_SHIFT,
  99. .window_start = WCD934X_WINDOW_START,
  100. .window_len = WCD934X_WINDOW_LENGTH,
  101. },
  102. };
  103. static struct regmap_config wcd934x_regmap_config = {
  104. .reg_bits = 16,
  105. .val_bits = 8,
  106. .cache_type = REGCACHE_RBTREE,
  107. .max_register = 0xffff,
  108. .can_multi_write = true,
  109. .ranges = wcd934x_ranges,
  110. .num_ranges = ARRAY_SIZE(wcd934x_ranges),
  111. .volatile_reg = wcd934x_is_volatile_register,
  112. };
  113. static int wcd934x_bring_up(struct wcd934x_ddata *ddata)
  114. {
  115. struct regmap *regmap = ddata->regmap;
  116. u16 id_minor, id_major;
  117. int ret;
  118. ret = regmap_bulk_read(regmap, WCD934X_CHIP_TIER_CTRL_CHIP_ID_BYTE0,
  119. (u8 *)&id_minor, sizeof(u16));
  120. if (ret)
  121. return ret;
  122. ret = regmap_bulk_read(regmap, WCD934X_CHIP_TIER_CTRL_CHIP_ID_BYTE2,
  123. (u8 *)&id_major, sizeof(u16));
  124. if (ret)
  125. return ret;
  126. dev_info(ddata->dev, "WCD934x chip id major 0x%x, minor 0x%x\n",
  127. id_major, id_minor);
  128. regmap_write(regmap, WCD934X_CODEC_RPM_RST_CTL, 0x01);
  129. regmap_write(regmap, WCD934X_SIDO_NEW_VOUT_A_STARTUP, 0x19);
  130. regmap_write(regmap, WCD934X_SIDO_NEW_VOUT_D_STARTUP, 0x15);
  131. /* Add 1msec delay for VOUT to settle */
  132. usleep_range(1000, 1100);
  133. regmap_write(regmap, WCD934X_CODEC_RPM_PWR_CDC_DIG_HM_CTL, 0x5);
  134. regmap_write(regmap, WCD934X_CODEC_RPM_PWR_CDC_DIG_HM_CTL, 0x7);
  135. regmap_write(regmap, WCD934X_CODEC_RPM_RST_CTL, 0x3);
  136. regmap_write(regmap, WCD934X_CODEC_RPM_RST_CTL, 0x7);
  137. regmap_write(regmap, WCD934X_CODEC_RPM_PWR_CDC_DIG_HM_CTL, 0x3);
  138. return 0;
  139. }
  140. static int wcd934x_slim_status_up(struct slim_device *sdev)
  141. {
  142. struct device *dev = &sdev->dev;
  143. struct wcd934x_ddata *ddata;
  144. int ret;
  145. ddata = dev_get_drvdata(dev);
  146. ddata->regmap = regmap_init_slimbus(sdev, &wcd934x_regmap_config);
  147. if (IS_ERR(ddata->regmap)) {
  148. dev_err(dev, "Error allocating slim regmap\n");
  149. return PTR_ERR(ddata->regmap);
  150. }
  151. ret = wcd934x_bring_up(ddata);
  152. if (ret) {
  153. dev_err(dev, "Failed to bring up WCD934X: err = %d\n", ret);
  154. return ret;
  155. }
  156. ret = devm_regmap_add_irq_chip(dev, ddata->regmap, ddata->irq,
  157. IRQF_TRIGGER_HIGH, 0,
  158. &wcd934x_regmap_irq_chip,
  159. &ddata->irq_data);
  160. if (ret) {
  161. dev_err(dev, "Failed to add IRQ chip: err = %d\n", ret);
  162. return ret;
  163. }
  164. ret = mfd_add_devices(dev, PLATFORM_DEVID_AUTO, wcd934x_devices,
  165. ARRAY_SIZE(wcd934x_devices), NULL, 0, NULL);
  166. if (ret) {
  167. dev_err(dev, "Failed to add child devices: err = %d\n",
  168. ret);
  169. return ret;
  170. }
  171. return ret;
  172. }
  173. static int wcd934x_slim_status(struct slim_device *sdev,
  174. enum slim_device_status status)
  175. {
  176. switch (status) {
  177. case SLIM_DEVICE_STATUS_UP:
  178. return wcd934x_slim_status_up(sdev);
  179. case SLIM_DEVICE_STATUS_DOWN:
  180. mfd_remove_devices(&sdev->dev);
  181. break;
  182. default:
  183. return -EINVAL;
  184. }
  185. return 0;
  186. }
  187. static int wcd934x_slim_probe(struct slim_device *sdev)
  188. {
  189. struct device *dev = &sdev->dev;
  190. struct device_node *np = dev->of_node;
  191. struct wcd934x_ddata *ddata;
  192. int reset_gpio, ret;
  193. ddata = devm_kzalloc(dev, sizeof(*ddata), GFP_KERNEL);
  194. if (!ddata)
  195. return -ENOMEM;
  196. ddata->irq = of_irq_get(np, 0);
  197. if (ddata->irq < 0)
  198. return dev_err_probe(ddata->dev, ddata->irq,
  199. "Failed to get IRQ\n");
  200. reset_gpio = of_get_named_gpio(np, "reset-gpios", 0);
  201. if (reset_gpio < 0) {
  202. dev_err(dev, "Failed to get reset gpio: err = %d\n",
  203. reset_gpio);
  204. return reset_gpio;
  205. }
  206. ddata->extclk = devm_clk_get(dev, "extclk");
  207. if (IS_ERR(ddata->extclk)) {
  208. dev_err(dev, "Failed to get extclk");
  209. return PTR_ERR(ddata->extclk);
  210. }
  211. ddata->supplies[0].supply = "vdd-buck";
  212. ddata->supplies[1].supply = "vdd-buck-sido";
  213. ddata->supplies[2].supply = "vdd-tx";
  214. ddata->supplies[3].supply = "vdd-rx";
  215. ddata->supplies[4].supply = "vdd-io";
  216. ret = regulator_bulk_get(dev, WCD934X_MAX_SUPPLY, ddata->supplies);
  217. if (ret) {
  218. dev_err(dev, "Failed to get supplies: err = %d\n", ret);
  219. return ret;
  220. }
  221. ret = regulator_bulk_enable(WCD934X_MAX_SUPPLY, ddata->supplies);
  222. if (ret) {
  223. dev_err(dev, "Failed to enable supplies: err = %d\n", ret);
  224. return ret;
  225. }
  226. /*
  227. * For WCD934X, it takes about 600us for the Vout_A and
  228. * Vout_D to be ready after BUCK_SIDO is powered up.
  229. * SYS_RST_N shouldn't be pulled high during this time
  230. */
  231. usleep_range(600, 650);
  232. gpio_direction_output(reset_gpio, 0);
  233. msleep(20);
  234. gpio_set_value(reset_gpio, 1);
  235. msleep(20);
  236. ddata->dev = dev;
  237. dev_set_drvdata(dev, ddata);
  238. return 0;
  239. }
  240. static void wcd934x_slim_remove(struct slim_device *sdev)
  241. {
  242. struct wcd934x_ddata *ddata = dev_get_drvdata(&sdev->dev);
  243. regulator_bulk_disable(WCD934X_MAX_SUPPLY, ddata->supplies);
  244. mfd_remove_devices(&sdev->dev);
  245. }
  246. static const struct slim_device_id wcd934x_slim_id[] = {
  247. { SLIM_MANF_ID_QCOM, SLIM_PROD_CODE_WCD9340,
  248. SLIM_DEV_IDX_WCD9340, SLIM_DEV_INSTANCE_ID_WCD9340 },
  249. {}
  250. };
  251. static struct slim_driver wcd934x_slim_driver = {
  252. .driver = {
  253. .name = "wcd934x-slim",
  254. },
  255. .probe = wcd934x_slim_probe,
  256. .remove = wcd934x_slim_remove,
  257. .device_status = wcd934x_slim_status,
  258. .id_table = wcd934x_slim_id,
  259. };
  260. module_slim_driver(wcd934x_slim_driver);
  261. MODULE_DESCRIPTION("WCD934X slim driver");
  262. MODULE_LICENSE("GPL v2");
  263. MODULE_ALIAS("slim:217:250:*");
  264. MODULE_AUTHOR("Srinivas Kandagatla <srinivas.kandagatla@linaro.org>");