189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin/* 289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin * Copyright (C) 2014 STMicroelectronics 389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin * 489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin * STMicroelectronics Generic PHY driver for STiH407 USB2. 589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin * 689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin * Author: Giuseppe Cavallaro <peppe.cavallaro@st.com> 789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin * 889ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin * This program is free software; you can redistribute it and/or modify 989ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin * it under the terms of the GNU General Public License version 2, as 1089ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin * published by the Free Software Foundation. 1189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin * 1289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin */ 1389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin#include <linux/platform_device.h> 1489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin#include <linux/io.h> 1589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin#include <linux/kernel.h> 1689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin#include <linux/module.h> 1789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin#include <linux/of.h> 1889ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin#include <linux/of_platform.h> 1989ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin#include <linux/clk.h> 2089ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin#include <linux/regmap.h> 2189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin#include <linux/reset.h> 2289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin#include <linux/mfd/syscon.h> 2389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin#include <linux/phy/phy.h> 2489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 2589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin/* Default PHY_SEL and REFCLKSEL configuration */ 2689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin#define STIH407_USB_PICOPHY_CTRL_PORT_CONF 0x6 2789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin#define STIH407_USB_PICOPHY_CTRL_PORT_MASK 0x1f 2889ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 2989ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin/* ports parameters overriding */ 3089ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin#define STIH407_USB_PICOPHY_PARAM_DEF 0x39a4dc 3189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin#define STIH407_USB_PICOPHY_PARAM_MASK 0xffffffff 3289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 3389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffinstruct stih407_usb2_picophy { 3489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin struct phy *phy; 3589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin struct regmap *regmap; 3689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin struct device *dev; 3789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin struct reset_control *rstc; 3889ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin struct reset_control *rstport; 3989ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin int ctrl; 4089ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin int param; 4189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin}; 4289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 4389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffinstatic int stih407_usb2_pico_ctrl(struct stih407_usb2_picophy *phy_dev) 4489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin{ 4589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin reset_control_deassert(phy_dev->rstc); 4689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 4789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin return regmap_update_bits(phy_dev->regmap, phy_dev->ctrl, 4889ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin STIH407_USB_PICOPHY_CTRL_PORT_MASK, 4989ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin STIH407_USB_PICOPHY_CTRL_PORT_CONF); 5089ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin} 5189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 5289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffinstatic int stih407_usb2_init_port(struct phy *phy) 5389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin{ 5489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin int ret; 5589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin struct stih407_usb2_picophy *phy_dev = phy_get_drvdata(phy); 5689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 5789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin stih407_usb2_pico_ctrl(phy_dev); 5889ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 5989ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin ret = regmap_update_bits(phy_dev->regmap, 6089ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin phy_dev->param, 6189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin STIH407_USB_PICOPHY_PARAM_MASK, 6289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin STIH407_USB_PICOPHY_PARAM_DEF); 6389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin if (ret) 6489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin return ret; 6589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 6689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin return reset_control_deassert(phy_dev->rstport); 6789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin} 6889ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 6989ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffinstatic int stih407_usb2_exit_port(struct phy *phy) 7089ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin{ 7189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin struct stih407_usb2_picophy *phy_dev = phy_get_drvdata(phy); 7289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 7389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin /* 7489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin * Only port reset is asserted, phy global reset is kept untouched 7589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin * as other ports may still be active. When all ports are in reset 7689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin * state, assumption is made that power will be cut off on the phy, in 7789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin * case of suspend for instance. Theoretically, asserting individual 7889ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin * reset (like here) or global reset should be equivalent. 7989ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin */ 8089ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin return reset_control_assert(phy_dev->rstport); 8189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin} 8289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 8389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffinstatic const struct phy_ops stih407_usb2_picophy_data = { 8489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin .init = stih407_usb2_init_port, 8589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin .exit = stih407_usb2_exit_port, 8689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin .owner = THIS_MODULE, 8789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin}; 8889ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 8989ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffinstatic int stih407_usb2_picophy_probe(struct platform_device *pdev) 9089ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin{ 9189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin struct stih407_usb2_picophy *phy_dev; 9289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin struct device *dev = &pdev->dev; 9389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin struct device_node *np = dev->of_node; 9489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin struct phy_provider *phy_provider; 9589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin struct phy *phy; 9689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin struct resource *res; 9789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 9889ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin phy_dev = devm_kzalloc(dev, sizeof(*phy_dev), GFP_KERNEL); 9989ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin if (!phy_dev) 10089ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin return -ENOMEM; 10189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 10289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin phy_dev->dev = dev; 10389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin dev_set_drvdata(dev, phy_dev); 10489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 10589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin phy_dev->rstc = devm_reset_control_get(dev, "global"); 10689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin if (IS_ERR(phy_dev->rstc)) { 10789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin dev_err(dev, "failed to ctrl picoPHY reset\n"); 10889ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin return PTR_ERR(phy_dev->rstc); 10989ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin } 11089ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 11189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin phy_dev->rstport = devm_reset_control_get(dev, "port"); 11289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin if (IS_ERR(phy_dev->rstport)) { 11389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin dev_err(dev, "failed to ctrl picoPHY reset\n"); 11489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin return PTR_ERR(phy_dev->rstport); 11589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin } 11689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 11789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin /* Reset port by default: only deassert it in phy init */ 11889ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin reset_control_assert(phy_dev->rstport); 11989ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 12089ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin phy_dev->regmap = syscon_regmap_lookup_by_phandle(np, "st,syscfg"); 12189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin if (IS_ERR(phy_dev->regmap)) { 12289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin dev_err(dev, "No syscfg phandle specified\n"); 12389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin return PTR_ERR(phy_dev->regmap); 12489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin } 12589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 12689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "ctrl"); 12789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin if (!res) { 12889ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin dev_err(dev, "No ctrl reg found\n"); 12989ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin return -ENXIO; 13089ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin } 13189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin phy_dev->ctrl = res->start; 13289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 13389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "param"); 13489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin if (!res) { 13589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin dev_err(dev, "No param reg found\n"); 13689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin return -ENXIO; 13789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin } 13889ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin phy_dev->param = res->start; 13989ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 14089ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin phy = devm_phy_create(dev, NULL, &stih407_usb2_picophy_data, NULL); 14189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin if (IS_ERR(phy)) { 14289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin dev_err(dev, "failed to create Display Port PHY\n"); 14389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin return PTR_ERR(phy); 14489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin } 14589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 14689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin phy_dev->phy = phy; 14789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin phy_set_drvdata(phy, phy_dev); 14889ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 14989ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate); 15089ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin if (IS_ERR(phy_provider)) 15189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin return PTR_ERR(phy_provider); 15289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 15389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin dev_info(dev, "STiH407 USB Generic picoPHY driver probed!"); 15489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 15589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin return 0; 15689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin} 15789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 15889ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffinstatic const struct of_device_id stih407_usb2_picophy_of_match[] = { 15989ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin { .compatible = "st,stih407-usb2-phy" }, 16089ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin { /*sentinel */ }, 16189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin}; 16289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 16389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter GriffinMODULE_DEVICE_TABLE(of, stih407_usb2_picophy_of_match); 16489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 16589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffinstatic struct platform_driver stih407_usb2_picophy_driver = { 16689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin .probe = stih407_usb2_picophy_probe, 16789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin .driver = { 16889ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin .name = "stih407-usb-genphy", 16989ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin .of_match_table = stih407_usb2_picophy_of_match, 17089ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin } 17189ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin}; 17289ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 17389ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffinmodule_platform_driver(stih407_usb2_picophy_driver); 17489ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter Griffin 17589ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter GriffinMODULE_AUTHOR("Giuseppe Cavallaro <peppe.cavallaro@st.com>"); 17689ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter GriffinMODULE_DESCRIPTION("STMicroelectronics Generic picoPHY driver for STiH407"); 17789ae1f5d4c9a62dd32e14d5edfb7221d2f73039ePeter GriffinMODULE_LICENSE("GPL v2"); 178