OERV-BSP/kernel-starfive-jh7110
4
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

usb: cdns3: set the phy mode while usb resume

Browse Source 
Set phy mode and phy configuraion while hibernation usb resume.
the phy setting lost while hibernation resume.

Signed-off-by: Minda Chen <minda.chen@starfivetech.com>
This commit is contained in:
Minda Chen
2024-05-30 11:25:12 +08:00
parent 55523997b9
commit a4af7cb31f
3 changed files with 54 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

10
drivers/phy/starfive/phy-jh7110-pcie.c
View File

@@ -129,7 +129,17 @@ static int jh7110_pcie_phy_set_mode(struct phy *_phy,
return 0;
}
static int jh7110_pcie_phy_exit(struct phy *_phy)
{
struct jh7110_pcie_phy *phy = phy_get_drvdata(_phy);
phy->mode = PHY_MODE_INVALID;
return 0;
}
static const struct phy_ops jh7110_pcie_phy_ops = {
.exit = jh7110_pcie_phy_exit,
.set_mode = jh7110_pcie_phy_set_mode,
.owner = THIS_MODULE,
};

2
drivers/phy/starfive/phy-jh7110-usb.c
View File

@@ -86,6 +86,8 @@ static int jh7110_usb2_phy_exit(struct phy *_phy)
clk_disable_unprepare(phy->app_125m);
phy->mode = PHY_MODE_INVALID;
return 0;
}

43
drivers/usb/cdns3/cdns3-starfive.c
View File

@@ -39,6 +39,7 @@ struct cdns_starfive {
struct clk_bulk_data *clks;
int num_clks;
u32 stg_usb_mode;
int mode;
};
static void cdns_mode_init(struct platform_device *pdev,
@@ -74,6 +75,7 @@ static void cdns_mode_init(struct platform_device *pdev,
default:
break;
}
data->mode = mode;
}
static int cdns_clk_rst_init(struct cdns_starfive *data)
@@ -104,6 +106,20 @@ static void cdns_clk_rst_deinit(struct cdns_starfive *data)
clk_bulk_disable_unprepare(data->num_clks, data->clks);
}
static int cdns_starfive_platform_suspend(struct device *dev,
bool suspend, bool wakeup);
static struct cdns3_platform_data cdns_starfive_pdata = {
.platform_suspend = cdns_starfive_platform_suspend,
};
static const struct of_dev_auxdata cdns_starfive_auxdata[] = {
{
.compatible = "cdns,usb3",
.platform_data = &cdns_starfive_pdata,
},
{},
};
static int cdns_starfive_probe(struct platform_device *pdev)
{
struct device *dev = &pdev->dev;
@@ -142,7 +158,7 @@ static int cdns_starfive_probe(struct platform_device *pdev)
if (ret)
return ret;
ret = of_platform_populate(dev->of_node, NULL, NULL, dev);
ret = of_platform_populate(dev->of_node, NULL, cdns_starfive_auxdata, dev);
if (ret) {
dev_err(dev, "Failed to create children\n");
cdns_clk_rst_deinit(data);
@@ -213,6 +229,31 @@ static int cdns_starfive_suspend(struct device *dev)
return 0;
}
static int cdns_starfive_platform_suspend(struct device *dev,
bool suspend, bool wakeup)
{
struct cdns *cdns = dev_get_drvdata(dev);
struct cdns_starfive *data = dev_get_drvdata(dev->parent);
if (!suspend) {
if (data->mode == USB_DR_MODE_HOST) {
phy_set_mode(cdns->usb2_phy, PHY_MODE_USB_HOST);
phy_set_mode(cdns->usb3_phy, PHY_MODE_USB_HOST);
} else if (data->mode == USB_DR_MODE_PERIPHERAL) {
phy_set_mode(cdns->usb2_phy, PHY_MODE_USB_DEVICE);
phy_set_mode(cdns->usb3_phy, PHY_MODE_USB_DEVICE);
}
}
return 0;
}
#else
static int cdns_starfive_platform_suspend(struct device *dev,
bool suspend, bool wakeup)
{
return 0;
}
#endif
#endif