phy-qcom-ufs.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745
  1. /*
  2. * Copyright (c) 2013-2015, Linux Foundation. All rights reserved.
  3. *
  4. * This program is free software; you can redistribute it and/or modify
  5. * it under the terms of the GNU General Public License version 2 and
  6. * only version 2 as published by the Free Software Foundation.
  7. *
  8. * This program is distributed in the hope that it will be useful,
  9. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  11. * GNU General Public License for more details.
  12. *
  13. */
  14. #include "phy-qcom-ufs-i.h"
  15. #define MAX_PROP_NAME 32
  16. #define VDDA_PHY_MIN_UV 1000000
  17. #define VDDA_PHY_MAX_UV 1000000
  18. #define VDDA_PLL_MIN_UV 1800000
  19. #define VDDA_PLL_MAX_UV 1800000
  20. #define VDDP_REF_CLK_MIN_UV 1200000
  21. #define VDDP_REF_CLK_MAX_UV 1200000
  22. static int __ufs_qcom_phy_init_vreg(struct phy *, struct ufs_qcom_phy_vreg *,
  23. const char *, bool);
  24. static int ufs_qcom_phy_init_vreg(struct phy *, struct ufs_qcom_phy_vreg *,
  25. const char *);
  26. static int ufs_qcom_phy_base_init(struct platform_device *pdev,
  27. struct ufs_qcom_phy *phy_common);
  28. int ufs_qcom_phy_calibrate(struct ufs_qcom_phy *ufs_qcom_phy,
  29. struct ufs_qcom_phy_calibration *tbl_A,
  30. int tbl_size_A,
  31. struct ufs_qcom_phy_calibration *tbl_B,
  32. int tbl_size_B, bool is_rate_B)
  33. {
  34. int i;
  35. int ret = 0;
  36. if (!tbl_A) {
  37. dev_err(ufs_qcom_phy->dev, "%s: tbl_A is NULL", __func__);
  38. ret = EINVAL;
  39. goto out;
  40. }
  41. for (i = 0; i < tbl_size_A; i++)
  42. writel_relaxed(tbl_A[i].cfg_value,
  43. ufs_qcom_phy->mmio + tbl_A[i].reg_offset);
  44. /*
  45. * In case we would like to work in rate B, we need
  46. * to override a registers that were configured in rate A table
  47. * with registers of rate B table.
  48. * table.
  49. */
  50. if (is_rate_B) {
  51. if (!tbl_B) {
  52. dev_err(ufs_qcom_phy->dev, "%s: tbl_B is NULL",
  53. __func__);
  54. ret = EINVAL;
  55. goto out;
  56. }
  57. for (i = 0; i < tbl_size_B; i++)
  58. writel_relaxed(tbl_B[i].cfg_value,
  59. ufs_qcom_phy->mmio + tbl_B[i].reg_offset);
  60. }
  61. /* flush buffered writes */
  62. mb();
  63. out:
  64. return ret;
  65. }
  66. struct phy *ufs_qcom_phy_generic_probe(struct platform_device *pdev,
  67. struct ufs_qcom_phy *common_cfg,
  68. struct phy_ops *ufs_qcom_phy_gen_ops,
  69. struct ufs_qcom_phy_specific_ops *phy_spec_ops)
  70. {
  71. int err;
  72. struct device *dev = &pdev->dev;
  73. struct phy *generic_phy = NULL;
  74. struct phy_provider *phy_provider;
  75. err = ufs_qcom_phy_base_init(pdev, common_cfg);
  76. if (err) {
  77. dev_err(dev, "%s: phy base init failed %d\n", __func__, err);
  78. goto out;
  79. }
  80. phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
  81. if (IS_ERR(phy_provider)) {
  82. err = PTR_ERR(phy_provider);
  83. dev_err(dev, "%s: failed to register phy %d\n", __func__, err);
  84. goto out;
  85. }
  86. generic_phy = devm_phy_create(dev, NULL, ufs_qcom_phy_gen_ops);
  87. if (IS_ERR(generic_phy)) {
  88. err = PTR_ERR(generic_phy);
  89. dev_err(dev, "%s: failed to create phy %d\n", __func__, err);
  90. goto out;
  91. }
  92. common_cfg->phy_spec_ops = phy_spec_ops;
  93. common_cfg->dev = dev;
  94. out:
  95. return generic_phy;
  96. }
  97. /*
  98. * This assumes the embedded phy structure inside generic_phy is of type
  99. * struct ufs_qcom_phy. In order to function properly it's crucial
  100. * to keep the embedded struct "struct ufs_qcom_phy common_cfg"
  101. * as the first inside generic_phy.
  102. */
  103. struct ufs_qcom_phy *get_ufs_qcom_phy(struct phy *generic_phy)
  104. {
  105. return (struct ufs_qcom_phy *)phy_get_drvdata(generic_phy);
  106. }
  107. static
  108. int ufs_qcom_phy_base_init(struct platform_device *pdev,
  109. struct ufs_qcom_phy *phy_common)
  110. {
  111. struct device *dev = &pdev->dev;
  112. struct resource *res;
  113. int err = 0;
  114. res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "phy_mem");
  115. if (!res) {
  116. dev_err(dev, "%s: phy_mem resource not found\n", __func__);
  117. err = -ENOMEM;
  118. goto out;
  119. }
  120. phy_common->mmio = devm_ioremap_resource(dev, res);
  121. if (IS_ERR((void const *)phy_common->mmio)) {
  122. err = PTR_ERR((void const *)phy_common->mmio);
  123. phy_common->mmio = NULL;
  124. dev_err(dev, "%s: ioremap for phy_mem resource failed %d\n",
  125. __func__, err);
  126. goto out;
  127. }
  128. /* "dev_ref_clk_ctrl_mem" is optional resource */
  129. res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
  130. "dev_ref_clk_ctrl_mem");
  131. if (!res) {
  132. dev_dbg(dev, "%s: dev_ref_clk_ctrl_mem resource not found\n",
  133. __func__);
  134. goto out;
  135. }
  136. phy_common->dev_ref_clk_ctrl_mmio = devm_ioremap_resource(dev, res);
  137. if (IS_ERR((void const *)phy_common->dev_ref_clk_ctrl_mmio)) {
  138. err = PTR_ERR((void const *)phy_common->dev_ref_clk_ctrl_mmio);
  139. phy_common->dev_ref_clk_ctrl_mmio = NULL;
  140. dev_err(dev, "%s: ioremap for dev_ref_clk_ctrl_mem resource failed %d\n",
  141. __func__, err);
  142. }
  143. out:
  144. return err;
  145. }
  146. static int __ufs_qcom_phy_clk_get(struct phy *phy,
  147. const char *name, struct clk **clk_out, bool err_print)
  148. {
  149. struct clk *clk;
  150. int err = 0;
  151. struct ufs_qcom_phy *ufs_qcom_phy = get_ufs_qcom_phy(phy);
  152. struct device *dev = ufs_qcom_phy->dev;
  153. clk = devm_clk_get(dev, name);
  154. if (IS_ERR(clk)) {
  155. err = PTR_ERR(clk);
  156. if (err_print)
  157. dev_err(dev, "failed to get %s err %d", name, err);
  158. } else {
  159. *clk_out = clk;
  160. }
  161. return err;
  162. }
  163. static
  164. int ufs_qcom_phy_clk_get(struct phy *phy,
  165. const char *name, struct clk **clk_out)
  166. {
  167. return __ufs_qcom_phy_clk_get(phy, name, clk_out, true);
  168. }
  169. int
  170. ufs_qcom_phy_init_clks(struct phy *generic_phy,
  171. struct ufs_qcom_phy *phy_common)
  172. {
  173. int err;
  174. err = ufs_qcom_phy_clk_get(generic_phy, "tx_iface_clk",
  175. &phy_common->tx_iface_clk);
  176. if (err)
  177. goto out;
  178. err = ufs_qcom_phy_clk_get(generic_phy, "rx_iface_clk",
  179. &phy_common->rx_iface_clk);
  180. if (err)
  181. goto out;
  182. err = ufs_qcom_phy_clk_get(generic_phy, "ref_clk_src",
  183. &phy_common->ref_clk_src);
  184. if (err)
  185. goto out;
  186. /*
  187. * "ref_clk_parent" is optional hence don't abort init if it's not
  188. * found.
  189. */
  190. __ufs_qcom_phy_clk_get(generic_phy, "ref_clk_parent",
  191. &phy_common->ref_clk_parent, false);
  192. err = ufs_qcom_phy_clk_get(generic_phy, "ref_clk",
  193. &phy_common->ref_clk);
  194. out:
  195. return err;
  196. }
  197. int
  198. ufs_qcom_phy_init_vregulators(struct phy *generic_phy,
  199. struct ufs_qcom_phy *phy_common)
  200. {
  201. int err;
  202. err = ufs_qcom_phy_init_vreg(generic_phy, &phy_common->vdda_pll,
  203. "vdda-pll");
  204. if (err)
  205. goto out;
  206. err = ufs_qcom_phy_init_vreg(generic_phy, &phy_common->vdda_phy,
  207. "vdda-phy");
  208. if (err)
  209. goto out;
  210. /* vddp-ref-clk-* properties are optional */
  211. __ufs_qcom_phy_init_vreg(generic_phy, &phy_common->vddp_ref_clk,
  212. "vddp-ref-clk", true);
  213. out:
  214. return err;
  215. }
  216. static int __ufs_qcom_phy_init_vreg(struct phy *phy,
  217. struct ufs_qcom_phy_vreg *vreg, const char *name, bool optional)
  218. {
  219. int err = 0;
  220. struct ufs_qcom_phy *ufs_qcom_phy = get_ufs_qcom_phy(phy);
  221. struct device *dev = ufs_qcom_phy->dev;
  222. char prop_name[MAX_PROP_NAME];
  223. vreg->name = kstrdup(name, GFP_KERNEL);
  224. if (!vreg->name) {
  225. err = -ENOMEM;
  226. goto out;
  227. }
  228. vreg->reg = devm_regulator_get(dev, name);
  229. if (IS_ERR(vreg->reg)) {
  230. err = PTR_ERR(vreg->reg);
  231. vreg->reg = NULL;
  232. if (!optional)
  233. dev_err(dev, "failed to get %s, %d\n", name, err);
  234. goto out;
  235. }
  236. if (dev->of_node) {
  237. snprintf(prop_name, MAX_PROP_NAME, "%s-max-microamp", name);
  238. err = of_property_read_u32(dev->of_node,
  239. prop_name, &vreg->max_uA);
  240. if (err && err != -EINVAL) {
  241. dev_err(dev, "%s: failed to read %s\n",
  242. __func__, prop_name);
  243. goto out;
  244. } else if (err == -EINVAL || !vreg->max_uA) {
  245. if (regulator_count_voltages(vreg->reg) > 0) {
  246. dev_err(dev, "%s: %s is mandatory\n",
  247. __func__, prop_name);
  248. goto out;
  249. }
  250. err = 0;
  251. }
  252. snprintf(prop_name, MAX_PROP_NAME, "%s-always-on", name);
  253. if (of_get_property(dev->of_node, prop_name, NULL))
  254. vreg->is_always_on = true;
  255. else
  256. vreg->is_always_on = false;
  257. }
  258. if (!strcmp(name, "vdda-pll")) {
  259. vreg->max_uV = VDDA_PLL_MAX_UV;
  260. vreg->min_uV = VDDA_PLL_MIN_UV;
  261. } else if (!strcmp(name, "vdda-phy")) {
  262. vreg->max_uV = VDDA_PHY_MAX_UV;
  263. vreg->min_uV = VDDA_PHY_MIN_UV;
  264. } else if (!strcmp(name, "vddp-ref-clk")) {
  265. vreg->max_uV = VDDP_REF_CLK_MAX_UV;
  266. vreg->min_uV = VDDP_REF_CLK_MIN_UV;
  267. }
  268. out:
  269. if (err)
  270. kfree(vreg->name);
  271. return err;
  272. }
  273. static int ufs_qcom_phy_init_vreg(struct phy *phy,
  274. struct ufs_qcom_phy_vreg *vreg, const char *name)
  275. {
  276. return __ufs_qcom_phy_init_vreg(phy, vreg, name, false);
  277. }
  278. static
  279. int ufs_qcom_phy_cfg_vreg(struct phy *phy,
  280. struct ufs_qcom_phy_vreg *vreg, bool on)
  281. {
  282. int ret = 0;
  283. struct regulator *reg = vreg->reg;
  284. const char *name = vreg->name;
  285. int min_uV;
  286. int uA_load;
  287. struct ufs_qcom_phy *ufs_qcom_phy = get_ufs_qcom_phy(phy);
  288. struct device *dev = ufs_qcom_phy->dev;
  289. BUG_ON(!vreg);
  290. if (regulator_count_voltages(reg) > 0) {
  291. min_uV = on ? vreg->min_uV : 0;
  292. ret = regulator_set_voltage(reg, min_uV, vreg->max_uV);
  293. if (ret) {
  294. dev_err(dev, "%s: %s set voltage failed, err=%d\n",
  295. __func__, name, ret);
  296. goto out;
  297. }
  298. uA_load = on ? vreg->max_uA : 0;
  299. ret = regulator_set_optimum_mode(reg, uA_load);
  300. if (ret >= 0) {
  301. /*
  302. * regulator_set_optimum_mode() returns new regulator
  303. * mode upon success.
  304. */
  305. ret = 0;
  306. } else {
  307. dev_err(dev, "%s: %s set optimum mode(uA_load=%d) failed, err=%d\n",
  308. __func__, name, uA_load, ret);
  309. goto out;
  310. }
  311. }
  312. out:
  313. return ret;
  314. }
  315. static
  316. int ufs_qcom_phy_enable_vreg(struct phy *phy,
  317. struct ufs_qcom_phy_vreg *vreg)
  318. {
  319. struct ufs_qcom_phy *ufs_qcom_phy = get_ufs_qcom_phy(phy);
  320. struct device *dev = ufs_qcom_phy->dev;
  321. int ret = 0;
  322. if (!vreg || vreg->enabled)
  323. goto out;
  324. ret = ufs_qcom_phy_cfg_vreg(phy, vreg, true);
  325. if (ret) {
  326. dev_err(dev, "%s: ufs_qcom_phy_cfg_vreg() failed, err=%d\n",
  327. __func__, ret);
  328. goto out;
  329. }
  330. ret = regulator_enable(vreg->reg);
  331. if (ret) {
  332. dev_err(dev, "%s: enable failed, err=%d\n",
  333. __func__, ret);
  334. goto out;
  335. }
  336. vreg->enabled = true;
  337. out:
  338. return ret;
  339. }
  340. int ufs_qcom_phy_enable_ref_clk(struct phy *generic_phy)
  341. {
  342. int ret = 0;
  343. struct ufs_qcom_phy *phy = get_ufs_qcom_phy(generic_phy);
  344. if (phy->is_ref_clk_enabled)
  345. goto out;
  346. /*
  347. * reference clock is propagated in a daisy-chained manner from
  348. * source to phy, so ungate them at each stage.
  349. */
  350. ret = clk_prepare_enable(phy->ref_clk_src);
  351. if (ret) {
  352. dev_err(phy->dev, "%s: ref_clk_src enable failed %d\n",
  353. __func__, ret);
  354. goto out;
  355. }
  356. /*
  357. * "ref_clk_parent" is optional clock hence make sure that clk reference
  358. * is available before trying to enable the clock.
  359. */
  360. if (phy->ref_clk_parent) {
  361. ret = clk_prepare_enable(phy->ref_clk_parent);
  362. if (ret) {
  363. dev_err(phy->dev, "%s: ref_clk_parent enable failed %d\n",
  364. __func__, ret);
  365. goto out_disable_src;
  366. }
  367. }
  368. ret = clk_prepare_enable(phy->ref_clk);
  369. if (ret) {
  370. dev_err(phy->dev, "%s: ref_clk enable failed %d\n",
  371. __func__, ret);
  372. goto out_disable_parent;
  373. }
  374. phy->is_ref_clk_enabled = true;
  375. goto out;
  376. out_disable_parent:
  377. if (phy->ref_clk_parent)
  378. clk_disable_unprepare(phy->ref_clk_parent);
  379. out_disable_src:
  380. clk_disable_unprepare(phy->ref_clk_src);
  381. out:
  382. return ret;
  383. }
  384. static
  385. int ufs_qcom_phy_disable_vreg(struct phy *phy,
  386. struct ufs_qcom_phy_vreg *vreg)
  387. {
  388. struct ufs_qcom_phy *ufs_qcom_phy = get_ufs_qcom_phy(phy);
  389. struct device *dev = ufs_qcom_phy->dev;
  390. int ret = 0;
  391. if (!vreg || !vreg->enabled || vreg->is_always_on)
  392. goto out;
  393. ret = regulator_disable(vreg->reg);
  394. if (!ret) {
  395. /* ignore errors on applying disable config */
  396. ufs_qcom_phy_cfg_vreg(phy, vreg, false);
  397. vreg->enabled = false;
  398. } else {
  399. dev_err(dev, "%s: %s disable failed, err=%d\n",
  400. __func__, vreg->name, ret);
  401. }
  402. out:
  403. return ret;
  404. }
  405. void ufs_qcom_phy_disable_ref_clk(struct phy *generic_phy)
  406. {
  407. struct ufs_qcom_phy *phy = get_ufs_qcom_phy(generic_phy);
  408. if (phy->is_ref_clk_enabled) {
  409. clk_disable_unprepare(phy->ref_clk);
  410. /*
  411. * "ref_clk_parent" is optional clock hence make sure that clk
  412. * reference is available before trying to disable the clock.
  413. */
  414. if (phy->ref_clk_parent)
  415. clk_disable_unprepare(phy->ref_clk_parent);
  416. clk_disable_unprepare(phy->ref_clk_src);
  417. phy->is_ref_clk_enabled = false;
  418. }
  419. }
  420. #define UFS_REF_CLK_EN (1 << 5)
  421. static void ufs_qcom_phy_dev_ref_clk_ctrl(struct phy *generic_phy, bool enable)
  422. {
  423. struct ufs_qcom_phy *phy = get_ufs_qcom_phy(generic_phy);
  424. if (phy->dev_ref_clk_ctrl_mmio &&
  425. (enable ^ phy->is_dev_ref_clk_enabled)) {
  426. u32 temp = readl_relaxed(phy->dev_ref_clk_ctrl_mmio);
  427. if (enable)
  428. temp |= UFS_REF_CLK_EN;
  429. else
  430. temp &= ~UFS_REF_CLK_EN;
  431. /*
  432. * If we are here to disable this clock immediately after
  433. * entering into hibern8, we need to make sure that device
  434. * ref_clk is active atleast 1us after the hibern8 enter.
  435. */
  436. if (!enable)
  437. udelay(1);
  438. writel_relaxed(temp, phy->dev_ref_clk_ctrl_mmio);
  439. /* ensure that ref_clk is enabled/disabled before we return */
  440. wmb();
  441. /*
  442. * If we call hibern8 exit after this, we need to make sure that
  443. * device ref_clk is stable for atleast 1us before the hibern8
  444. * exit command.
  445. */
  446. if (enable)
  447. udelay(1);
  448. phy->is_dev_ref_clk_enabled = enable;
  449. }
  450. }
  451. void ufs_qcom_phy_enable_dev_ref_clk(struct phy *generic_phy)
  452. {
  453. ufs_qcom_phy_dev_ref_clk_ctrl(generic_phy, true);
  454. }
  455. void ufs_qcom_phy_disable_dev_ref_clk(struct phy *generic_phy)
  456. {
  457. ufs_qcom_phy_dev_ref_clk_ctrl(generic_phy, false);
  458. }
  459. /* Turn ON M-PHY RMMI interface clocks */
  460. int ufs_qcom_phy_enable_iface_clk(struct phy *generic_phy)
  461. {
  462. struct ufs_qcom_phy *phy = get_ufs_qcom_phy(generic_phy);
  463. int ret = 0;
  464. if (phy->is_iface_clk_enabled)
  465. goto out;
  466. ret = clk_prepare_enable(phy->tx_iface_clk);
  467. if (ret) {
  468. dev_err(phy->dev, "%s: tx_iface_clk enable failed %d\n",
  469. __func__, ret);
  470. goto out;
  471. }
  472. ret = clk_prepare_enable(phy->rx_iface_clk);
  473. if (ret) {
  474. clk_disable_unprepare(phy->tx_iface_clk);
  475. dev_err(phy->dev, "%s: rx_iface_clk enable failed %d. disabling also tx_iface_clk\n",
  476. __func__, ret);
  477. goto out;
  478. }
  479. phy->is_iface_clk_enabled = true;
  480. out:
  481. return ret;
  482. }
  483. /* Turn OFF M-PHY RMMI interface clocks */
  484. void ufs_qcom_phy_disable_iface_clk(struct phy *generic_phy)
  485. {
  486. struct ufs_qcom_phy *phy = get_ufs_qcom_phy(generic_phy);
  487. if (phy->is_iface_clk_enabled) {
  488. clk_disable_unprepare(phy->tx_iface_clk);
  489. clk_disable_unprepare(phy->rx_iface_clk);
  490. phy->is_iface_clk_enabled = false;
  491. }
  492. }
  493. int ufs_qcom_phy_start_serdes(struct phy *generic_phy)
  494. {
  495. struct ufs_qcom_phy *ufs_qcom_phy = get_ufs_qcom_phy(generic_phy);
  496. int ret = 0;
  497. if (!ufs_qcom_phy->phy_spec_ops->start_serdes) {
  498. dev_err(ufs_qcom_phy->dev, "%s: start_serdes() callback is not supported\n",
  499. __func__);
  500. ret = -ENOTSUPP;
  501. } else {
  502. ufs_qcom_phy->phy_spec_ops->start_serdes(ufs_qcom_phy);
  503. }
  504. return ret;
  505. }
  506. int ufs_qcom_phy_set_tx_lane_enable(struct phy *generic_phy, u32 tx_lanes)
  507. {
  508. struct ufs_qcom_phy *ufs_qcom_phy = get_ufs_qcom_phy(generic_phy);
  509. int ret = 0;
  510. if (!ufs_qcom_phy->phy_spec_ops->set_tx_lane_enable) {
  511. dev_err(ufs_qcom_phy->dev, "%s: set_tx_lane_enable() callback is not supported\n",
  512. __func__);
  513. ret = -ENOTSUPP;
  514. } else {
  515. ufs_qcom_phy->phy_spec_ops->set_tx_lane_enable(ufs_qcom_phy,
  516. tx_lanes);
  517. }
  518. return ret;
  519. }
  520. void ufs_qcom_phy_save_controller_version(struct phy *generic_phy,
  521. u8 major, u16 minor, u16 step)
  522. {
  523. struct ufs_qcom_phy *ufs_qcom_phy = get_ufs_qcom_phy(generic_phy);
  524. ufs_qcom_phy->host_ctrl_rev_major = major;
  525. ufs_qcom_phy->host_ctrl_rev_minor = minor;
  526. ufs_qcom_phy->host_ctrl_rev_step = step;
  527. }
  528. int ufs_qcom_phy_calibrate_phy(struct phy *generic_phy, bool is_rate_B)
  529. {
  530. struct ufs_qcom_phy *ufs_qcom_phy = get_ufs_qcom_phy(generic_phy);
  531. int ret = 0;
  532. if (!ufs_qcom_phy->phy_spec_ops->calibrate_phy) {
  533. dev_err(ufs_qcom_phy->dev, "%s: calibrate_phy() callback is not supported\n",
  534. __func__);
  535. ret = -ENOTSUPP;
  536. } else {
  537. ret = ufs_qcom_phy->phy_spec_ops->
  538. calibrate_phy(ufs_qcom_phy, is_rate_B);
  539. if (ret)
  540. dev_err(ufs_qcom_phy->dev, "%s: calibrate_phy() failed %d\n",
  541. __func__, ret);
  542. }
  543. return ret;
  544. }
  545. int ufs_qcom_phy_remove(struct phy *generic_phy,
  546. struct ufs_qcom_phy *ufs_qcom_phy)
  547. {
  548. phy_power_off(generic_phy);
  549. kfree(ufs_qcom_phy->vdda_pll.name);
  550. kfree(ufs_qcom_phy->vdda_phy.name);
  551. return 0;
  552. }
  553. int ufs_qcom_phy_exit(struct phy *generic_phy)
  554. {
  555. struct ufs_qcom_phy *ufs_qcom_phy = get_ufs_qcom_phy(generic_phy);
  556. if (ufs_qcom_phy->is_powered_on)
  557. phy_power_off(generic_phy);
  558. return 0;
  559. }
  560. int ufs_qcom_phy_is_pcs_ready(struct phy *generic_phy)
  561. {
  562. struct ufs_qcom_phy *ufs_qcom_phy = get_ufs_qcom_phy(generic_phy);
  563. if (!ufs_qcom_phy->phy_spec_ops->is_physical_coding_sublayer_ready) {
  564. dev_err(ufs_qcom_phy->dev, "%s: is_physical_coding_sublayer_ready() callback is not supported\n",
  565. __func__);
  566. return -ENOTSUPP;
  567. }
  568. return ufs_qcom_phy->phy_spec_ops->
  569. is_physical_coding_sublayer_ready(ufs_qcom_phy);
  570. }
  571. int ufs_qcom_phy_power_on(struct phy *generic_phy)
  572. {
  573. struct ufs_qcom_phy *phy_common = get_ufs_qcom_phy(generic_phy);
  574. struct device *dev = phy_common->dev;
  575. int err;
  576. err = ufs_qcom_phy_enable_vreg(generic_phy, &phy_common->vdda_phy);
  577. if (err) {
  578. dev_err(dev, "%s enable vdda_phy failed, err=%d\n",
  579. __func__, err);
  580. goto out;
  581. }
  582. phy_common->phy_spec_ops->power_control(phy_common, true);
  583. /* vdda_pll also enables ref clock LDOs so enable it first */
  584. err = ufs_qcom_phy_enable_vreg(generic_phy, &phy_common->vdda_pll);
  585. if (err) {
  586. dev_err(dev, "%s enable vdda_pll failed, err=%d\n",
  587. __func__, err);
  588. goto out_disable_phy;
  589. }
  590. err = ufs_qcom_phy_enable_ref_clk(generic_phy);
  591. if (err) {
  592. dev_err(dev, "%s enable phy ref clock failed, err=%d\n",
  593. __func__, err);
  594. goto out_disable_pll;
  595. }
  596. /* enable device PHY ref_clk pad rail */
  597. if (phy_common->vddp_ref_clk.reg) {
  598. err = ufs_qcom_phy_enable_vreg(generic_phy,
  599. &phy_common->vddp_ref_clk);
  600. if (err) {
  601. dev_err(dev, "%s enable vddp_ref_clk failed, err=%d\n",
  602. __func__, err);
  603. goto out_disable_ref_clk;
  604. }
  605. }
  606. phy_common->is_powered_on = true;
  607. goto out;
  608. out_disable_ref_clk:
  609. ufs_qcom_phy_disable_ref_clk(generic_phy);
  610. out_disable_pll:
  611. ufs_qcom_phy_disable_vreg(generic_phy, &phy_common->vdda_pll);
  612. out_disable_phy:
  613. ufs_qcom_phy_disable_vreg(generic_phy, &phy_common->vdda_phy);
  614. out:
  615. return err;
  616. }
  617. int ufs_qcom_phy_power_off(struct phy *generic_phy)
  618. {
  619. struct ufs_qcom_phy *phy_common = get_ufs_qcom_phy(generic_phy);
  620. phy_common->phy_spec_ops->power_control(phy_common, false);
  621. if (phy_common->vddp_ref_clk.reg)
  622. ufs_qcom_phy_disable_vreg(generic_phy,
  623. &phy_common->vddp_ref_clk);
  624. ufs_qcom_phy_disable_ref_clk(generic_phy);
  625. ufs_qcom_phy_disable_vreg(generic_phy, &phy_common->vdda_pll);
  626. ufs_qcom_phy_disable_vreg(generic_phy, &phy_common->vdda_phy);
  627. phy_common->is_powered_on = false;
  628. return 0;
  629. }