123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704 |
- /*
- * phy-ti-pipe3 - PIPE3 PHY driver.
- *
- * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * Author: Kishon Vijay Abraham I <kishon@ti.com>
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- */
- #include <linux/module.h>
- #include <linux/platform_device.h>
- #include <linux/slab.h>
- #include <linux/phy/phy.h>
- #include <linux/of.h>
- #include <linux/clk.h>
- #include <linux/err.h>
- #include <linux/io.h>
- #include <linux/pm_runtime.h>
- #include <linux/delay.h>
- #include <linux/phy/omap_control_phy.h>
- #include <linux/of_platform.h>
- #include <linux/mfd/syscon.h>
- #include <linux/regmap.h>
- #define PLL_STATUS 0x00000004
- #define PLL_GO 0x00000008
- #define PLL_CONFIGURATION1 0x0000000C
- #define PLL_CONFIGURATION2 0x00000010
- #define PLL_CONFIGURATION3 0x00000014
- #define PLL_CONFIGURATION4 0x00000020
- #define PLL_REGM_MASK 0x001FFE00
- #define PLL_REGM_SHIFT 0x9
- #define PLL_REGM_F_MASK 0x0003FFFF
- #define PLL_REGM_F_SHIFT 0x0
- #define PLL_REGN_MASK 0x000001FE
- #define PLL_REGN_SHIFT 0x1
- #define PLL_SELFREQDCO_MASK 0x0000000E
- #define PLL_SELFREQDCO_SHIFT 0x1
- #define PLL_SD_MASK 0x0003FC00
- #define PLL_SD_SHIFT 10
- #define SET_PLL_GO 0x1
- #define PLL_LDOPWDN BIT(15)
- #define PLL_TICOPWDN BIT(16)
- #define PLL_LOCK 0x2
- #define PLL_IDLE 0x1
- #define SATA_PLL_SOFT_RESET BIT(18)
- #define PIPE3_PHY_PWRCTL_CLK_CMD_MASK 0x003FC000
- #define PIPE3_PHY_PWRCTL_CLK_CMD_SHIFT 14
- #define PIPE3_PHY_PWRCTL_CLK_FREQ_MASK 0xFFC00000
- #define PIPE3_PHY_PWRCTL_CLK_FREQ_SHIFT 22
- #define PIPE3_PHY_TX_RX_POWERON 0x3
- #define PIPE3_PHY_TX_RX_POWEROFF 0x0
- #define PCIE_PCS_MASK 0xFF0000
- #define PCIE_PCS_DELAY_COUNT_SHIFT 0x10
- /*
- * This is an Empirical value that works, need to confirm the actual
- * value required for the PIPE3PHY_PLL_CONFIGURATION2.PLL_IDLE status
- * to be correctly reflected in the PIPE3PHY_PLL_STATUS register.
- */
- #define PLL_IDLE_TIME 100 /* in milliseconds */
- #define PLL_LOCK_TIME 100 /* in milliseconds */
- struct pipe3_dpll_params {
- u16 m;
- u8 n;
- u8 freq:3;
- u8 sd;
- u32 mf;
- };
- struct pipe3_dpll_map {
- unsigned long rate;
- struct pipe3_dpll_params params;
- };
- struct ti_pipe3 {
- void __iomem *pll_ctrl_base;
- struct device *dev;
- struct device *control_dev;
- struct clk *wkupclk;
- struct clk *sys_clk;
- struct clk *refclk;
- struct clk *div_clk;
- struct pipe3_dpll_map *dpll_map;
- struct regmap *phy_power_syscon; /* ctrl. reg. acces */
- struct regmap *pcs_syscon; /* ctrl. reg. acces */
- struct regmap *dpll_reset_syscon; /* ctrl. reg. acces */
- unsigned int dpll_reset_reg; /* reg. index within syscon */
- unsigned int power_reg; /* power reg. index within syscon */
- unsigned int pcie_pcs_reg; /* pcs reg. index in syscon */
- bool sata_refclk_enabled;
- };
- static struct pipe3_dpll_map dpll_map_usb[] = {
- {12000000, {1250, 5, 4, 20, 0} }, /* 12 MHz */
- {16800000, {3125, 20, 4, 20, 0} }, /* 16.8 MHz */
- {19200000, {1172, 8, 4, 20, 65537} }, /* 19.2 MHz */
- {20000000, {1000, 7, 4, 10, 0} }, /* 20 MHz */
- {26000000, {1250, 12, 4, 20, 0} }, /* 26 MHz */
- {38400000, {3125, 47, 4, 20, 92843} }, /* 38.4 MHz */
- { }, /* Terminator */
- };
- static struct pipe3_dpll_map dpll_map_sata[] = {
- {12000000, {1000, 7, 4, 6, 0} }, /* 12 MHz */
- {16800000, {714, 7, 4, 6, 0} }, /* 16.8 MHz */
- {19200000, {625, 7, 4, 6, 0} }, /* 19.2 MHz */
- {20000000, {600, 7, 4, 6, 0} }, /* 20 MHz */
- {26000000, {461, 7, 4, 6, 0} }, /* 26 MHz */
- {38400000, {312, 7, 4, 6, 0} }, /* 38.4 MHz */
- { }, /* Terminator */
- };
- static inline u32 ti_pipe3_readl(void __iomem *addr, unsigned offset)
- {
- return __raw_readl(addr + offset);
- }
- static inline void ti_pipe3_writel(void __iomem *addr, unsigned offset,
- u32 data)
- {
- __raw_writel(data, addr + offset);
- }
- static struct pipe3_dpll_params *ti_pipe3_get_dpll_params(struct ti_pipe3 *phy)
- {
- unsigned long rate;
- struct pipe3_dpll_map *dpll_map = phy->dpll_map;
- rate = clk_get_rate(phy->sys_clk);
- for (; dpll_map->rate; dpll_map++) {
- if (rate == dpll_map->rate)
- return &dpll_map->params;
- }
- dev_err(phy->dev, "No DPLL configuration for %lu Hz SYS CLK\n", rate);
- return NULL;
- }
- static int ti_pipe3_enable_clocks(struct ti_pipe3 *phy);
- static void ti_pipe3_disable_clocks(struct ti_pipe3 *phy);
- static int ti_pipe3_power_off(struct phy *x)
- {
- u32 val;
- int ret;
- struct ti_pipe3 *phy = phy_get_drvdata(x);
- if (!phy->phy_power_syscon) {
- omap_control_phy_power(phy->control_dev, 0);
- return 0;
- }
- val = PIPE3_PHY_TX_RX_POWEROFF << PIPE3_PHY_PWRCTL_CLK_CMD_SHIFT;
- ret = regmap_update_bits(phy->phy_power_syscon, phy->power_reg,
- PIPE3_PHY_PWRCTL_CLK_CMD_MASK, val);
- return ret;
- }
- static int ti_pipe3_power_on(struct phy *x)
- {
- u32 val;
- u32 mask;
- int ret;
- unsigned long rate;
- struct ti_pipe3 *phy = phy_get_drvdata(x);
- if (!phy->phy_power_syscon) {
- omap_control_phy_power(phy->control_dev, 1);
- return 0;
- }
- rate = clk_get_rate(phy->sys_clk);
- if (!rate) {
- dev_err(phy->dev, "Invalid clock rate\n");
- return -EINVAL;
- }
- rate = rate / 1000000;
- mask = OMAP_CTRL_PIPE3_PHY_PWRCTL_CLK_CMD_MASK |
- OMAP_CTRL_PIPE3_PHY_PWRCTL_CLK_FREQ_MASK;
- val = PIPE3_PHY_TX_RX_POWERON << PIPE3_PHY_PWRCTL_CLK_CMD_SHIFT;
- val |= rate << OMAP_CTRL_PIPE3_PHY_PWRCTL_CLK_FREQ_SHIFT;
- ret = regmap_update_bits(phy->phy_power_syscon, phy->power_reg,
- mask, val);
- return ret;
- }
- static int ti_pipe3_dpll_wait_lock(struct ti_pipe3 *phy)
- {
- u32 val;
- unsigned long timeout;
- timeout = jiffies + msecs_to_jiffies(PLL_LOCK_TIME);
- do {
- cpu_relax();
- val = ti_pipe3_readl(phy->pll_ctrl_base, PLL_STATUS);
- if (val & PLL_LOCK)
- return 0;
- } while (!time_after(jiffies, timeout));
- dev_err(phy->dev, "DPLL failed to lock\n");
- return -EBUSY;
- }
- static int ti_pipe3_dpll_program(struct ti_pipe3 *phy)
- {
- u32 val;
- struct pipe3_dpll_params *dpll_params;
- dpll_params = ti_pipe3_get_dpll_params(phy);
- if (!dpll_params)
- return -EINVAL;
- val = ti_pipe3_readl(phy->pll_ctrl_base, PLL_CONFIGURATION1);
- val &= ~PLL_REGN_MASK;
- val |= dpll_params->n << PLL_REGN_SHIFT;
- ti_pipe3_writel(phy->pll_ctrl_base, PLL_CONFIGURATION1, val);
- val = ti_pipe3_readl(phy->pll_ctrl_base, PLL_CONFIGURATION2);
- val &= ~PLL_SELFREQDCO_MASK;
- val |= dpll_params->freq << PLL_SELFREQDCO_SHIFT;
- ti_pipe3_writel(phy->pll_ctrl_base, PLL_CONFIGURATION2, val);
- val = ti_pipe3_readl(phy->pll_ctrl_base, PLL_CONFIGURATION1);
- val &= ~PLL_REGM_MASK;
- val |= dpll_params->m << PLL_REGM_SHIFT;
- ti_pipe3_writel(phy->pll_ctrl_base, PLL_CONFIGURATION1, val);
- val = ti_pipe3_readl(phy->pll_ctrl_base, PLL_CONFIGURATION4);
- val &= ~PLL_REGM_F_MASK;
- val |= dpll_params->mf << PLL_REGM_F_SHIFT;
- ti_pipe3_writel(phy->pll_ctrl_base, PLL_CONFIGURATION4, val);
- val = ti_pipe3_readl(phy->pll_ctrl_base, PLL_CONFIGURATION3);
- val &= ~PLL_SD_MASK;
- val |= dpll_params->sd << PLL_SD_SHIFT;
- ti_pipe3_writel(phy->pll_ctrl_base, PLL_CONFIGURATION3, val);
- ti_pipe3_writel(phy->pll_ctrl_base, PLL_GO, SET_PLL_GO);
- return ti_pipe3_dpll_wait_lock(phy);
- }
- static int ti_pipe3_init(struct phy *x)
- {
- struct ti_pipe3 *phy = phy_get_drvdata(x);
- u32 val;
- int ret = 0;
- ti_pipe3_enable_clocks(phy);
- /*
- * Set pcie_pcs register to 0x96 for proper functioning of phy
- * as recommended in AM572x TRM SPRUHZ6, section 18.5.2.2, table
- * 18-1804.
- */
- if (of_device_is_compatible(phy->dev->of_node, "ti,phy-pipe3-pcie")) {
- if (!phy->pcs_syscon) {
- omap_control_pcie_pcs(phy->control_dev, 0x96);
- return 0;
- }
- val = 0x96 << OMAP_CTRL_PCIE_PCS_DELAY_COUNT_SHIFT;
- ret = regmap_update_bits(phy->pcs_syscon, phy->pcie_pcs_reg,
- PCIE_PCS_MASK, val);
- return ret;
- }
- /* Bring it out of IDLE if it is IDLE */
- val = ti_pipe3_readl(phy->pll_ctrl_base, PLL_CONFIGURATION2);
- if (val & PLL_IDLE) {
- val &= ~PLL_IDLE;
- ti_pipe3_writel(phy->pll_ctrl_base, PLL_CONFIGURATION2, val);
- ret = ti_pipe3_dpll_wait_lock(phy);
- }
- /* SATA has issues if re-programmed when locked */
- val = ti_pipe3_readl(phy->pll_ctrl_base, PLL_STATUS);
- if ((val & PLL_LOCK) && of_device_is_compatible(phy->dev->of_node,
- "ti,phy-pipe3-sata"))
- return ret;
- /* Program the DPLL */
- ret = ti_pipe3_dpll_program(phy);
- if (ret) {
- ti_pipe3_disable_clocks(phy);
- return -EINVAL;
- }
- return ret;
- }
- static int ti_pipe3_exit(struct phy *x)
- {
- struct ti_pipe3 *phy = phy_get_drvdata(x);
- u32 val;
- unsigned long timeout;
- /* If dpll_reset_syscon is not present we wont power down SATA DPLL
- * due to Errata i783
- */
- if (of_device_is_compatible(phy->dev->of_node, "ti,phy-pipe3-sata") &&
- !phy->dpll_reset_syscon)
- return 0;
- /* PCIe doesn't have internal DPLL */
- if (!of_device_is_compatible(phy->dev->of_node, "ti,phy-pipe3-pcie")) {
- /* Put DPLL in IDLE mode */
- val = ti_pipe3_readl(phy->pll_ctrl_base, PLL_CONFIGURATION2);
- val |= PLL_IDLE;
- ti_pipe3_writel(phy->pll_ctrl_base, PLL_CONFIGURATION2, val);
- /* wait for LDO and Oscillator to power down */
- timeout = jiffies + msecs_to_jiffies(PLL_IDLE_TIME);
- do {
- cpu_relax();
- val = ti_pipe3_readl(phy->pll_ctrl_base, PLL_STATUS);
- if ((val & PLL_TICOPWDN) && (val & PLL_LDOPWDN))
- break;
- } while (!time_after(jiffies, timeout));
- if (!(val & PLL_TICOPWDN) || !(val & PLL_LDOPWDN)) {
- dev_err(phy->dev, "Failed to power down: PLL_STATUS 0x%x\n",
- val);
- return -EBUSY;
- }
- }
- /* i783: SATA needs control bit toggle after PLL unlock */
- if (of_device_is_compatible(phy->dev->of_node, "ti,phy-pipe3-sata")) {
- regmap_update_bits(phy->dpll_reset_syscon, phy->dpll_reset_reg,
- SATA_PLL_SOFT_RESET, SATA_PLL_SOFT_RESET);
- regmap_update_bits(phy->dpll_reset_syscon, phy->dpll_reset_reg,
- SATA_PLL_SOFT_RESET, 0);
- }
- ti_pipe3_disable_clocks(phy);
- return 0;
- }
- static const struct phy_ops ops = {
- .init = ti_pipe3_init,
- .exit = ti_pipe3_exit,
- .power_on = ti_pipe3_power_on,
- .power_off = ti_pipe3_power_off,
- .owner = THIS_MODULE,
- };
- static const struct of_device_id ti_pipe3_id_table[];
- static int ti_pipe3_get_clk(struct ti_pipe3 *phy)
- {
- struct clk *clk;
- struct device *dev = phy->dev;
- struct device_node *node = dev->of_node;
- phy->refclk = devm_clk_get(dev, "refclk");
- if (IS_ERR(phy->refclk)) {
- dev_err(dev, "unable to get refclk\n");
- /* older DTBs have missing refclk in SATA PHY
- * so don't bail out in case of SATA PHY.
- */
- if (!of_device_is_compatible(node, "ti,phy-pipe3-sata"))
- return PTR_ERR(phy->refclk);
- }
- if (!of_device_is_compatible(node, "ti,phy-pipe3-sata")) {
- phy->wkupclk = devm_clk_get(dev, "wkupclk");
- if (IS_ERR(phy->wkupclk)) {
- dev_err(dev, "unable to get wkupclk\n");
- return PTR_ERR(phy->wkupclk);
- }
- } else {
- phy->wkupclk = ERR_PTR(-ENODEV);
- }
- if (!of_device_is_compatible(node, "ti,phy-pipe3-pcie") ||
- phy->phy_power_syscon) {
- phy->sys_clk = devm_clk_get(dev, "sysclk");
- if (IS_ERR(phy->sys_clk)) {
- dev_err(dev, "unable to get sysclk\n");
- return -EINVAL;
- }
- }
- if (of_device_is_compatible(node, "ti,phy-pipe3-pcie")) {
- clk = devm_clk_get(dev, "dpll_ref");
- if (IS_ERR(clk)) {
- dev_err(dev, "unable to get dpll ref clk\n");
- return PTR_ERR(clk);
- }
- clk_set_rate(clk, 1500000000);
- clk = devm_clk_get(dev, "dpll_ref_m2");
- if (IS_ERR(clk)) {
- dev_err(dev, "unable to get dpll ref m2 clk\n");
- return PTR_ERR(clk);
- }
- clk_set_rate(clk, 100000000);
- clk = devm_clk_get(dev, "phy-div");
- if (IS_ERR(clk)) {
- dev_err(dev, "unable to get phy-div clk\n");
- return PTR_ERR(clk);
- }
- clk_set_rate(clk, 100000000);
- phy->div_clk = devm_clk_get(dev, "div-clk");
- if (IS_ERR(phy->div_clk)) {
- dev_err(dev, "unable to get div-clk\n");
- return PTR_ERR(phy->div_clk);
- }
- } else {
- phy->div_clk = ERR_PTR(-ENODEV);
- }
- return 0;
- }
- static int ti_pipe3_get_sysctrl(struct ti_pipe3 *phy)
- {
- struct device *dev = phy->dev;
- struct device_node *node = dev->of_node;
- struct device_node *control_node;
- struct platform_device *control_pdev;
- phy->phy_power_syscon = syscon_regmap_lookup_by_phandle(node,
- "syscon-phy-power");
- if (IS_ERR(phy->phy_power_syscon)) {
- dev_dbg(dev,
- "can't get syscon-phy-power, using control device\n");
- phy->phy_power_syscon = NULL;
- } else {
- if (of_property_read_u32_index(node,
- "syscon-phy-power", 1,
- &phy->power_reg)) {
- dev_err(dev, "couldn't get power reg. offset\n");
- return -EINVAL;
- }
- }
- if (!phy->phy_power_syscon) {
- control_node = of_parse_phandle(node, "ctrl-module", 0);
- if (!control_node) {
- dev_err(dev, "Failed to get control device phandle\n");
- return -EINVAL;
- }
- control_pdev = of_find_device_by_node(control_node);
- if (!control_pdev) {
- dev_err(dev, "Failed to get control device\n");
- return -EINVAL;
- }
- phy->control_dev = &control_pdev->dev;
- }
- if (of_device_is_compatible(node, "ti,phy-pipe3-pcie")) {
- phy->pcs_syscon = syscon_regmap_lookup_by_phandle(node,
- "syscon-pcs");
- if (IS_ERR(phy->pcs_syscon)) {
- dev_dbg(dev,
- "can't get syscon-pcs, using omap control\n");
- phy->pcs_syscon = NULL;
- } else {
- if (of_property_read_u32_index(node,
- "syscon-pcs", 1,
- &phy->pcie_pcs_reg)) {
- dev_err(dev,
- "couldn't get pcie pcs reg. offset\n");
- return -EINVAL;
- }
- }
- }
- if (of_device_is_compatible(node, "ti,phy-pipe3-sata")) {
- phy->dpll_reset_syscon = syscon_regmap_lookup_by_phandle(node,
- "syscon-pllreset");
- if (IS_ERR(phy->dpll_reset_syscon)) {
- dev_info(dev,
- "can't get syscon-pllreset, sata dpll won't idle\n");
- phy->dpll_reset_syscon = NULL;
- } else {
- if (of_property_read_u32_index(node,
- "syscon-pllreset", 1,
- &phy->dpll_reset_reg)) {
- dev_err(dev,
- "couldn't get pllreset reg. offset\n");
- return -EINVAL;
- }
- }
- }
- return 0;
- }
- static int ti_pipe3_get_pll_base(struct ti_pipe3 *phy)
- {
- struct resource *res;
- const struct of_device_id *match;
- struct device *dev = phy->dev;
- struct device_node *node = dev->of_node;
- struct platform_device *pdev = to_platform_device(dev);
- if (of_device_is_compatible(node, "ti,phy-pipe3-pcie"))
- return 0;
- match = of_match_device(ti_pipe3_id_table, dev);
- if (!match)
- return -EINVAL;
- phy->dpll_map = (struct pipe3_dpll_map *)match->data;
- if (!phy->dpll_map) {
- dev_err(dev, "no DPLL data\n");
- return -EINVAL;
- }
- res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
- "pll_ctrl");
- phy->pll_ctrl_base = devm_ioremap_resource(dev, res);
- if (IS_ERR(phy->pll_ctrl_base))
- return PTR_ERR(phy->pll_ctrl_base);
- return 0;
- }
- static int ti_pipe3_probe(struct platform_device *pdev)
- {
- struct ti_pipe3 *phy;
- struct phy *generic_phy;
- struct phy_provider *phy_provider;
- struct device_node *node = pdev->dev.of_node;
- struct device *dev = &pdev->dev;
- int ret;
- phy = devm_kzalloc(dev, sizeof(*phy), GFP_KERNEL);
- if (!phy)
- return -ENOMEM;
- phy->dev = dev;
- ret = ti_pipe3_get_pll_base(phy);
- if (ret)
- return ret;
- ret = ti_pipe3_get_sysctrl(phy);
- if (ret)
- return ret;
- ret = ti_pipe3_get_clk(phy);
- if (ret)
- return ret;
- platform_set_drvdata(pdev, phy);
- pm_runtime_enable(dev);
- /*
- * Prevent auto-disable of refclk for SATA PHY due to Errata i783
- */
- if (of_device_is_compatible(node, "ti,phy-pipe3-sata")) {
- if (!IS_ERR(phy->refclk)) {
- clk_prepare_enable(phy->refclk);
- phy->sata_refclk_enabled = true;
- }
- }
- generic_phy = devm_phy_create(dev, NULL, &ops);
- if (IS_ERR(generic_phy))
- return PTR_ERR(generic_phy);
- phy_set_drvdata(generic_phy, phy);
- ti_pipe3_power_off(generic_phy);
- phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
- if (IS_ERR(phy_provider))
- return PTR_ERR(phy_provider);
- return 0;
- }
- static int ti_pipe3_remove(struct platform_device *pdev)
- {
- pm_runtime_disable(&pdev->dev);
- return 0;
- }
- static int ti_pipe3_enable_clocks(struct ti_pipe3 *phy)
- {
- int ret = 0;
- if (!IS_ERR(phy->refclk)) {
- ret = clk_prepare_enable(phy->refclk);
- if (ret) {
- dev_err(phy->dev, "Failed to enable refclk %d\n", ret);
- return ret;
- }
- }
- if (!IS_ERR(phy->wkupclk)) {
- ret = clk_prepare_enable(phy->wkupclk);
- if (ret) {
- dev_err(phy->dev, "Failed to enable wkupclk %d\n", ret);
- goto disable_refclk;
- }
- }
- if (!IS_ERR(phy->div_clk)) {
- ret = clk_prepare_enable(phy->div_clk);
- if (ret) {
- dev_err(phy->dev, "Failed to enable div_clk %d\n", ret);
- goto disable_wkupclk;
- }
- }
- return 0;
- disable_wkupclk:
- if (!IS_ERR(phy->wkupclk))
- clk_disable_unprepare(phy->wkupclk);
- disable_refclk:
- if (!IS_ERR(phy->refclk))
- clk_disable_unprepare(phy->refclk);
- return ret;
- }
- static void ti_pipe3_disable_clocks(struct ti_pipe3 *phy)
- {
- if (!IS_ERR(phy->wkupclk))
- clk_disable_unprepare(phy->wkupclk);
- if (!IS_ERR(phy->refclk)) {
- clk_disable_unprepare(phy->refclk);
- /*
- * SATA refclk needs an additional disable as we left it
- * on in probe to avoid Errata i783
- */
- if (phy->sata_refclk_enabled) {
- clk_disable_unprepare(phy->refclk);
- phy->sata_refclk_enabled = false;
- }
- }
- if (!IS_ERR(phy->div_clk))
- clk_disable_unprepare(phy->div_clk);
- }
- static const struct of_device_id ti_pipe3_id_table[] = {
- {
- .compatible = "ti,phy-usb3",
- .data = dpll_map_usb,
- },
- {
- .compatible = "ti,omap-usb3",
- .data = dpll_map_usb,
- },
- {
- .compatible = "ti,phy-pipe3-sata",
- .data = dpll_map_sata,
- },
- {
- .compatible = "ti,phy-pipe3-pcie",
- },
- {}
- };
- MODULE_DEVICE_TABLE(of, ti_pipe3_id_table);
- static struct platform_driver ti_pipe3_driver = {
- .probe = ti_pipe3_probe,
- .remove = ti_pipe3_remove,
- .driver = {
- .name = "ti-pipe3",
- .of_match_table = ti_pipe3_id_table,
- },
- };
- module_platform_driver(ti_pipe3_driver);
- MODULE_ALIAS("platform:ti_pipe3");
- MODULE_AUTHOR("Texas Instruments Inc.");
- MODULE_DESCRIPTION("TI PIPE3 phy driver");
- MODULE_LICENSE("GPL v2");
|