rtq2208-regulator.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638
  1. // SPDX-License-Identifier: GPL-2.0+
  2. #include <linux/bitops.h>
  3. #include <linux/bitfield.h>
  4. #include <linux/util_macros.h>
  5. #include <linux/module.h>
  6. #include <linux/i2c.h>
  7. #include <linux/regmap.h>
  8. #include <linux/regulator/driver.h>
  9. #include <linux/regulator/machine.h>
  10. #include <linux/regulator/of_regulator.h>
  11. #include <linux/mod_devicetable.h>
  12. /* Register */
  13. #define RTQ2208_REG_GLOBAL_INT1 0x12
  14. #define RTQ2208_REG_FLT_RECORDBUCK_CB 0x18
  15. #define RTQ2208_REG_GLOBAL_INT1_MASK 0x1D
  16. #define RTQ2208_REG_FLT_MASKBUCK_CB 0x1F
  17. #define RTQ2208_REG_BUCK_C_CFG0 0x32
  18. #define RTQ2208_REG_BUCK_B_CFG0 0x42
  19. #define RTQ2208_REG_BUCK_A_CFG0 0x52
  20. #define RTQ2208_REG_BUCK_D_CFG0 0x62
  21. #define RTQ2208_REG_BUCK_G_CFG0 0x72
  22. #define RTQ2208_REG_BUCK_F_CFG0 0x82
  23. #define RTQ2208_REG_BUCK_E_CFG0 0x92
  24. #define RTQ2208_REG_BUCK_H_CFG0 0xA2
  25. #define RTQ2208_REG_LDO1_CFG 0xB1
  26. #define RTQ2208_REG_LDO2_CFG 0xC1
  27. #define RTQ2208_REG_LDO_DVS_CTRL 0xD0
  28. /* Mask */
  29. #define RTQ2208_BUCK_NR_MTP_SEL_MASK GENMASK(7, 0)
  30. #define RTQ2208_BUCK_EN_NR_MTP_SEL0_MASK BIT(0)
  31. #define RTQ2208_BUCK_EN_NR_MTP_SEL1_MASK BIT(1)
  32. #define RTQ2208_BUCK_RSPUP_MASK GENMASK(6, 4)
  33. #define RTQ2208_BUCK_RSPDN_MASK GENMASK(2, 0)
  34. #define RTQ2208_BUCK_NRMODE_MASK BIT(5)
  35. #define RTQ2208_BUCK_STRMODE_MASK BIT(5)
  36. #define RTQ2208_BUCK_EN_STR_MASK BIT(0)
  37. #define RTQ2208_LDO_EN_STR_MASK BIT(7)
  38. #define RTQ2208_EN_DIS_MASK BIT(0)
  39. #define RTQ2208_BUCK_RAMP_SEL_MASK GENMASK(2, 0)
  40. #define RTQ2208_HD_INT_MASK BIT(0)
  41. #define RTQ2208_LDO1_DISCHG_EN_MASK BIT(4)
  42. #define RTQ2208_LDO1_VOSEL_SD_MASK BIT(5)
  43. #define RTQ2208_LDO2_DISCHG_EN_MASK BIT(6)
  44. #define RTQ2208_LDO2_VOSEL_SD_MASK BIT(7)
  45. /* Size */
  46. #define RTQ2208_VOUT_MAXNUM 256
  47. #define RTQ2208_BUCK_NUM_IRQ_REGS 5
  48. #define RTQ2208_STS_NUM_IRQ_REGS 2
  49. /* Value */
  50. #define RTQ2208_RAMP_VALUE_MIN_uV 500
  51. #define RTQ2208_RAMP_VALUE_MAX_uV 16000
  52. #define RTQ2208_BUCK_MASK(uv_irq, ov_irq) (1 << ((uv_irq) % 8) | 1 << ((ov_irq) % 8))
  53. enum {
  54. RTQ2208_BUCK_B = 0,
  55. RTQ2208_BUCK_C,
  56. RTQ2208_BUCK_D,
  57. RTQ2208_BUCK_A,
  58. RTQ2208_BUCK_F,
  59. RTQ2208_BUCK_G,
  60. RTQ2208_BUCK_H,
  61. RTQ2208_BUCK_E,
  62. RTQ2208_LDO2,
  63. RTQ2208_LDO1,
  64. RTQ2208_LDO_MAX,
  65. };
  66. enum {
  67. RTQ2208_AUTO_MODE = 0,
  68. RTQ2208_FCCM,
  69. };
  70. struct rtq2208_regulator_desc {
  71. struct regulator_desc desc;
  72. unsigned int mtp_sel_reg;
  73. unsigned int mtp_sel_mask;
  74. unsigned int mode_reg;
  75. unsigned int mode_mask;
  76. unsigned int suspend_config_reg;
  77. unsigned int suspend_enable_mask;
  78. unsigned int suspend_mode_mask;
  79. };
  80. struct rtq2208_rdev_map {
  81. struct regulator_dev *rdev[RTQ2208_LDO_MAX];
  82. struct regmap *regmap;
  83. struct device *dev;
  84. };
  85. /* set Normal Auto/FCCM mode */
  86. static int rtq2208_set_mode(struct regulator_dev *rdev, unsigned int mode)
  87. {
  88. const struct rtq2208_regulator_desc *rdesc =
  89. (const struct rtq2208_regulator_desc *)rdev->desc;
  90. unsigned int val, shift;
  91. switch (mode) {
  92. case REGULATOR_MODE_NORMAL:
  93. val = RTQ2208_AUTO_MODE;
  94. break;
  95. case REGULATOR_MODE_FAST:
  96. val = RTQ2208_FCCM;
  97. break;
  98. default:
  99. return -EINVAL;
  100. }
  101. shift = ffs(rdesc->mode_mask) - 1;
  102. return regmap_update_bits(rdev->regmap, rdesc->mode_reg,
  103. rdesc->mode_mask, val << shift);
  104. }
  105. static unsigned int rtq2208_get_mode(struct regulator_dev *rdev)
  106. {
  107. const struct rtq2208_regulator_desc *rdesc =
  108. (const struct rtq2208_regulator_desc *)rdev->desc;
  109. unsigned int mode_val;
  110. int ret;
  111. ret = regmap_read(rdev->regmap, rdesc->mode_reg, &mode_val);
  112. if (ret)
  113. return REGULATOR_MODE_INVALID;
  114. return (mode_val & rdesc->mode_mask) ? REGULATOR_MODE_FAST : REGULATOR_MODE_NORMAL;
  115. }
  116. static int rtq2208_set_ramp_delay(struct regulator_dev *rdev, int ramp_delay)
  117. {
  118. const struct regulator_desc *desc = rdev->desc;
  119. unsigned int sel = 0, val;
  120. ramp_delay = max(ramp_delay, RTQ2208_RAMP_VALUE_MIN_uV);
  121. ramp_delay = min(ramp_delay, RTQ2208_RAMP_VALUE_MAX_uV);
  122. ramp_delay /= RTQ2208_RAMP_VALUE_MIN_uV;
  123. /*
  124. * fls(ramp_delay) - 1: doing LSB shift, let it starts from 0
  125. *
  126. * RTQ2208_BUCK_RAMP_SEL_MASK - sel: doing descending order shifting.
  127. * Because the relation of seleltion and value is like that
  128. *
  129. * seletion: value
  130. * 010: 16mv
  131. * ...
  132. * 111: 0.5mv
  133. *
  134. * For example, if I would like to select 16mv, the fls(ramp_delay) - 1 will be 0b010,
  135. * and I need to use 0b111 - sel to do the shifting
  136. */
  137. sel = fls(ramp_delay) - 1;
  138. sel = RTQ2208_BUCK_RAMP_SEL_MASK - sel;
  139. val = FIELD_PREP(RTQ2208_BUCK_RSPUP_MASK, sel) | FIELD_PREP(RTQ2208_BUCK_RSPDN_MASK, sel);
  140. return regmap_update_bits(rdev->regmap, desc->ramp_reg,
  141. RTQ2208_BUCK_RSPUP_MASK | RTQ2208_BUCK_RSPDN_MASK, val);
  142. }
  143. static int rtq2208_set_suspend_enable(struct regulator_dev *rdev)
  144. {
  145. const struct rtq2208_regulator_desc *rdesc =
  146. (const struct rtq2208_regulator_desc *)rdev->desc;
  147. return regmap_set_bits(rdev->regmap, rdesc->suspend_config_reg, rdesc->suspend_enable_mask);
  148. }
  149. static int rtq2208_set_suspend_disable(struct regulator_dev *rdev)
  150. {
  151. const struct rtq2208_regulator_desc *rdesc =
  152. (const struct rtq2208_regulator_desc *)rdev->desc;
  153. return regmap_update_bits(rdev->regmap, rdesc->suspend_config_reg, rdesc->suspend_enable_mask, 0);
  154. }
  155. static int rtq2208_set_suspend_mode(struct regulator_dev *rdev, unsigned int mode)
  156. {
  157. const struct rtq2208_regulator_desc *rdesc =
  158. (const struct rtq2208_regulator_desc *)rdev->desc;
  159. unsigned int val, shift;
  160. switch (mode) {
  161. case REGULATOR_MODE_NORMAL:
  162. val = RTQ2208_AUTO_MODE;
  163. break;
  164. case REGULATOR_MODE_FAST:
  165. val = RTQ2208_FCCM;
  166. break;
  167. default:
  168. return -EINVAL;
  169. }
  170. shift = ffs(rdesc->suspend_mode_mask) - 1;
  171. return regmap_update_bits(rdev->regmap, rdesc->suspend_config_reg,
  172. rdesc->suspend_mode_mask, val << shift);
  173. }
  174. static const struct regulator_ops rtq2208_regulator_buck_ops = {
  175. .enable = regulator_enable_regmap,
  176. .disable = regulator_disable_regmap,
  177. .is_enabled = regulator_is_enabled_regmap,
  178. .list_voltage = regulator_list_voltage_linear_range,
  179. .set_voltage_sel = regulator_set_voltage_sel_regmap,
  180. .get_voltage_sel = regulator_get_voltage_sel_regmap,
  181. .set_mode = rtq2208_set_mode,
  182. .get_mode = rtq2208_get_mode,
  183. .set_ramp_delay = rtq2208_set_ramp_delay,
  184. .set_active_discharge = regulator_set_active_discharge_regmap,
  185. .set_suspend_enable = rtq2208_set_suspend_enable,
  186. .set_suspend_disable = rtq2208_set_suspend_disable,
  187. .set_suspend_mode = rtq2208_set_suspend_mode,
  188. };
  189. static const struct regulator_ops rtq2208_regulator_ldo_fix_ops = {
  190. .enable = regulator_enable_regmap,
  191. .disable = regulator_disable_regmap,
  192. .is_enabled = regulator_is_enabled_regmap,
  193. .set_active_discharge = regulator_set_active_discharge_regmap,
  194. .set_suspend_enable = rtq2208_set_suspend_enable,
  195. .set_suspend_disable = rtq2208_set_suspend_disable,
  196. };
  197. static const struct regulator_ops rtq2208_regulator_ldo_adj_ops = {
  198. .enable = regulator_enable_regmap,
  199. .disable = regulator_disable_regmap,
  200. .is_enabled = regulator_is_enabled_regmap,
  201. .list_voltage = regulator_list_voltage_table,
  202. .set_voltage_sel = regulator_set_voltage_sel_regmap,
  203. .get_voltage_sel = regulator_get_voltage_sel_regmap,
  204. .set_active_discharge = regulator_set_active_discharge_regmap,
  205. .set_suspend_enable = rtq2208_set_suspend_enable,
  206. .set_suspend_disable = rtq2208_set_suspend_disable,
  207. };
  208. static const unsigned int rtq2208_ldo_volt_table[] = {
  209. 1800000,
  210. 3300000,
  211. };
  212. static struct of_regulator_match rtq2208_ldo_match[] = {
  213. {.name = "ldo2", },
  214. {.name = "ldo1", },
  215. };
  216. static unsigned int rtq2208_of_map_mode(unsigned int mode)
  217. {
  218. switch (mode) {
  219. case RTQ2208_AUTO_MODE:
  220. return REGULATOR_MODE_NORMAL;
  221. case RTQ2208_FCCM:
  222. return REGULATOR_MODE_FAST;
  223. default:
  224. return REGULATOR_MODE_INVALID;
  225. }
  226. }
  227. static int rtq2208_init_irq_mask(struct rtq2208_rdev_map *rdev_map, unsigned int *buck_masks)
  228. {
  229. unsigned char buck_clr_masks[5] = {0x33, 0x33, 0x33, 0x33, 0x33},
  230. sts_clr_masks[2] = {0xE7, 0xF7}, sts_masks[2] = {0xE6, 0xF6};
  231. int ret;
  232. /* write clear all buck irq once */
  233. ret = regmap_bulk_write(rdev_map->regmap, RTQ2208_REG_FLT_RECORDBUCK_CB, buck_clr_masks, 5);
  234. if (ret)
  235. return dev_err_probe(rdev_map->dev, ret, "Failed to clr buck irqs\n");
  236. /* write clear general irq once */
  237. ret = regmap_bulk_write(rdev_map->regmap, RTQ2208_REG_GLOBAL_INT1, sts_clr_masks, 2);
  238. if (ret)
  239. return dev_err_probe(rdev_map->dev, ret, "Failed to clr general irqs\n");
  240. /* unmask buck ov/uv irq */
  241. ret = regmap_bulk_write(rdev_map->regmap, RTQ2208_REG_FLT_MASKBUCK_CB, buck_masks, 5);
  242. if (ret)
  243. return dev_err_probe(rdev_map->dev, ret, "Failed to unmask buck irqs\n");
  244. /* unmask needed general irq */
  245. return regmap_bulk_write(rdev_map->regmap, RTQ2208_REG_GLOBAL_INT1_MASK, sts_masks, 2);
  246. }
  247. static irqreturn_t rtq2208_irq_handler(int irqno, void *devid)
  248. {
  249. unsigned char buck_flags[RTQ2208_BUCK_NUM_IRQ_REGS], sts_flags[RTQ2208_STS_NUM_IRQ_REGS];
  250. int ret = 0, i, uv_bit, ov_bit;
  251. struct rtq2208_rdev_map *rdev_map = devid;
  252. struct regulator_dev *rdev;
  253. if (!rdev_map)
  254. return IRQ_NONE;
  255. /* read irq event */
  256. ret = regmap_bulk_read(rdev_map->regmap, RTQ2208_REG_FLT_RECORDBUCK_CB,
  257. buck_flags, ARRAY_SIZE(buck_flags));
  258. if (ret)
  259. return IRQ_NONE;
  260. ret = regmap_bulk_read(rdev_map->regmap, RTQ2208_REG_GLOBAL_INT1,
  261. sts_flags, ARRAY_SIZE(sts_flags));
  262. if (ret)
  263. return IRQ_NONE;
  264. /* clear irq event */
  265. ret = regmap_bulk_write(rdev_map->regmap, RTQ2208_REG_FLT_RECORDBUCK_CB,
  266. buck_flags, ARRAY_SIZE(buck_flags));
  267. if (ret)
  268. return IRQ_NONE;
  269. ret = regmap_bulk_write(rdev_map->regmap, RTQ2208_REG_GLOBAL_INT1,
  270. sts_flags, ARRAY_SIZE(sts_flags));
  271. if (ret)
  272. return IRQ_NONE;
  273. for (i = 0; i < RTQ2208_LDO_MAX; i++) {
  274. if (!rdev_map->rdev[i])
  275. continue;
  276. rdev = rdev_map->rdev[i];
  277. /* uv irq */
  278. uv_bit = (i & 1) ? 4 : 0;
  279. if (buck_flags[i >> 1] & (1 << uv_bit))
  280. regulator_notifier_call_chain(rdev,
  281. REGULATOR_EVENT_UNDER_VOLTAGE, NULL);
  282. /* ov irq */
  283. ov_bit = uv_bit + 1;
  284. if (buck_flags[i >> 1] & (1 << ov_bit))
  285. regulator_notifier_call_chain(rdev,
  286. REGULATOR_EVENT_REGULATION_OUT, NULL);
  287. /* hd irq */
  288. if (sts_flags[1] & RTQ2208_HD_INT_MASK)
  289. regulator_notifier_call_chain(rdev,
  290. REGULATOR_EVENT_OVER_TEMP, NULL);
  291. }
  292. return IRQ_HANDLED;
  293. }
  294. static int rtq2208_of_get_ldo_dvs_ability(struct device *dev)
  295. {
  296. struct device_node *np;
  297. struct of_regulator_match *match;
  298. struct regulator_desc *desc;
  299. struct regulator_init_data *init_data;
  300. u32 fixed_uV;
  301. int ret, i;
  302. if (!dev->of_node)
  303. return -ENODEV;
  304. np = of_get_child_by_name(dev->of_node, "regulators");
  305. if (!np)
  306. np = dev->of_node;
  307. ret = of_regulator_match(dev, np, rtq2208_ldo_match, ARRAY_SIZE(rtq2208_ldo_match));
  308. of_node_put(np);
  309. if (ret < 0)
  310. return ret;
  311. for (i = 0; i < ARRAY_SIZE(rtq2208_ldo_match); i++) {
  312. match = rtq2208_ldo_match + i;
  313. init_data = match->init_data;
  314. desc = (struct regulator_desc *)match->desc;
  315. if (!init_data || !desc)
  316. continue;
  317. /* specify working fixed voltage if the propery exists */
  318. ret = of_property_read_u32(match->of_node, "richtek,fixed-microvolt", &fixed_uV);
  319. if (!ret) {
  320. if (fixed_uV != init_data->constraints.min_uV ||
  321. fixed_uV != init_data->constraints.max_uV)
  322. return -EINVAL;
  323. desc->n_voltages = 1;
  324. desc->fixed_uV = fixed_uV;
  325. desc->fixed_uV = init_data->constraints.min_uV;
  326. desc->ops = &rtq2208_regulator_ldo_fix_ops;
  327. } else {
  328. desc->n_voltages = ARRAY_SIZE(rtq2208_ldo_volt_table);
  329. desc->volt_table = rtq2208_ldo_volt_table;
  330. desc->ops = &rtq2208_regulator_ldo_adj_ops;
  331. }
  332. }
  333. return 0;
  334. }
  335. #define BUCK_INFO(_name, _id) \
  336. { \
  337. .name = _name, \
  338. .base = RTQ2208_REG_BUCK_##_id##_CFG0, \
  339. .enable_reg = BUCK_RG_SHIFT(RTQ2208_REG_BUCK_##_id##_CFG0, 2), \
  340. .dis_reg = RTQ2208_REG_BUCK_##_id##_CFG0, \
  341. }
  342. #define LDO_INFO(_name, _id) \
  343. { \
  344. .name = _name, \
  345. .base = RTQ2208_REG_LDO##_id##_CFG, \
  346. .enable_reg = RTQ2208_REG_LDO##_id##_CFG, \
  347. .dis_mask = RTQ2208_LDO##_id##_DISCHG_EN_MASK, \
  348. .dis_on = RTQ2208_LDO##_id##_DISCHG_EN_MASK, \
  349. .vsel_mask = RTQ2208_LDO##_id##_VOSEL_SD_MASK, \
  350. }
  351. #define BUCK_RG_SHIFT(_base, _shift) (_base + _shift)
  352. #define VSEL_SHIFT(_sel) (_sel ? 3 : 1)
  353. #define MTP_SEL_MASK(_sel) RTQ2208_BUCK_EN_NR_MTP_SEL##_sel##_MASK
  354. static const struct linear_range rtq2208_vout_range[] = {
  355. REGULATOR_LINEAR_RANGE(400000, 0, 180, 5000),
  356. REGULATOR_LINEAR_RANGE(1310000, 181, 255, 10000),
  357. };
  358. static void rtq2208_init_regulator_desc(struct rtq2208_regulator_desc *rdesc, int mtp_sel, int idx)
  359. {
  360. struct regulator_desc *desc;
  361. static const struct {
  362. char *name;
  363. int base;
  364. int enable_reg;
  365. int dis_reg;
  366. int dis_mask;
  367. int dis_on;
  368. int vsel_mask;
  369. } regulator_info[] = {
  370. BUCK_INFO("buck-b", B),
  371. BUCK_INFO("buck-c", C),
  372. BUCK_INFO("buck-d", D),
  373. BUCK_INFO("buck-a", A),
  374. BUCK_INFO("buck-f", F),
  375. BUCK_INFO("buck-g", G),
  376. BUCK_INFO("buck-h", H),
  377. BUCK_INFO("buck-e", E),
  378. LDO_INFO("ldo2", 2),
  379. LDO_INFO("ldo1", 1),
  380. }, *curr_info;
  381. curr_info = regulator_info + idx;
  382. desc = &rdesc->desc;
  383. desc->name = curr_info->name;
  384. desc->of_match = of_match_ptr(curr_info->name);
  385. desc->regulators_node = of_match_ptr("regulators");
  386. desc->id = idx;
  387. desc->owner = THIS_MODULE;
  388. desc->type = REGULATOR_VOLTAGE;
  389. desc->enable_mask = mtp_sel ? MTP_SEL_MASK(1) : MTP_SEL_MASK(0);
  390. desc->enable_reg = curr_info->enable_reg;
  391. desc->active_discharge_off = 0;
  392. rdesc->mode_mask = RTQ2208_BUCK_NRMODE_MASK;
  393. if (idx >= RTQ2208_BUCK_B && idx <= RTQ2208_BUCK_E) {
  394. /* init buck desc */
  395. desc->ops = &rtq2208_regulator_buck_ops;
  396. desc->vsel_reg = curr_info->base + VSEL_SHIFT(mtp_sel);
  397. desc->vsel_mask = RTQ2208_BUCK_NR_MTP_SEL_MASK;
  398. desc->n_voltages = RTQ2208_VOUT_MAXNUM;
  399. desc->linear_ranges = rtq2208_vout_range;
  400. desc->n_linear_ranges = ARRAY_SIZE(rtq2208_vout_range);
  401. desc->ramp_reg = BUCK_RG_SHIFT(curr_info->base, 5);
  402. desc->of_map_mode = rtq2208_of_map_mode;
  403. desc->active_discharge_reg = curr_info->dis_reg;
  404. desc->active_discharge_on = RTQ2208_EN_DIS_MASK;
  405. desc->active_discharge_mask = RTQ2208_EN_DIS_MASK;
  406. rdesc->mode_reg = BUCK_RG_SHIFT(curr_info->base, 2);
  407. rdesc->suspend_config_reg = BUCK_RG_SHIFT(curr_info->base, 4);
  408. rdesc->suspend_enable_mask = RTQ2208_BUCK_EN_STR_MASK;
  409. rdesc->suspend_mode_mask = RTQ2208_BUCK_STRMODE_MASK;
  410. } else {
  411. /* init ldo desc */
  412. desc->active_discharge_reg = RTQ2208_REG_LDO_DVS_CTRL;
  413. desc->active_discharge_on = curr_info->dis_on;
  414. desc->active_discharge_mask = curr_info->dis_mask;
  415. desc->vsel_reg = RTQ2208_REG_LDO_DVS_CTRL;
  416. desc->vsel_mask = curr_info->vsel_mask;
  417. rdesc->suspend_config_reg = curr_info->base;
  418. rdesc->suspend_enable_mask = RTQ2208_LDO_EN_STR_MASK;
  419. }
  420. }
  421. static int rtq2208_parse_regulator_dt_data(int n_regulator, const unsigned int *regulator_idx_table,
  422. struct rtq2208_regulator_desc *rdesc[RTQ2208_LDO_MAX], struct device *dev)
  423. {
  424. int mtp_sel, i, idx, ret;
  425. /* get mtp_sel0 or mtp_sel1 */
  426. mtp_sel = device_property_read_bool(dev, "richtek,mtp-sel-high");
  427. for (i = 0; i < n_regulator; i++) {
  428. idx = regulator_idx_table[i];
  429. rdesc[i] = devm_kcalloc(dev, 1, sizeof(*rdesc[0]), GFP_KERNEL);
  430. if (!rdesc[i])
  431. return -ENOMEM;
  432. rtq2208_init_regulator_desc(rdesc[i], mtp_sel, idx);
  433. /* init ldo dvs ability */
  434. if (idx >= RTQ2208_LDO2)
  435. rtq2208_ldo_match[idx - RTQ2208_LDO2].desc = &rdesc[i]->desc;
  436. }
  437. /* init ldo fixed_uV */
  438. ret = rtq2208_of_get_ldo_dvs_ability(dev);
  439. if (ret)
  440. return dev_err_probe(dev, ret, "Failed to get ldo fixed_uV\n");
  441. return 0;
  442. }
  443. /** different slave address corresponds different used bucks
  444. * slave address 0x10: BUCK[BCA FGE]
  445. * slave address 0x20: BUCK[BC FGHE]
  446. * slave address 0x40: BUCK[C G]
  447. */
  448. static int rtq2208_regulator_check(int slave_addr, int *num,
  449. int *regulator_idx_table, unsigned int *buck_masks)
  450. {
  451. static bool rtq2208_used_table[3][RTQ2208_LDO_MAX] = {
  452. /* BUCK[BCA FGE], LDO[12] */
  453. {1, 1, 0, 1, 1, 1, 0, 1, 1, 1},
  454. /* BUCK[BC FGHE], LDO[12]*/
  455. {1, 1, 0, 0, 1, 1, 1, 1, 1, 1},
  456. /* BUCK[C G], LDO[12] */
  457. {0, 1, 0, 0, 0, 1, 0, 0, 1, 1},
  458. };
  459. int i, idx = ffs(slave_addr >> 4) - 1;
  460. u8 mask;
  461. for (i = 0; i < RTQ2208_LDO_MAX; i++) {
  462. if (!rtq2208_used_table[idx][i])
  463. continue;
  464. regulator_idx_table[(*num)++] = i;
  465. mask = RTQ2208_BUCK_MASK(4 * i, 4 * i + 1);
  466. buck_masks[i >> 1] &= ~mask;
  467. }
  468. return 0;
  469. }
  470. static const struct regmap_config rtq2208_regmap_config = {
  471. .reg_bits = 8,
  472. .val_bits = 8,
  473. .max_register = 0xEF,
  474. };
  475. static int rtq2208_probe(struct i2c_client *i2c)
  476. {
  477. struct device *dev = &i2c->dev;
  478. struct regmap *regmap;
  479. struct rtq2208_regulator_desc *rdesc[RTQ2208_LDO_MAX];
  480. struct regulator_dev *rdev;
  481. struct regulator_config cfg = {};
  482. struct rtq2208_rdev_map *rdev_map;
  483. int i, ret = 0, idx, n_regulator = 0;
  484. unsigned int regulator_idx_table[RTQ2208_LDO_MAX],
  485. buck_masks[RTQ2208_BUCK_NUM_IRQ_REGS] = {0x33, 0x33, 0x33, 0x33, 0x33};
  486. rdev_map = devm_kzalloc(dev, sizeof(struct rtq2208_rdev_map), GFP_KERNEL);
  487. if (!rdev_map)
  488. return -ENOMEM;
  489. regmap = devm_regmap_init_i2c(i2c, &rtq2208_regmap_config);
  490. if (IS_ERR(regmap))
  491. return dev_err_probe(dev, PTR_ERR(regmap), "Failed to allocate regmap\n");
  492. /* get needed regulator */
  493. ret = rtq2208_regulator_check(i2c->addr, &n_regulator, regulator_idx_table, buck_masks);
  494. if (ret)
  495. return dev_err_probe(dev, ret, "Failed to check used regulators\n");
  496. rdev_map->regmap = regmap;
  497. rdev_map->dev = dev;
  498. cfg.dev = dev;
  499. /* init regulator desc */
  500. ret = rtq2208_parse_regulator_dt_data(n_regulator, regulator_idx_table, rdesc, dev);
  501. if (ret)
  502. return ret;
  503. for (i = 0; i < n_regulator; i++) {
  504. idx = regulator_idx_table[i];
  505. /* register regulator */
  506. rdev = devm_regulator_register(dev, &rdesc[i]->desc, &cfg);
  507. if (IS_ERR(rdev))
  508. return PTR_ERR(rdev);
  509. rdev_map->rdev[idx] = rdev;
  510. }
  511. /* init interrupt mask */
  512. ret = rtq2208_init_irq_mask(rdev_map, buck_masks);
  513. if (ret)
  514. return ret;
  515. /* register interrupt */
  516. return devm_request_threaded_irq(dev, i2c->irq, NULL, rtq2208_irq_handler,
  517. IRQF_ONESHOT, dev_name(dev), rdev_map);
  518. }
  519. static const struct of_device_id rtq2208_device_tables[] = {
  520. { .compatible = "richtek,rtq2208" },
  521. {}
  522. };
  523. MODULE_DEVICE_TABLE(of, rtq2208_device_tables);
  524. static struct i2c_driver rtq2208_driver = {
  525. .driver = {
  526. .name = "rtq2208",
  527. .of_match_table = rtq2208_device_tables,
  528. },
  529. .probe = rtq2208_probe,
  530. };
  531. module_i2c_driver(rtq2208_driver);
  532. MODULE_AUTHOR("Alina Yu <alina_yu@richtek.com>");
  533. MODULE_DESCRIPTION("Richtek RTQ2208 Regulator Driver");
  534. MODULE_LICENSE("GPL");