linux/drivers/phy/phy-samsung-usb2.c
<<
>>
Prefs
   1/*
   2 * Samsung SoC USB 1.1/2.0 PHY driver
   3 *
   4 * Copyright (C) 2013 Samsung Electronics Co., Ltd.
   5 * Author: Kamil Debski <k.debski@samsung.com>
   6 *
   7 * This program is free software; you can redistribute it and/or modify
   8 * it under the terms of the GNU General Public License version 2 as
   9 * published by the Free Software Foundation.
  10 */
  11
  12#include <linux/clk.h>
  13#include <linux/mfd/syscon.h>
  14#include <linux/module.h>
  15#include <linux/of.h>
  16#include <linux/of_address.h>
  17#include <linux/phy/phy.h>
  18#include <linux/platform_device.h>
  19#include <linux/spinlock.h>
  20#include "phy-samsung-usb2.h"
  21
  22static int samsung_usb2_phy_power_on(struct phy *phy)
  23{
  24        struct samsung_usb2_phy_instance *inst = phy_get_drvdata(phy);
  25        struct samsung_usb2_phy_driver *drv = inst->drv;
  26        int ret;
  27
  28        dev_dbg(drv->dev, "Request to power_on \"%s\" usb phy\n",
  29                inst->cfg->label);
  30        ret = clk_prepare_enable(drv->clk);
  31        if (ret)
  32                goto err_main_clk;
  33        ret = clk_prepare_enable(drv->ref_clk);
  34        if (ret)
  35                goto err_instance_clk;
  36        if (inst->cfg->power_on) {
  37                spin_lock(&drv->lock);
  38                ret = inst->cfg->power_on(inst);
  39                spin_unlock(&drv->lock);
  40        }
  41
  42        return 0;
  43
  44err_instance_clk:
  45        clk_disable_unprepare(drv->clk);
  46err_main_clk:
  47        return ret;
  48}
  49
  50static int samsung_usb2_phy_power_off(struct phy *phy)
  51{
  52        struct samsung_usb2_phy_instance *inst = phy_get_drvdata(phy);
  53        struct samsung_usb2_phy_driver *drv = inst->drv;
  54        int ret = 0;
  55
  56        dev_dbg(drv->dev, "Request to power_off \"%s\" usb phy\n",
  57                inst->cfg->label);
  58        if (inst->cfg->power_off) {
  59                spin_lock(&drv->lock);
  60                ret = inst->cfg->power_off(inst);
  61                spin_unlock(&drv->lock);
  62        }
  63        clk_disable_unprepare(drv->ref_clk);
  64        clk_disable_unprepare(drv->clk);
  65        return ret;
  66}
  67
  68static struct phy_ops samsung_usb2_phy_ops = {
  69        .power_on       = samsung_usb2_phy_power_on,
  70        .power_off      = samsung_usb2_phy_power_off,
  71        .owner          = THIS_MODULE,
  72};
  73
  74static struct phy *samsung_usb2_phy_xlate(struct device *dev,
  75                                        struct of_phandle_args *args)
  76{
  77        struct samsung_usb2_phy_driver *drv;
  78
  79        drv = dev_get_drvdata(dev);
  80        if (!drv)
  81                return ERR_PTR(-EINVAL);
  82
  83        if (WARN_ON(args->args[0] >= drv->cfg->num_phys))
  84                return ERR_PTR(-ENODEV);
  85
  86        return drv->instances[args->args[0]].phy;
  87}
  88
  89static const struct of_device_id samsung_usb2_phy_of_match[] = {
  90#ifdef CONFIG_PHY_EXYNOS4X12_USB2
  91        {
  92                .compatible = "samsung,exynos3250-usb2-phy",
  93                .data = &exynos3250_usb2_phy_config,
  94        },
  95#endif
  96#ifdef CONFIG_PHY_EXYNOS4210_USB2
  97        {
  98                .compatible = "samsung,exynos4210-usb2-phy",
  99                .data = &exynos4210_usb2_phy_config,
 100        },
 101#endif
 102#ifdef CONFIG_PHY_EXYNOS4X12_USB2
 103        {
 104                .compatible = "samsung,exynos4x12-usb2-phy",
 105                .data = &exynos4x12_usb2_phy_config,
 106        },
 107#endif
 108#ifdef CONFIG_PHY_EXYNOS5250_USB2
 109        {
 110                .compatible = "samsung,exynos5250-usb2-phy",
 111                .data = &exynos5250_usb2_phy_config,
 112        },
 113#endif
 114#ifdef CONFIG_PHY_S5PV210_USB2
 115        {
 116                .compatible = "samsung,s5pv210-usb2-phy",
 117                .data = &s5pv210_usb2_phy_config,
 118        },
 119#endif
 120        { },
 121};
 122MODULE_DEVICE_TABLE(of, samsung_usb2_phy_of_match);
 123
 124static int samsung_usb2_phy_probe(struct platform_device *pdev)
 125{
 126        const struct of_device_id *match;
 127        const struct samsung_usb2_phy_config *cfg;
 128        struct device *dev = &pdev->dev;
 129        struct phy_provider *phy_provider;
 130        struct resource *mem;
 131        struct samsung_usb2_phy_driver *drv;
 132        int i, ret;
 133
 134        if (!pdev->dev.of_node) {
 135                dev_err(dev, "This driver is required to be instantiated from device tree\n");
 136                return -EINVAL;
 137        }
 138
 139        match = of_match_node(samsung_usb2_phy_of_match, pdev->dev.of_node);
 140        if (!match) {
 141                dev_err(dev, "of_match_node() failed\n");
 142                return -EINVAL;
 143        }
 144        cfg = match->data;
 145
 146        drv = devm_kzalloc(dev, sizeof(struct samsung_usb2_phy_driver) +
 147                cfg->num_phys * sizeof(struct samsung_usb2_phy_instance),
 148                                                                GFP_KERNEL);
 149        if (!drv)
 150                return -ENOMEM;
 151
 152        dev_set_drvdata(dev, drv);
 153        spin_lock_init(&drv->lock);
 154
 155        drv->cfg = cfg;
 156        drv->dev = dev;
 157
 158        mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 159        drv->reg_phy = devm_ioremap_resource(dev, mem);
 160        if (IS_ERR(drv->reg_phy)) {
 161                dev_err(dev, "Failed to map register memory (phy)\n");
 162                return PTR_ERR(drv->reg_phy);
 163        }
 164
 165        drv->reg_pmu = syscon_regmap_lookup_by_phandle(pdev->dev.of_node,
 166                "samsung,pmureg-phandle");
 167        if (IS_ERR(drv->reg_pmu)) {
 168                dev_err(dev, "Failed to map PMU registers (via syscon)\n");
 169                return PTR_ERR(drv->reg_pmu);
 170        }
 171
 172        if (drv->cfg->has_mode_switch) {
 173                drv->reg_sys = syscon_regmap_lookup_by_phandle(
 174                                pdev->dev.of_node, "samsung,sysreg-phandle");
 175                if (IS_ERR(drv->reg_sys)) {
 176                        dev_err(dev, "Failed to map system registers (via syscon)\n");
 177                        return PTR_ERR(drv->reg_sys);
 178                }
 179        }
 180
 181        drv->clk = devm_clk_get(dev, "phy");
 182        if (IS_ERR(drv->clk)) {
 183                dev_err(dev, "Failed to get clock of phy controller\n");
 184                return PTR_ERR(drv->clk);
 185        }
 186
 187        drv->ref_clk = devm_clk_get(dev, "ref");
 188        if (IS_ERR(drv->ref_clk)) {
 189                dev_err(dev, "Failed to get reference clock for the phy controller\n");
 190                return PTR_ERR(drv->ref_clk);
 191        }
 192
 193        drv->ref_rate = clk_get_rate(drv->ref_clk);
 194        if (drv->cfg->rate_to_clk) {
 195                ret = drv->cfg->rate_to_clk(drv->ref_rate, &drv->ref_reg_val);
 196                if (ret)
 197                        return ret;
 198        }
 199
 200        for (i = 0; i < drv->cfg->num_phys; i++) {
 201                char *label = drv->cfg->phys[i].label;
 202                struct samsung_usb2_phy_instance *p = &drv->instances[i];
 203
 204                dev_dbg(dev, "Creating phy \"%s\"\n", label);
 205                p->phy = devm_phy_create(dev, NULL, &samsung_usb2_phy_ops);
 206                if (IS_ERR(p->phy)) {
 207                        dev_err(drv->dev, "Failed to create usb2_phy \"%s\"\n",
 208                                label);
 209                        return PTR_ERR(p->phy);
 210                }
 211
 212                p->cfg = &drv->cfg->phys[i];
 213                p->drv = drv;
 214                phy_set_bus_width(p->phy, 8);
 215                phy_set_drvdata(p->phy, p);
 216        }
 217
 218        phy_provider = devm_of_phy_provider_register(dev,
 219                                                        samsung_usb2_phy_xlate);
 220        if (IS_ERR(phy_provider)) {
 221                dev_err(drv->dev, "Failed to register phy provider\n");
 222                return PTR_ERR(phy_provider);
 223        }
 224
 225        return 0;
 226}
 227
 228static struct platform_driver samsung_usb2_phy_driver = {
 229        .probe  = samsung_usb2_phy_probe,
 230        .driver = {
 231                .of_match_table = samsung_usb2_phy_of_match,
 232                .name           = "samsung-usb2-phy",
 233        }
 234};
 235
 236module_platform_driver(samsung_usb2_phy_driver);
 237MODULE_DESCRIPTION("Samsung S5P/EXYNOS SoC USB PHY driver");
 238MODULE_AUTHOR("Kamil Debski <k.debski@samsung.com>");
 239MODULE_LICENSE("GPL v2");
 240MODULE_ALIAS("platform:samsung-usb2-phy");
 241
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.