blob: c5c29fef4c56694011f8e757ab271a19c1cfdf63 [file] [log] [blame]
Yaniv Gardiadaafaa2015-01-15 16:32:35 +02001/*
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
Yaniv Gardiadaafaa2015-01-15 16:32:35 +020025int 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}
Axel Lin358d6c82015-03-23 11:54:50 +080069EXPORT_SYMBOL_GPL(ufs_qcom_phy_calibrate);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +020070
Yaniv Gardiadaafaa2015-01-15 16:32:35 +020071/*
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}
Axel Lin358d6c82015-03-23 11:54:50 +080081EXPORT_SYMBOL_GPL(get_ufs_qcom_phy);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +020082
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");
Yaniv Gardiadaafaa2015-01-15 16:32:35 +020092 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);
Axel Lin52ea7962015-03-23 12:08:18 +080098 return err;
Yaniv Gardiadaafaa2015-01-15 16:32:35 +020099 }
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");
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200104 phy_common->dev_ref_clk_ctrl_mmio = devm_ioremap_resource(dev, res);
Axel Lin52ea7962015-03-23 12:08:18 +0800105 if (IS_ERR((void const *)phy_common->dev_ref_clk_ctrl_mmio))
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200106 phy_common->dev_ref_clk_ctrl_mmio = NULL;
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200107
Axel Lin52ea7962015-03-23 12:08:18 +0800108 return 0;
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200109}
110
Vivek Gautam15887cb2016-11-08 15:37:46 +0530111struct 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
Vivek Gautam89bd2962016-11-08 15:37:42 +0530150static int __ufs_qcom_phy_clk_get(struct device *dev,
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200151 const char *name, struct clk **clk_out, bool err_print)
152{
153 struct clk *clk;
154 int err = 0;
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200155
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
Vivek Gautam89bd2962016-11-08 15:37:42 +0530168static int ufs_qcom_phy_clk_get(struct device *dev,
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200169 const char *name, struct clk **clk_out)
170{
Vivek Gautam89bd2962016-11-08 15:37:42 +0530171 return __ufs_qcom_phy_clk_get(dev, name, clk_out, true);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200172}
173
Vivek Gautam89bd2962016-11-08 15:37:42 +0530174int ufs_qcom_phy_init_clks(struct ufs_qcom_phy *phy_common)
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200175{
176 int err;
177
Vivek Gautam300f9672016-11-08 15:37:44 +0530178 if (of_device_is_compatible(phy_common->dev->of_node,
179 "qcom,msm8996-ufs-phy-qmp-14nm"))
180 goto skip_txrx_clk;
181
Vivek Gautam89bd2962016-11-08 15:37:42 +0530182 err = ufs_qcom_phy_clk_get(phy_common->dev, "tx_iface_clk",
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200183 &phy_common->tx_iface_clk);
184 if (err)
185 goto out;
186
Vivek Gautam89bd2962016-11-08 15:37:42 +0530187 err = ufs_qcom_phy_clk_get(phy_common->dev, "rx_iface_clk",
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200188 &phy_common->rx_iface_clk);
189 if (err)
190 goto out;
191
Vivek Gautam89bd2962016-11-08 15:37:42 +0530192 err = ufs_qcom_phy_clk_get(phy_common->dev, "ref_clk_src",
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200193 &phy_common->ref_clk_src);
194 if (err)
195 goto out;
196
Vivek Gautam300f9672016-11-08 15:37:44 +0530197skip_txrx_clk:
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200198 /*
199 * "ref_clk_parent" is optional hence don't abort init if it's not
200 * found.
201 */
Vivek Gautam89bd2962016-11-08 15:37:42 +0530202 __ufs_qcom_phy_clk_get(phy_common->dev, "ref_clk_parent",
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200203 &phy_common->ref_clk_parent, false);
204
Vivek Gautam89bd2962016-11-08 15:37:42 +0530205 err = ufs_qcom_phy_clk_get(phy_common->dev, "ref_clk",
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200206 &phy_common->ref_clk);
207
208out:
209 return err;
210}
Axel Lin358d6c82015-03-23 11:54:50 +0800211EXPORT_SYMBOL_GPL(ufs_qcom_phy_init_clks);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200212
Vivek Gautam89bd2962016-11-08 15:37:42 +0530213static int __ufs_qcom_phy_init_vreg(struct device *dev,
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200214 struct ufs_qcom_phy_vreg *vreg, const char *name, bool optional)
215{
216 int err = 0;
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200217
218 char prop_name[MAX_PROP_NAME];
219
Vivek Gautamadd78fc2016-11-08 15:37:41 +0530220 vreg->name = devm_kstrdup(dev, name, GFP_KERNEL);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200221 if (!vreg->name) {
222 err = -ENOMEM;
223 goto out;
224 }
225
226 vreg->reg = devm_regulator_get(dev, name);
227 if (IS_ERR(vreg->reg)) {
228 err = PTR_ERR(vreg->reg);
229 vreg->reg = NULL;
230 if (!optional)
231 dev_err(dev, "failed to get %s, %d\n", name, err);
232 goto out;
233 }
234
235 if (dev->of_node) {
236 snprintf(prop_name, MAX_PROP_NAME, "%s-max-microamp", name);
237 err = of_property_read_u32(dev->of_node,
238 prop_name, &vreg->max_uA);
239 if (err && err != -EINVAL) {
240 dev_err(dev, "%s: failed to read %s\n",
241 __func__, prop_name);
242 goto out;
243 } else if (err == -EINVAL || !vreg->max_uA) {
244 if (regulator_count_voltages(vreg->reg) > 0) {
245 dev_err(dev, "%s: %s is mandatory\n",
246 __func__, prop_name);
247 goto out;
248 }
249 err = 0;
250 }
251 snprintf(prop_name, MAX_PROP_NAME, "%s-always-on", name);
Julia Lawall3ea981e2016-08-05 13:25:13 +0200252 vreg->is_always_on = of_property_read_bool(dev->of_node,
253 prop_name);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200254 }
255
256 if (!strcmp(name, "vdda-pll")) {
257 vreg->max_uV = VDDA_PLL_MAX_UV;
258 vreg->min_uV = VDDA_PLL_MIN_UV;
259 } else if (!strcmp(name, "vdda-phy")) {
260 vreg->max_uV = VDDA_PHY_MAX_UV;
261 vreg->min_uV = VDDA_PHY_MIN_UV;
262 } else if (!strcmp(name, "vddp-ref-clk")) {
263 vreg->max_uV = VDDP_REF_CLK_MAX_UV;
264 vreg->min_uV = VDDP_REF_CLK_MIN_UV;
265 }
266
267out:
268 if (err)
269 kfree(vreg->name);
270 return err;
271}
272
Vivek Gautam89bd2962016-11-08 15:37:42 +0530273static int ufs_qcom_phy_init_vreg(struct device *dev,
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200274 struct ufs_qcom_phy_vreg *vreg, const char *name)
275{
Vivek Gautam89bd2962016-11-08 15:37:42 +0530276 return __ufs_qcom_phy_init_vreg(dev, vreg, name, false);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200277}
278
Vivek Gautam15887cb2016-11-08 15:37:46 +0530279int ufs_qcom_phy_init_vregulators(struct ufs_qcom_phy *phy_common)
280{
281 int err;
282
283 err = ufs_qcom_phy_init_vreg(phy_common->dev, &phy_common->vdda_pll,
284 "vdda-pll");
285 if (err)
286 goto out;
287
288 err = ufs_qcom_phy_init_vreg(phy_common->dev, &phy_common->vdda_phy,
289 "vdda-phy");
290
291 if (err)
292 goto out;
293
294 /* vddp-ref-clk-* properties are optional */
295 __ufs_qcom_phy_init_vreg(phy_common->dev, &phy_common->vddp_ref_clk,
296 "vddp-ref-clk", true);
297out:
298 return err;
299}
300EXPORT_SYMBOL_GPL(ufs_qcom_phy_init_vregulators);
301
Vivek Gautam89bd2962016-11-08 15:37:42 +0530302static int ufs_qcom_phy_cfg_vreg(struct device *dev,
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200303 struct ufs_qcom_phy_vreg *vreg, bool on)
304{
305 int ret = 0;
306 struct regulator *reg = vreg->reg;
307 const char *name = vreg->name;
308 int min_uV;
309 int uA_load;
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200310
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200311 if (regulator_count_voltages(reg) > 0) {
312 min_uV = on ? vreg->min_uV : 0;
313 ret = regulator_set_voltage(reg, min_uV, vreg->max_uV);
314 if (ret) {
315 dev_err(dev, "%s: %s set voltage failed, err=%d\n",
316 __func__, name, ret);
317 goto out;
318 }
319 uA_load = on ? vreg->max_uA : 0;
Stephen Rothwell7e476c72015-03-10 13:44:41 +1100320 ret = regulator_set_load(reg, uA_load);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200321 if (ret >= 0) {
322 /*
Stephen Rothwell7e476c72015-03-10 13:44:41 +1100323 * regulator_set_load() returns new regulator
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200324 * mode upon success.
325 */
326 ret = 0;
327 } else {
328 dev_err(dev, "%s: %s set optimum mode(uA_load=%d) failed, err=%d\n",
329 __func__, name, uA_load, ret);
330 goto out;
331 }
332 }
333out:
334 return ret;
335}
336
Vivek Gautam89bd2962016-11-08 15:37:42 +0530337static int ufs_qcom_phy_enable_vreg(struct device *dev,
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200338 struct ufs_qcom_phy_vreg *vreg)
339{
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200340 int ret = 0;
341
342 if (!vreg || vreg->enabled)
343 goto out;
344
Vivek Gautam89bd2962016-11-08 15:37:42 +0530345 ret = ufs_qcom_phy_cfg_vreg(dev, vreg, true);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200346 if (ret) {
347 dev_err(dev, "%s: ufs_qcom_phy_cfg_vreg() failed, err=%d\n",
348 __func__, ret);
349 goto out;
350 }
351
352 ret = regulator_enable(vreg->reg);
353 if (ret) {
354 dev_err(dev, "%s: enable failed, err=%d\n",
355 __func__, ret);
356 goto out;
357 }
358
359 vreg->enabled = true;
360out:
361 return ret;
362}
363
364int ufs_qcom_phy_enable_ref_clk(struct phy *generic_phy)
365{
366 int ret = 0;
367 struct ufs_qcom_phy *phy = get_ufs_qcom_phy(generic_phy);
368
369 if (phy->is_ref_clk_enabled)
370 goto out;
371
372 /*
373 * reference clock is propagated in a daisy-chained manner from
374 * source to phy, so ungate them at each stage.
375 */
376 ret = clk_prepare_enable(phy->ref_clk_src);
377 if (ret) {
378 dev_err(phy->dev, "%s: ref_clk_src enable failed %d\n",
379 __func__, ret);
380 goto out;
381 }
382
383 /*
384 * "ref_clk_parent" is optional clock hence make sure that clk reference
385 * is available before trying to enable the clock.
386 */
387 if (phy->ref_clk_parent) {
388 ret = clk_prepare_enable(phy->ref_clk_parent);
389 if (ret) {
390 dev_err(phy->dev, "%s: ref_clk_parent enable failed %d\n",
391 __func__, ret);
392 goto out_disable_src;
393 }
394 }
395
396 ret = clk_prepare_enable(phy->ref_clk);
397 if (ret) {
398 dev_err(phy->dev, "%s: ref_clk enable failed %d\n",
399 __func__, ret);
400 goto out_disable_parent;
401 }
402
403 phy->is_ref_clk_enabled = true;
404 goto out;
405
406out_disable_parent:
407 if (phy->ref_clk_parent)
408 clk_disable_unprepare(phy->ref_clk_parent);
409out_disable_src:
410 clk_disable_unprepare(phy->ref_clk_src);
411out:
412 return ret;
413}
Yaniv Gardi65d49b32015-09-02 11:32:17 +0300414EXPORT_SYMBOL_GPL(ufs_qcom_phy_enable_ref_clk);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200415
Vivek Gautam89bd2962016-11-08 15:37:42 +0530416static int ufs_qcom_phy_disable_vreg(struct device *dev,
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200417 struct ufs_qcom_phy_vreg *vreg)
418{
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200419 int ret = 0;
420
421 if (!vreg || !vreg->enabled || vreg->is_always_on)
422 goto out;
423
424 ret = regulator_disable(vreg->reg);
425
426 if (!ret) {
427 /* ignore errors on applying disable config */
Vivek Gautam89bd2962016-11-08 15:37:42 +0530428 ufs_qcom_phy_cfg_vreg(dev, vreg, false);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200429 vreg->enabled = false;
430 } else {
431 dev_err(dev, "%s: %s disable failed, err=%d\n",
432 __func__, vreg->name, ret);
433 }
434out:
435 return ret;
436}
437
438void ufs_qcom_phy_disable_ref_clk(struct phy *generic_phy)
439{
440 struct ufs_qcom_phy *phy = get_ufs_qcom_phy(generic_phy);
441
442 if (phy->is_ref_clk_enabled) {
443 clk_disable_unprepare(phy->ref_clk);
444 /*
445 * "ref_clk_parent" is optional clock hence make sure that clk
446 * reference is available before trying to disable the clock.
447 */
448 if (phy->ref_clk_parent)
449 clk_disable_unprepare(phy->ref_clk_parent);
450 clk_disable_unprepare(phy->ref_clk_src);
451 phy->is_ref_clk_enabled = false;
452 }
453}
Yaniv Gardi65d49b32015-09-02 11:32:17 +0300454EXPORT_SYMBOL_GPL(ufs_qcom_phy_disable_ref_clk);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200455
456#define UFS_REF_CLK_EN (1 << 5)
457
458static void ufs_qcom_phy_dev_ref_clk_ctrl(struct phy *generic_phy, bool enable)
459{
460 struct ufs_qcom_phy *phy = get_ufs_qcom_phy(generic_phy);
461
462 if (phy->dev_ref_clk_ctrl_mmio &&
463 (enable ^ phy->is_dev_ref_clk_enabled)) {
464 u32 temp = readl_relaxed(phy->dev_ref_clk_ctrl_mmio);
465
466 if (enable)
467 temp |= UFS_REF_CLK_EN;
468 else
469 temp &= ~UFS_REF_CLK_EN;
470
471 /*
472 * If we are here to disable this clock immediately after
473 * entering into hibern8, we need to make sure that device
474 * ref_clk is active atleast 1us after the hibern8 enter.
475 */
476 if (!enable)
477 udelay(1);
478
479 writel_relaxed(temp, phy->dev_ref_clk_ctrl_mmio);
480 /* ensure that ref_clk is enabled/disabled before we return */
481 wmb();
482 /*
483 * If we call hibern8 exit after this, we need to make sure that
484 * device ref_clk is stable for atleast 1us before the hibern8
485 * exit command.
486 */
487 if (enable)
488 udelay(1);
489
490 phy->is_dev_ref_clk_enabled = enable;
491 }
492}
493
494void ufs_qcom_phy_enable_dev_ref_clk(struct phy *generic_phy)
495{
496 ufs_qcom_phy_dev_ref_clk_ctrl(generic_phy, true);
497}
Yaniv Gardi65d49b32015-09-02 11:32:17 +0300498EXPORT_SYMBOL_GPL(ufs_qcom_phy_enable_dev_ref_clk);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200499
500void ufs_qcom_phy_disable_dev_ref_clk(struct phy *generic_phy)
501{
502 ufs_qcom_phy_dev_ref_clk_ctrl(generic_phy, false);
503}
Yaniv Gardi65d49b32015-09-02 11:32:17 +0300504EXPORT_SYMBOL_GPL(ufs_qcom_phy_disable_dev_ref_clk);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200505
506/* Turn ON M-PHY RMMI interface clocks */
507int ufs_qcom_phy_enable_iface_clk(struct phy *generic_phy)
508{
509 struct ufs_qcom_phy *phy = get_ufs_qcom_phy(generic_phy);
510 int ret = 0;
511
512 if (phy->is_iface_clk_enabled)
513 goto out;
514
515 ret = clk_prepare_enable(phy->tx_iface_clk);
516 if (ret) {
517 dev_err(phy->dev, "%s: tx_iface_clk enable failed %d\n",
518 __func__, ret);
519 goto out;
520 }
521 ret = clk_prepare_enable(phy->rx_iface_clk);
522 if (ret) {
523 clk_disable_unprepare(phy->tx_iface_clk);
524 dev_err(phy->dev, "%s: rx_iface_clk enable failed %d. disabling also tx_iface_clk\n",
525 __func__, ret);
526 goto out;
527 }
528 phy->is_iface_clk_enabled = true;
529
530out:
531 return ret;
532}
Yaniv Gardi65d49b32015-09-02 11:32:17 +0300533EXPORT_SYMBOL_GPL(ufs_qcom_phy_enable_iface_clk);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200534
535/* Turn OFF M-PHY RMMI interface clocks */
536void ufs_qcom_phy_disable_iface_clk(struct phy *generic_phy)
537{
538 struct ufs_qcom_phy *phy = get_ufs_qcom_phy(generic_phy);
539
540 if (phy->is_iface_clk_enabled) {
541 clk_disable_unprepare(phy->tx_iface_clk);
542 clk_disable_unprepare(phy->rx_iface_clk);
543 phy->is_iface_clk_enabled = false;
544 }
545}
Yaniv Gardi65d49b32015-09-02 11:32:17 +0300546EXPORT_SYMBOL_GPL(ufs_qcom_phy_disable_iface_clk);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200547
548int ufs_qcom_phy_start_serdes(struct phy *generic_phy)
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->start_serdes) {
554 dev_err(ufs_qcom_phy->dev, "%s: start_serdes() callback is not supported\n",
555 __func__);
556 ret = -ENOTSUPP;
557 } else {
558 ufs_qcom_phy->phy_spec_ops->start_serdes(ufs_qcom_phy);
559 }
560
561 return ret;
562}
Yaniv Gardi65d49b32015-09-02 11:32:17 +0300563EXPORT_SYMBOL_GPL(ufs_qcom_phy_start_serdes);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200564
565int ufs_qcom_phy_set_tx_lane_enable(struct phy *generic_phy, u32 tx_lanes)
566{
567 struct ufs_qcom_phy *ufs_qcom_phy = get_ufs_qcom_phy(generic_phy);
568 int ret = 0;
569
570 if (!ufs_qcom_phy->phy_spec_ops->set_tx_lane_enable) {
571 dev_err(ufs_qcom_phy->dev, "%s: set_tx_lane_enable() callback is not supported\n",
572 __func__);
573 ret = -ENOTSUPP;
574 } else {
575 ufs_qcom_phy->phy_spec_ops->set_tx_lane_enable(ufs_qcom_phy,
576 tx_lanes);
577 }
578
579 return ret;
580}
Yaniv Gardi65d49b32015-09-02 11:32:17 +0300581EXPORT_SYMBOL_GPL(ufs_qcom_phy_set_tx_lane_enable);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200582
583void ufs_qcom_phy_save_controller_version(struct phy *generic_phy,
584 u8 major, u16 minor, u16 step)
585{
586 struct ufs_qcom_phy *ufs_qcom_phy = get_ufs_qcom_phy(generic_phy);
587
588 ufs_qcom_phy->host_ctrl_rev_major = major;
589 ufs_qcom_phy->host_ctrl_rev_minor = minor;
590 ufs_qcom_phy->host_ctrl_rev_step = step;
591}
Yaniv Gardi65d49b32015-09-02 11:32:17 +0300592EXPORT_SYMBOL_GPL(ufs_qcom_phy_save_controller_version);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200593
594int ufs_qcom_phy_calibrate_phy(struct phy *generic_phy, bool is_rate_B)
595{
596 struct ufs_qcom_phy *ufs_qcom_phy = get_ufs_qcom_phy(generic_phy);
597 int ret = 0;
598
599 if (!ufs_qcom_phy->phy_spec_ops->calibrate_phy) {
600 dev_err(ufs_qcom_phy->dev, "%s: calibrate_phy() callback is not supported\n",
601 __func__);
602 ret = -ENOTSUPP;
603 } else {
604 ret = ufs_qcom_phy->phy_spec_ops->
605 calibrate_phy(ufs_qcom_phy, is_rate_B);
606 if (ret)
607 dev_err(ufs_qcom_phy->dev, "%s: calibrate_phy() failed %d\n",
608 __func__, ret);
609 }
610
611 return ret;
612}
Yaniv Gardi65d49b32015-09-02 11:32:17 +0300613EXPORT_SYMBOL_GPL(ufs_qcom_phy_calibrate_phy);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200614
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200615int ufs_qcom_phy_exit(struct phy *generic_phy)
616{
617 struct ufs_qcom_phy *ufs_qcom_phy = get_ufs_qcom_phy(generic_phy);
618
619 if (ufs_qcom_phy->is_powered_on)
620 phy_power_off(generic_phy);
621
622 return 0;
623}
Axel Lin358d6c82015-03-23 11:54:50 +0800624EXPORT_SYMBOL_GPL(ufs_qcom_phy_exit);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200625
626int ufs_qcom_phy_is_pcs_ready(struct phy *generic_phy)
627{
628 struct ufs_qcom_phy *ufs_qcom_phy = get_ufs_qcom_phy(generic_phy);
629
630 if (!ufs_qcom_phy->phy_spec_ops->is_physical_coding_sublayer_ready) {
631 dev_err(ufs_qcom_phy->dev, "%s: is_physical_coding_sublayer_ready() callback is not supported\n",
632 __func__);
633 return -ENOTSUPP;
634 }
635
636 return ufs_qcom_phy->phy_spec_ops->
637 is_physical_coding_sublayer_ready(ufs_qcom_phy);
638}
Yaniv Gardi65d49b32015-09-02 11:32:17 +0300639EXPORT_SYMBOL_GPL(ufs_qcom_phy_is_pcs_ready);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200640
641int ufs_qcom_phy_power_on(struct phy *generic_phy)
642{
643 struct ufs_qcom_phy *phy_common = get_ufs_qcom_phy(generic_phy);
644 struct device *dev = phy_common->dev;
645 int err;
646
Vivek Gautam89bd2962016-11-08 15:37:42 +0530647 err = ufs_qcom_phy_enable_vreg(dev, &phy_common->vdda_phy);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200648 if (err) {
649 dev_err(dev, "%s enable vdda_phy failed, err=%d\n",
650 __func__, err);
651 goto out;
652 }
653
654 phy_common->phy_spec_ops->power_control(phy_common, true);
655
656 /* vdda_pll also enables ref clock LDOs so enable it first */
Vivek Gautam89bd2962016-11-08 15:37:42 +0530657 err = ufs_qcom_phy_enable_vreg(dev, &phy_common->vdda_pll);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200658 if (err) {
659 dev_err(dev, "%s enable vdda_pll failed, err=%d\n",
660 __func__, err);
661 goto out_disable_phy;
662 }
663
664 err = ufs_qcom_phy_enable_ref_clk(generic_phy);
665 if (err) {
666 dev_err(dev, "%s enable phy ref clock failed, err=%d\n",
667 __func__, err);
668 goto out_disable_pll;
669 }
670
671 /* enable device PHY ref_clk pad rail */
672 if (phy_common->vddp_ref_clk.reg) {
Vivek Gautam89bd2962016-11-08 15:37:42 +0530673 err = ufs_qcom_phy_enable_vreg(dev,
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200674 &phy_common->vddp_ref_clk);
675 if (err) {
676 dev_err(dev, "%s enable vddp_ref_clk failed, err=%d\n",
677 __func__, err);
678 goto out_disable_ref_clk;
679 }
680 }
681
682 phy_common->is_powered_on = true;
683 goto out;
684
685out_disable_ref_clk:
686 ufs_qcom_phy_disable_ref_clk(generic_phy);
687out_disable_pll:
Vivek Gautam89bd2962016-11-08 15:37:42 +0530688 ufs_qcom_phy_disable_vreg(dev, &phy_common->vdda_pll);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200689out_disable_phy:
Vivek Gautam89bd2962016-11-08 15:37:42 +0530690 ufs_qcom_phy_disable_vreg(dev, &phy_common->vdda_phy);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200691out:
692 return err;
693}
Axel Lin358d6c82015-03-23 11:54:50 +0800694EXPORT_SYMBOL_GPL(ufs_qcom_phy_power_on);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200695
696int ufs_qcom_phy_power_off(struct phy *generic_phy)
697{
698 struct ufs_qcom_phy *phy_common = get_ufs_qcom_phy(generic_phy);
699
700 phy_common->phy_spec_ops->power_control(phy_common, false);
701
702 if (phy_common->vddp_ref_clk.reg)
Vivek Gautam89bd2962016-11-08 15:37:42 +0530703 ufs_qcom_phy_disable_vreg(phy_common->dev,
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200704 &phy_common->vddp_ref_clk);
705 ufs_qcom_phy_disable_ref_clk(generic_phy);
706
Vivek Gautam89bd2962016-11-08 15:37:42 +0530707 ufs_qcom_phy_disable_vreg(phy_common->dev, &phy_common->vdda_pll);
708 ufs_qcom_phy_disable_vreg(phy_common->dev, &phy_common->vdda_phy);
Yaniv Gardiadaafaa2015-01-15 16:32:35 +0200709 phy_common->is_powered_on = false;
710
711 return 0;
712}
Axel Lin358d6c82015-03-23 11:54:50 +0800713EXPORT_SYMBOL_GPL(ufs_qcom_phy_power_off);