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