mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-07 23:16:41 +07:00
9dba516ed2
imx usb over current polarity is low active by default, with over-current-active-high property added, user can config it to be high active. Meanwhile keep this setting unchanged for existing platforms so new platform must set the right value for active low by its usbmisc init function if over current is enabled. Signed-off-by: Li Jun <jun.li@nxp.com> Signed-off-by: Peter Chen <peter.chen@nxp.com>
489 lines
11 KiB
C
489 lines
11 KiB
C
/*
|
|
* Copyright 2012 Freescale Semiconductor, Inc.
|
|
* Copyright (C) 2012 Marek Vasut <marex@denx.de>
|
|
* on behalf of DENX Software Engineering GmbH
|
|
*
|
|
* The code contained herein is licensed under the GNU General Public
|
|
* License. You may obtain a copy of the GNU General Public License
|
|
* Version 2 or later at the following locations:
|
|
*
|
|
* http://www.opensource.org/licenses/gpl-license.html
|
|
* http://www.gnu.org/copyleft/gpl.html
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/of_platform.h>
|
|
#include <linux/of_gpio.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/pm_runtime.h>
|
|
#include <linux/dma-mapping.h>
|
|
#include <linux/usb/chipidea.h>
|
|
#include <linux/clk.h>
|
|
|
|
#include "ci.h"
|
|
#include "ci_hdrc_imx.h"
|
|
|
|
struct ci_hdrc_imx_platform_flag {
|
|
unsigned int flags;
|
|
bool runtime_pm;
|
|
};
|
|
|
|
static const struct ci_hdrc_imx_platform_flag imx23_usb_data = {
|
|
.flags = CI_HDRC_TURN_VBUS_EARLY_ON |
|
|
CI_HDRC_DISABLE_STREAMING,
|
|
};
|
|
|
|
static const struct ci_hdrc_imx_platform_flag imx27_usb_data = {
|
|
CI_HDRC_DISABLE_STREAMING,
|
|
};
|
|
|
|
static const struct ci_hdrc_imx_platform_flag imx28_usb_data = {
|
|
.flags = CI_HDRC_IMX28_WRITE_FIX |
|
|
CI_HDRC_TURN_VBUS_EARLY_ON |
|
|
CI_HDRC_DISABLE_STREAMING,
|
|
};
|
|
|
|
static const struct ci_hdrc_imx_platform_flag imx6q_usb_data = {
|
|
.flags = CI_HDRC_SUPPORTS_RUNTIME_PM |
|
|
CI_HDRC_TURN_VBUS_EARLY_ON |
|
|
CI_HDRC_DISABLE_STREAMING,
|
|
};
|
|
|
|
static const struct ci_hdrc_imx_platform_flag imx6sl_usb_data = {
|
|
.flags = CI_HDRC_SUPPORTS_RUNTIME_PM |
|
|
CI_HDRC_TURN_VBUS_EARLY_ON |
|
|
CI_HDRC_DISABLE_HOST_STREAMING,
|
|
};
|
|
|
|
static const struct ci_hdrc_imx_platform_flag imx6sx_usb_data = {
|
|
.flags = CI_HDRC_SUPPORTS_RUNTIME_PM |
|
|
CI_HDRC_TURN_VBUS_EARLY_ON |
|
|
CI_HDRC_DISABLE_HOST_STREAMING,
|
|
};
|
|
|
|
static const struct ci_hdrc_imx_platform_flag imx6ul_usb_data = {
|
|
.flags = CI_HDRC_SUPPORTS_RUNTIME_PM |
|
|
CI_HDRC_TURN_VBUS_EARLY_ON,
|
|
};
|
|
|
|
static const struct ci_hdrc_imx_platform_flag imx7d_usb_data = {
|
|
.flags = CI_HDRC_SUPPORTS_RUNTIME_PM,
|
|
};
|
|
|
|
static const struct of_device_id ci_hdrc_imx_dt_ids[] = {
|
|
{ .compatible = "fsl,imx23-usb", .data = &imx23_usb_data},
|
|
{ .compatible = "fsl,imx28-usb", .data = &imx28_usb_data},
|
|
{ .compatible = "fsl,imx27-usb", .data = &imx27_usb_data},
|
|
{ .compatible = "fsl,imx6q-usb", .data = &imx6q_usb_data},
|
|
{ .compatible = "fsl,imx6sl-usb", .data = &imx6sl_usb_data},
|
|
{ .compatible = "fsl,imx6sx-usb", .data = &imx6sx_usb_data},
|
|
{ .compatible = "fsl,imx6ul-usb", .data = &imx6ul_usb_data},
|
|
{ .compatible = "fsl,imx7d-usb", .data = &imx7d_usb_data},
|
|
{ /* sentinel */ }
|
|
};
|
|
MODULE_DEVICE_TABLE(of, ci_hdrc_imx_dt_ids);
|
|
|
|
struct ci_hdrc_imx_data {
|
|
struct usb_phy *phy;
|
|
struct platform_device *ci_pdev;
|
|
struct clk *clk;
|
|
struct imx_usbmisc_data *usbmisc_data;
|
|
bool supports_runtime_pm;
|
|
bool in_lpm;
|
|
/* SoC before i.mx6 (except imx23/imx28) needs three clks */
|
|
bool need_three_clks;
|
|
struct clk *clk_ipg;
|
|
struct clk *clk_ahb;
|
|
struct clk *clk_per;
|
|
/* --------------------------------- */
|
|
};
|
|
|
|
/* Common functions shared by usbmisc drivers */
|
|
|
|
static struct imx_usbmisc_data *usbmisc_get_init_data(struct device *dev)
|
|
{
|
|
struct platform_device *misc_pdev;
|
|
struct device_node *np = dev->of_node;
|
|
struct of_phandle_args args;
|
|
struct imx_usbmisc_data *data;
|
|
int ret;
|
|
|
|
/*
|
|
* In case the fsl,usbmisc property is not present this device doesn't
|
|
* need usbmisc. Return NULL (which is no error here)
|
|
*/
|
|
if (!of_get_property(np, "fsl,usbmisc", NULL))
|
|
return NULL;
|
|
|
|
data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
|
|
if (!data)
|
|
return ERR_PTR(-ENOMEM);
|
|
|
|
ret = of_parse_phandle_with_args(np, "fsl,usbmisc", "#index-cells",
|
|
0, &args);
|
|
if (ret) {
|
|
dev_err(dev, "Failed to parse property fsl,usbmisc, errno %d\n",
|
|
ret);
|
|
return ERR_PTR(ret);
|
|
}
|
|
|
|
data->index = args.args[0];
|
|
|
|
misc_pdev = of_find_device_by_node(args.np);
|
|
of_node_put(args.np);
|
|
|
|
if (!misc_pdev || !platform_get_drvdata(misc_pdev))
|
|
return ERR_PTR(-EPROBE_DEFER);
|
|
|
|
data->dev = &misc_pdev->dev;
|
|
|
|
if (of_find_property(np, "disable-over-current", NULL))
|
|
data->disable_oc = 1;
|
|
|
|
if (of_find_property(np, "over-current-active-high", NULL))
|
|
data->oc_polarity = 1;
|
|
|
|
if (of_find_property(np, "external-vbus-divider", NULL))
|
|
data->evdo = 1;
|
|
|
|
return data;
|
|
}
|
|
|
|
/* End of common functions shared by usbmisc drivers*/
|
|
static int imx_get_clks(struct device *dev)
|
|
{
|
|
struct ci_hdrc_imx_data *data = dev_get_drvdata(dev);
|
|
int ret = 0;
|
|
|
|
data->clk_ipg = devm_clk_get(dev, "ipg");
|
|
if (IS_ERR(data->clk_ipg)) {
|
|
/* If the platform only needs one clocks */
|
|
data->clk = devm_clk_get(dev, NULL);
|
|
if (IS_ERR(data->clk)) {
|
|
ret = PTR_ERR(data->clk);
|
|
dev_err(dev,
|
|
"Failed to get clks, err=%ld,%ld\n",
|
|
PTR_ERR(data->clk), PTR_ERR(data->clk_ipg));
|
|
return ret;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
data->clk_ahb = devm_clk_get(dev, "ahb");
|
|
if (IS_ERR(data->clk_ahb)) {
|
|
ret = PTR_ERR(data->clk_ahb);
|
|
dev_err(dev,
|
|
"Failed to get ahb clock, err=%d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
data->clk_per = devm_clk_get(dev, "per");
|
|
if (IS_ERR(data->clk_per)) {
|
|
ret = PTR_ERR(data->clk_per);
|
|
dev_err(dev,
|
|
"Failed to get per clock, err=%d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
data->need_three_clks = true;
|
|
return ret;
|
|
}
|
|
|
|
static int imx_prepare_enable_clks(struct device *dev)
|
|
{
|
|
struct ci_hdrc_imx_data *data = dev_get_drvdata(dev);
|
|
int ret = 0;
|
|
|
|
if (data->need_three_clks) {
|
|
ret = clk_prepare_enable(data->clk_ipg);
|
|
if (ret) {
|
|
dev_err(dev,
|
|
"Failed to prepare/enable ipg clk, err=%d\n",
|
|
ret);
|
|
return ret;
|
|
}
|
|
|
|
ret = clk_prepare_enable(data->clk_ahb);
|
|
if (ret) {
|
|
dev_err(dev,
|
|
"Failed to prepare/enable ahb clk, err=%d\n",
|
|
ret);
|
|
clk_disable_unprepare(data->clk_ipg);
|
|
return ret;
|
|
}
|
|
|
|
ret = clk_prepare_enable(data->clk_per);
|
|
if (ret) {
|
|
dev_err(dev,
|
|
"Failed to prepare/enable per clk, err=%d\n",
|
|
ret);
|
|
clk_disable_unprepare(data->clk_ahb);
|
|
clk_disable_unprepare(data->clk_ipg);
|
|
return ret;
|
|
}
|
|
} else {
|
|
ret = clk_prepare_enable(data->clk);
|
|
if (ret) {
|
|
dev_err(dev,
|
|
"Failed to prepare/enable clk, err=%d\n",
|
|
ret);
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void imx_disable_unprepare_clks(struct device *dev)
|
|
{
|
|
struct ci_hdrc_imx_data *data = dev_get_drvdata(dev);
|
|
|
|
if (data->need_three_clks) {
|
|
clk_disable_unprepare(data->clk_per);
|
|
clk_disable_unprepare(data->clk_ahb);
|
|
clk_disable_unprepare(data->clk_ipg);
|
|
} else {
|
|
clk_disable_unprepare(data->clk);
|
|
}
|
|
}
|
|
|
|
static int ci_hdrc_imx_probe(struct platform_device *pdev)
|
|
{
|
|
struct ci_hdrc_imx_data *data;
|
|
struct ci_hdrc_platform_data pdata = {
|
|
.name = dev_name(&pdev->dev),
|
|
.capoffset = DEF_CAPOFFSET,
|
|
};
|
|
int ret;
|
|
const struct of_device_id *of_id;
|
|
const struct ci_hdrc_imx_platform_flag *imx_platform_flag;
|
|
|
|
of_id = of_match_device(ci_hdrc_imx_dt_ids, &pdev->dev);
|
|
if (!of_id)
|
|
return -ENODEV;
|
|
|
|
imx_platform_flag = of_id->data;
|
|
|
|
data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
|
|
if (!data)
|
|
return -ENOMEM;
|
|
|
|
platform_set_drvdata(pdev, data);
|
|
data->usbmisc_data = usbmisc_get_init_data(&pdev->dev);
|
|
if (IS_ERR(data->usbmisc_data))
|
|
return PTR_ERR(data->usbmisc_data);
|
|
|
|
ret = imx_get_clks(&pdev->dev);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = imx_prepare_enable_clks(&pdev->dev);
|
|
if (ret)
|
|
return ret;
|
|
|
|
data->phy = devm_usb_get_phy_by_phandle(&pdev->dev, "fsl,usbphy", 0);
|
|
if (IS_ERR(data->phy)) {
|
|
ret = PTR_ERR(data->phy);
|
|
/* Return -EINVAL if no usbphy is available */
|
|
if (ret == -ENODEV)
|
|
ret = -EINVAL;
|
|
goto err_clk;
|
|
}
|
|
|
|
pdata.usb_phy = data->phy;
|
|
pdata.flags |= imx_platform_flag->flags;
|
|
if (pdata.flags & CI_HDRC_SUPPORTS_RUNTIME_PM)
|
|
data->supports_runtime_pm = true;
|
|
|
|
ret = imx_usbmisc_init(data->usbmisc_data);
|
|
if (ret) {
|
|
dev_err(&pdev->dev, "usbmisc init failed, ret=%d\n", ret);
|
|
goto err_clk;
|
|
}
|
|
|
|
data->ci_pdev = ci_hdrc_add_device(&pdev->dev,
|
|
pdev->resource, pdev->num_resources,
|
|
&pdata);
|
|
if (IS_ERR(data->ci_pdev)) {
|
|
ret = PTR_ERR(data->ci_pdev);
|
|
if (ret != -EPROBE_DEFER)
|
|
dev_err(&pdev->dev,
|
|
"ci_hdrc_add_device failed, err=%d\n", ret);
|
|
goto err_clk;
|
|
}
|
|
|
|
ret = imx_usbmisc_init_post(data->usbmisc_data);
|
|
if (ret) {
|
|
dev_err(&pdev->dev, "usbmisc post failed, ret=%d\n", ret);
|
|
goto disable_device;
|
|
}
|
|
|
|
if (data->supports_runtime_pm) {
|
|
pm_runtime_set_active(&pdev->dev);
|
|
pm_runtime_enable(&pdev->dev);
|
|
}
|
|
|
|
device_set_wakeup_capable(&pdev->dev, true);
|
|
|
|
return 0;
|
|
|
|
disable_device:
|
|
ci_hdrc_remove_device(data->ci_pdev);
|
|
err_clk:
|
|
imx_disable_unprepare_clks(&pdev->dev);
|
|
return ret;
|
|
}
|
|
|
|
static int ci_hdrc_imx_remove(struct platform_device *pdev)
|
|
{
|
|
struct ci_hdrc_imx_data *data = platform_get_drvdata(pdev);
|
|
|
|
if (data->supports_runtime_pm) {
|
|
pm_runtime_get_sync(&pdev->dev);
|
|
pm_runtime_disable(&pdev->dev);
|
|
pm_runtime_put_noidle(&pdev->dev);
|
|
}
|
|
ci_hdrc_remove_device(data->ci_pdev);
|
|
imx_disable_unprepare_clks(&pdev->dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void ci_hdrc_imx_shutdown(struct platform_device *pdev)
|
|
{
|
|
ci_hdrc_imx_remove(pdev);
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
static int imx_controller_suspend(struct device *dev)
|
|
{
|
|
struct ci_hdrc_imx_data *data = dev_get_drvdata(dev);
|
|
|
|
dev_dbg(dev, "at %s\n", __func__);
|
|
|
|
imx_disable_unprepare_clks(dev);
|
|
data->in_lpm = true;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int imx_controller_resume(struct device *dev)
|
|
{
|
|
struct ci_hdrc_imx_data *data = dev_get_drvdata(dev);
|
|
int ret = 0;
|
|
|
|
dev_dbg(dev, "at %s\n", __func__);
|
|
|
|
if (!data->in_lpm) {
|
|
WARN_ON(1);
|
|
return 0;
|
|
}
|
|
|
|
ret = imx_prepare_enable_clks(dev);
|
|
if (ret)
|
|
return ret;
|
|
|
|
data->in_lpm = false;
|
|
|
|
ret = imx_usbmisc_set_wakeup(data->usbmisc_data, false);
|
|
if (ret) {
|
|
dev_err(dev, "usbmisc set_wakeup failed, ret=%d\n", ret);
|
|
goto clk_disable;
|
|
}
|
|
|
|
return 0;
|
|
|
|
clk_disable:
|
|
imx_disable_unprepare_clks(dev);
|
|
return ret;
|
|
}
|
|
|
|
#ifdef CONFIG_PM_SLEEP
|
|
static int ci_hdrc_imx_suspend(struct device *dev)
|
|
{
|
|
int ret;
|
|
|
|
struct ci_hdrc_imx_data *data = dev_get_drvdata(dev);
|
|
|
|
if (data->in_lpm)
|
|
/* The core's suspend doesn't run */
|
|
return 0;
|
|
|
|
if (device_may_wakeup(dev)) {
|
|
ret = imx_usbmisc_set_wakeup(data->usbmisc_data, true);
|
|
if (ret) {
|
|
dev_err(dev, "usbmisc set_wakeup failed, ret=%d\n",
|
|
ret);
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
return imx_controller_suspend(dev);
|
|
}
|
|
|
|
static int ci_hdrc_imx_resume(struct device *dev)
|
|
{
|
|
struct ci_hdrc_imx_data *data = dev_get_drvdata(dev);
|
|
int ret;
|
|
|
|
ret = imx_controller_resume(dev);
|
|
if (!ret && data->supports_runtime_pm) {
|
|
pm_runtime_disable(dev);
|
|
pm_runtime_set_active(dev);
|
|
pm_runtime_enable(dev);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
#endif /* CONFIG_PM_SLEEP */
|
|
|
|
static int ci_hdrc_imx_runtime_suspend(struct device *dev)
|
|
{
|
|
struct ci_hdrc_imx_data *data = dev_get_drvdata(dev);
|
|
int ret;
|
|
|
|
if (data->in_lpm) {
|
|
WARN_ON(1);
|
|
return 0;
|
|
}
|
|
|
|
ret = imx_usbmisc_set_wakeup(data->usbmisc_data, true);
|
|
if (ret) {
|
|
dev_err(dev, "usbmisc set_wakeup failed, ret=%d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
return imx_controller_suspend(dev);
|
|
}
|
|
|
|
static int ci_hdrc_imx_runtime_resume(struct device *dev)
|
|
{
|
|
return imx_controller_resume(dev);
|
|
}
|
|
|
|
#endif /* CONFIG_PM */
|
|
|
|
static const struct dev_pm_ops ci_hdrc_imx_pm_ops = {
|
|
SET_SYSTEM_SLEEP_PM_OPS(ci_hdrc_imx_suspend, ci_hdrc_imx_resume)
|
|
SET_RUNTIME_PM_OPS(ci_hdrc_imx_runtime_suspend,
|
|
ci_hdrc_imx_runtime_resume, NULL)
|
|
};
|
|
static struct platform_driver ci_hdrc_imx_driver = {
|
|
.probe = ci_hdrc_imx_probe,
|
|
.remove = ci_hdrc_imx_remove,
|
|
.shutdown = ci_hdrc_imx_shutdown,
|
|
.driver = {
|
|
.name = "imx_usb",
|
|
.of_match_table = ci_hdrc_imx_dt_ids,
|
|
.pm = &ci_hdrc_imx_pm_ops,
|
|
},
|
|
};
|
|
|
|
module_platform_driver(ci_hdrc_imx_driver);
|
|
|
|
MODULE_ALIAS("platform:imx-usb");
|
|
MODULE_LICENSE("GPL v2");
|
|
MODULE_DESCRIPTION("CI HDRC i.MX USB binding");
|
|
MODULE_AUTHOR("Marek Vasut <marex@denx.de>");
|
|
MODULE_AUTHOR("Richard Zhao <richard.zhao@freescale.com>");
|