mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-15 06:55:13 +08:00
cefdd52fa0
In order to take advantage of the TX fifo resizing logic, manually add these properties to the DWC3 child node by default. This will allow the DWC3 gadget to resize the TX fifos for the IN endpoints, which help with performance. Signed-off-by: Wesley Cheng <wcheng@codeaurora.org> Link: https://lore.kernel.org/r/1625908395-5498-6-git-send-email-wcheng@codeaurora.org Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
986 lines
23 KiB
C
986 lines
23 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/* Copyright (c) 2018, The Linux Foundation. All rights reserved.
|
|
*
|
|
* Inspired by dwc3-of-simple.c
|
|
*/
|
|
|
|
#include <linux/acpi.h>
|
|
#include <linux/io.h>
|
|
#include <linux/of.h>
|
|
#include <linux/clk.h>
|
|
#include <linux/irq.h>
|
|
#include <linux/of_clk.h>
|
|
#include <linux/module.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/extcon.h>
|
|
#include <linux/interconnect.h>
|
|
#include <linux/of_platform.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/phy/phy.h>
|
|
#include <linux/usb/of.h>
|
|
#include <linux/reset.h>
|
|
#include <linux/iopoll.h>
|
|
|
|
#include "core.h"
|
|
|
|
/* USB QSCRATCH Hardware registers */
|
|
#define QSCRATCH_HS_PHY_CTRL 0x10
|
|
#define UTMI_OTG_VBUS_VALID BIT(20)
|
|
#define SW_SESSVLD_SEL BIT(28)
|
|
|
|
#define QSCRATCH_SS_PHY_CTRL 0x30
|
|
#define LANE0_PWR_PRESENT BIT(24)
|
|
|
|
#define QSCRATCH_GENERAL_CFG 0x08
|
|
#define PIPE_UTMI_CLK_SEL BIT(0)
|
|
#define PIPE3_PHYSTATUS_SW BIT(3)
|
|
#define PIPE_UTMI_CLK_DIS BIT(8)
|
|
|
|
#define PWR_EVNT_IRQ_STAT_REG 0x58
|
|
#define PWR_EVNT_LPM_IN_L2_MASK BIT(4)
|
|
#define PWR_EVNT_LPM_OUT_L2_MASK BIT(5)
|
|
|
|
#define SDM845_QSCRATCH_BASE_OFFSET 0xf8800
|
|
#define SDM845_QSCRATCH_SIZE 0x400
|
|
#define SDM845_DWC3_CORE_SIZE 0xcd00
|
|
|
|
/* Interconnect path bandwidths in MBps */
|
|
#define USB_MEMORY_AVG_HS_BW MBps_to_icc(240)
|
|
#define USB_MEMORY_PEAK_HS_BW MBps_to_icc(700)
|
|
#define USB_MEMORY_AVG_SS_BW MBps_to_icc(1000)
|
|
#define USB_MEMORY_PEAK_SS_BW MBps_to_icc(2500)
|
|
#define APPS_USB_AVG_BW 0
|
|
#define APPS_USB_PEAK_BW MBps_to_icc(40)
|
|
|
|
struct dwc3_acpi_pdata {
|
|
u32 qscratch_base_offset;
|
|
u32 qscratch_base_size;
|
|
u32 dwc3_core_base_size;
|
|
int hs_phy_irq_index;
|
|
int dp_hs_phy_irq_index;
|
|
int dm_hs_phy_irq_index;
|
|
int ss_phy_irq_index;
|
|
bool is_urs;
|
|
};
|
|
|
|
struct dwc3_qcom {
|
|
struct device *dev;
|
|
void __iomem *qscratch_base;
|
|
struct platform_device *dwc3;
|
|
struct platform_device *urs_usb;
|
|
struct clk **clks;
|
|
int num_clocks;
|
|
struct reset_control *resets;
|
|
|
|
int hs_phy_irq;
|
|
int dp_hs_phy_irq;
|
|
int dm_hs_phy_irq;
|
|
int ss_phy_irq;
|
|
|
|
struct extcon_dev *edev;
|
|
struct extcon_dev *host_edev;
|
|
struct notifier_block vbus_nb;
|
|
struct notifier_block host_nb;
|
|
|
|
const struct dwc3_acpi_pdata *acpi_pdata;
|
|
|
|
enum usb_dr_mode mode;
|
|
bool is_suspended;
|
|
bool pm_suspended;
|
|
struct icc_path *icc_path_ddr;
|
|
struct icc_path *icc_path_apps;
|
|
};
|
|
|
|
static inline void dwc3_qcom_setbits(void __iomem *base, u32 offset, u32 val)
|
|
{
|
|
u32 reg;
|
|
|
|
reg = readl(base + offset);
|
|
reg |= val;
|
|
writel(reg, base + offset);
|
|
|
|
/* ensure that above write is through */
|
|
readl(base + offset);
|
|
}
|
|
|
|
static inline void dwc3_qcom_clrbits(void __iomem *base, u32 offset, u32 val)
|
|
{
|
|
u32 reg;
|
|
|
|
reg = readl(base + offset);
|
|
reg &= ~val;
|
|
writel(reg, base + offset);
|
|
|
|
/* ensure that above write is through */
|
|
readl(base + offset);
|
|
}
|
|
|
|
static void dwc3_qcom_vbus_overrride_enable(struct dwc3_qcom *qcom, bool enable)
|
|
{
|
|
if (enable) {
|
|
dwc3_qcom_setbits(qcom->qscratch_base, QSCRATCH_SS_PHY_CTRL,
|
|
LANE0_PWR_PRESENT);
|
|
dwc3_qcom_setbits(qcom->qscratch_base, QSCRATCH_HS_PHY_CTRL,
|
|
UTMI_OTG_VBUS_VALID | SW_SESSVLD_SEL);
|
|
} else {
|
|
dwc3_qcom_clrbits(qcom->qscratch_base, QSCRATCH_SS_PHY_CTRL,
|
|
LANE0_PWR_PRESENT);
|
|
dwc3_qcom_clrbits(qcom->qscratch_base, QSCRATCH_HS_PHY_CTRL,
|
|
UTMI_OTG_VBUS_VALID | SW_SESSVLD_SEL);
|
|
}
|
|
}
|
|
|
|
static int dwc3_qcom_vbus_notifier(struct notifier_block *nb,
|
|
unsigned long event, void *ptr)
|
|
{
|
|
struct dwc3_qcom *qcom = container_of(nb, struct dwc3_qcom, vbus_nb);
|
|
|
|
/* enable vbus override for device mode */
|
|
dwc3_qcom_vbus_overrride_enable(qcom, event);
|
|
qcom->mode = event ? USB_DR_MODE_PERIPHERAL : USB_DR_MODE_HOST;
|
|
|
|
return NOTIFY_DONE;
|
|
}
|
|
|
|
static int dwc3_qcom_host_notifier(struct notifier_block *nb,
|
|
unsigned long event, void *ptr)
|
|
{
|
|
struct dwc3_qcom *qcom = container_of(nb, struct dwc3_qcom, host_nb);
|
|
|
|
/* disable vbus override in host mode */
|
|
dwc3_qcom_vbus_overrride_enable(qcom, !event);
|
|
qcom->mode = event ? USB_DR_MODE_HOST : USB_DR_MODE_PERIPHERAL;
|
|
|
|
return NOTIFY_DONE;
|
|
}
|
|
|
|
static int dwc3_qcom_register_extcon(struct dwc3_qcom *qcom)
|
|
{
|
|
struct device *dev = qcom->dev;
|
|
struct extcon_dev *host_edev;
|
|
int ret;
|
|
|
|
if (!of_property_read_bool(dev->of_node, "extcon"))
|
|
return 0;
|
|
|
|
qcom->edev = extcon_get_edev_by_phandle(dev, 0);
|
|
if (IS_ERR(qcom->edev))
|
|
return PTR_ERR(qcom->edev);
|
|
|
|
qcom->vbus_nb.notifier_call = dwc3_qcom_vbus_notifier;
|
|
|
|
qcom->host_edev = extcon_get_edev_by_phandle(dev, 1);
|
|
if (IS_ERR(qcom->host_edev))
|
|
qcom->host_edev = NULL;
|
|
|
|
ret = devm_extcon_register_notifier(dev, qcom->edev, EXTCON_USB,
|
|
&qcom->vbus_nb);
|
|
if (ret < 0) {
|
|
dev_err(dev, "VBUS notifier register failed\n");
|
|
return ret;
|
|
}
|
|
|
|
if (qcom->host_edev)
|
|
host_edev = qcom->host_edev;
|
|
else
|
|
host_edev = qcom->edev;
|
|
|
|
qcom->host_nb.notifier_call = dwc3_qcom_host_notifier;
|
|
ret = devm_extcon_register_notifier(dev, host_edev, EXTCON_USB_HOST,
|
|
&qcom->host_nb);
|
|
if (ret < 0) {
|
|
dev_err(dev, "Host notifier register failed\n");
|
|
return ret;
|
|
}
|
|
|
|
/* Update initial VBUS override based on extcon state */
|
|
if (extcon_get_state(qcom->edev, EXTCON_USB) ||
|
|
!extcon_get_state(host_edev, EXTCON_USB_HOST))
|
|
dwc3_qcom_vbus_notifier(&qcom->vbus_nb, true, qcom->edev);
|
|
else
|
|
dwc3_qcom_vbus_notifier(&qcom->vbus_nb, false, qcom->edev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dwc3_qcom_interconnect_enable(struct dwc3_qcom *qcom)
|
|
{
|
|
int ret;
|
|
|
|
ret = icc_enable(qcom->icc_path_ddr);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = icc_enable(qcom->icc_path_apps);
|
|
if (ret)
|
|
icc_disable(qcom->icc_path_ddr);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int dwc3_qcom_interconnect_disable(struct dwc3_qcom *qcom)
|
|
{
|
|
int ret;
|
|
|
|
ret = icc_disable(qcom->icc_path_ddr);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = icc_disable(qcom->icc_path_apps);
|
|
if (ret)
|
|
icc_enable(qcom->icc_path_ddr);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dwc3_qcom_interconnect_init() - Get interconnect path handles
|
|
* and set bandwidth.
|
|
* @qcom: Pointer to the concerned usb core.
|
|
*
|
|
*/
|
|
static int dwc3_qcom_interconnect_init(struct dwc3_qcom *qcom)
|
|
{
|
|
struct device *dev = qcom->dev;
|
|
int ret;
|
|
|
|
if (has_acpi_companion(dev))
|
|
return 0;
|
|
|
|
qcom->icc_path_ddr = of_icc_get(dev, "usb-ddr");
|
|
if (IS_ERR(qcom->icc_path_ddr)) {
|
|
dev_err(dev, "failed to get usb-ddr path: %ld\n",
|
|
PTR_ERR(qcom->icc_path_ddr));
|
|
return PTR_ERR(qcom->icc_path_ddr);
|
|
}
|
|
|
|
qcom->icc_path_apps = of_icc_get(dev, "apps-usb");
|
|
if (IS_ERR(qcom->icc_path_apps)) {
|
|
dev_err(dev, "failed to get apps-usb path: %ld\n",
|
|
PTR_ERR(qcom->icc_path_apps));
|
|
return PTR_ERR(qcom->icc_path_apps);
|
|
}
|
|
|
|
if (usb_get_maximum_speed(&qcom->dwc3->dev) >= USB_SPEED_SUPER ||
|
|
usb_get_maximum_speed(&qcom->dwc3->dev) == USB_SPEED_UNKNOWN)
|
|
ret = icc_set_bw(qcom->icc_path_ddr,
|
|
USB_MEMORY_AVG_SS_BW, USB_MEMORY_PEAK_SS_BW);
|
|
else
|
|
ret = icc_set_bw(qcom->icc_path_ddr,
|
|
USB_MEMORY_AVG_HS_BW, USB_MEMORY_PEAK_HS_BW);
|
|
|
|
if (ret) {
|
|
dev_err(dev, "failed to set bandwidth for usb-ddr path: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
ret = icc_set_bw(qcom->icc_path_apps,
|
|
APPS_USB_AVG_BW, APPS_USB_PEAK_BW);
|
|
if (ret) {
|
|
dev_err(dev, "failed to set bandwidth for apps-usb path: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* dwc3_qcom_interconnect_exit() - Release interconnect path handles
|
|
* @qcom: Pointer to the concerned usb core.
|
|
*
|
|
* This function is used to release interconnect path handle.
|
|
*/
|
|
static void dwc3_qcom_interconnect_exit(struct dwc3_qcom *qcom)
|
|
{
|
|
icc_put(qcom->icc_path_ddr);
|
|
icc_put(qcom->icc_path_apps);
|
|
}
|
|
|
|
static void dwc3_qcom_disable_interrupts(struct dwc3_qcom *qcom)
|
|
{
|
|
if (qcom->hs_phy_irq) {
|
|
disable_irq_wake(qcom->hs_phy_irq);
|
|
disable_irq_nosync(qcom->hs_phy_irq);
|
|
}
|
|
|
|
if (qcom->dp_hs_phy_irq) {
|
|
disable_irq_wake(qcom->dp_hs_phy_irq);
|
|
disable_irq_nosync(qcom->dp_hs_phy_irq);
|
|
}
|
|
|
|
if (qcom->dm_hs_phy_irq) {
|
|
disable_irq_wake(qcom->dm_hs_phy_irq);
|
|
disable_irq_nosync(qcom->dm_hs_phy_irq);
|
|
}
|
|
|
|
if (qcom->ss_phy_irq) {
|
|
disable_irq_wake(qcom->ss_phy_irq);
|
|
disable_irq_nosync(qcom->ss_phy_irq);
|
|
}
|
|
}
|
|
|
|
static void dwc3_qcom_enable_interrupts(struct dwc3_qcom *qcom)
|
|
{
|
|
if (qcom->hs_phy_irq) {
|
|
enable_irq(qcom->hs_phy_irq);
|
|
enable_irq_wake(qcom->hs_phy_irq);
|
|
}
|
|
|
|
if (qcom->dp_hs_phy_irq) {
|
|
enable_irq(qcom->dp_hs_phy_irq);
|
|
enable_irq_wake(qcom->dp_hs_phy_irq);
|
|
}
|
|
|
|
if (qcom->dm_hs_phy_irq) {
|
|
enable_irq(qcom->dm_hs_phy_irq);
|
|
enable_irq_wake(qcom->dm_hs_phy_irq);
|
|
}
|
|
|
|
if (qcom->ss_phy_irq) {
|
|
enable_irq(qcom->ss_phy_irq);
|
|
enable_irq_wake(qcom->ss_phy_irq);
|
|
}
|
|
}
|
|
|
|
static int dwc3_qcom_suspend(struct dwc3_qcom *qcom)
|
|
{
|
|
u32 val;
|
|
int i, ret;
|
|
|
|
if (qcom->is_suspended)
|
|
return 0;
|
|
|
|
val = readl(qcom->qscratch_base + PWR_EVNT_IRQ_STAT_REG);
|
|
if (!(val & PWR_EVNT_LPM_IN_L2_MASK))
|
|
dev_err(qcom->dev, "HS-PHY not in L2\n");
|
|
|
|
for (i = qcom->num_clocks - 1; i >= 0; i--)
|
|
clk_disable_unprepare(qcom->clks[i]);
|
|
|
|
ret = dwc3_qcom_interconnect_disable(qcom);
|
|
if (ret)
|
|
dev_warn(qcom->dev, "failed to disable interconnect: %d\n", ret);
|
|
|
|
if (device_may_wakeup(qcom->dev))
|
|
dwc3_qcom_enable_interrupts(qcom);
|
|
|
|
qcom->is_suspended = true;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dwc3_qcom_resume(struct dwc3_qcom *qcom)
|
|
{
|
|
int ret;
|
|
int i;
|
|
|
|
if (!qcom->is_suspended)
|
|
return 0;
|
|
|
|
if (device_may_wakeup(qcom->dev))
|
|
dwc3_qcom_disable_interrupts(qcom);
|
|
|
|
for (i = 0; i < qcom->num_clocks; i++) {
|
|
ret = clk_prepare_enable(qcom->clks[i]);
|
|
if (ret < 0) {
|
|
while (--i >= 0)
|
|
clk_disable_unprepare(qcom->clks[i]);
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
ret = dwc3_qcom_interconnect_enable(qcom);
|
|
if (ret)
|
|
dev_warn(qcom->dev, "failed to enable interconnect: %d\n", ret);
|
|
|
|
/* Clear existing events from PHY related to L2 in/out */
|
|
dwc3_qcom_setbits(qcom->qscratch_base, PWR_EVNT_IRQ_STAT_REG,
|
|
PWR_EVNT_LPM_IN_L2_MASK | PWR_EVNT_LPM_OUT_L2_MASK);
|
|
|
|
qcom->is_suspended = false;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static irqreturn_t qcom_dwc3_resume_irq(int irq, void *data)
|
|
{
|
|
struct dwc3_qcom *qcom = data;
|
|
struct dwc3 *dwc = platform_get_drvdata(qcom->dwc3);
|
|
|
|
/* If pm_suspended then let pm_resume take care of resuming h/w */
|
|
if (qcom->pm_suspended)
|
|
return IRQ_HANDLED;
|
|
|
|
if (dwc->xhci)
|
|
pm_runtime_resume(&dwc->xhci->dev);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static void dwc3_qcom_select_utmi_clk(struct dwc3_qcom *qcom)
|
|
{
|
|
/* Configure dwc3 to use UTMI clock as PIPE clock not present */
|
|
dwc3_qcom_setbits(qcom->qscratch_base, QSCRATCH_GENERAL_CFG,
|
|
PIPE_UTMI_CLK_DIS);
|
|
|
|
usleep_range(100, 1000);
|
|
|
|
dwc3_qcom_setbits(qcom->qscratch_base, QSCRATCH_GENERAL_CFG,
|
|
PIPE_UTMI_CLK_SEL | PIPE3_PHYSTATUS_SW);
|
|
|
|
usleep_range(100, 1000);
|
|
|
|
dwc3_qcom_clrbits(qcom->qscratch_base, QSCRATCH_GENERAL_CFG,
|
|
PIPE_UTMI_CLK_DIS);
|
|
}
|
|
|
|
static int dwc3_qcom_get_irq(struct platform_device *pdev,
|
|
const char *name, int num)
|
|
{
|
|
struct dwc3_qcom *qcom = platform_get_drvdata(pdev);
|
|
struct platform_device *pdev_irq = qcom->urs_usb ? qcom->urs_usb : pdev;
|
|
struct device_node *np = pdev->dev.of_node;
|
|
int ret;
|
|
|
|
if (np)
|
|
ret = platform_get_irq_byname(pdev_irq, name);
|
|
else
|
|
ret = platform_get_irq(pdev_irq, num);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int dwc3_qcom_setup_irq(struct platform_device *pdev)
|
|
{
|
|
struct dwc3_qcom *qcom = platform_get_drvdata(pdev);
|
|
const struct dwc3_acpi_pdata *pdata = qcom->acpi_pdata;
|
|
int irq;
|
|
int ret;
|
|
|
|
irq = dwc3_qcom_get_irq(pdev, "hs_phy_irq",
|
|
pdata ? pdata->hs_phy_irq_index : -1);
|
|
if (irq > 0) {
|
|
/* Keep wakeup interrupts disabled until suspend */
|
|
irq_set_status_flags(irq, IRQ_NOAUTOEN);
|
|
ret = devm_request_threaded_irq(qcom->dev, irq, NULL,
|
|
qcom_dwc3_resume_irq,
|
|
IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
|
|
"qcom_dwc3 HS", qcom);
|
|
if (ret) {
|
|
dev_err(qcom->dev, "hs_phy_irq failed: %d\n", ret);
|
|
return ret;
|
|
}
|
|
qcom->hs_phy_irq = irq;
|
|
}
|
|
|
|
irq = dwc3_qcom_get_irq(pdev, "dp_hs_phy_irq",
|
|
pdata ? pdata->dp_hs_phy_irq_index : -1);
|
|
if (irq > 0) {
|
|
irq_set_status_flags(irq, IRQ_NOAUTOEN);
|
|
ret = devm_request_threaded_irq(qcom->dev, irq, NULL,
|
|
qcom_dwc3_resume_irq,
|
|
IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
|
|
"qcom_dwc3 DP_HS", qcom);
|
|
if (ret) {
|
|
dev_err(qcom->dev, "dp_hs_phy_irq failed: %d\n", ret);
|
|
return ret;
|
|
}
|
|
qcom->dp_hs_phy_irq = irq;
|
|
}
|
|
|
|
irq = dwc3_qcom_get_irq(pdev, "dm_hs_phy_irq",
|
|
pdata ? pdata->dm_hs_phy_irq_index : -1);
|
|
if (irq > 0) {
|
|
irq_set_status_flags(irq, IRQ_NOAUTOEN);
|
|
ret = devm_request_threaded_irq(qcom->dev, irq, NULL,
|
|
qcom_dwc3_resume_irq,
|
|
IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
|
|
"qcom_dwc3 DM_HS", qcom);
|
|
if (ret) {
|
|
dev_err(qcom->dev, "dm_hs_phy_irq failed: %d\n", ret);
|
|
return ret;
|
|
}
|
|
qcom->dm_hs_phy_irq = irq;
|
|
}
|
|
|
|
irq = dwc3_qcom_get_irq(pdev, "ss_phy_irq",
|
|
pdata ? pdata->ss_phy_irq_index : -1);
|
|
if (irq > 0) {
|
|
irq_set_status_flags(irq, IRQ_NOAUTOEN);
|
|
ret = devm_request_threaded_irq(qcom->dev, irq, NULL,
|
|
qcom_dwc3_resume_irq,
|
|
IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
|
|
"qcom_dwc3 SS", qcom);
|
|
if (ret) {
|
|
dev_err(qcom->dev, "ss_phy_irq failed: %d\n", ret);
|
|
return ret;
|
|
}
|
|
qcom->ss_phy_irq = irq;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int dwc3_qcom_clk_init(struct dwc3_qcom *qcom, int count)
|
|
{
|
|
struct device *dev = qcom->dev;
|
|
struct device_node *np = dev->of_node;
|
|
int i;
|
|
|
|
if (!np || !count)
|
|
return 0;
|
|
|
|
if (count < 0)
|
|
return count;
|
|
|
|
qcom->num_clocks = count;
|
|
|
|
qcom->clks = devm_kcalloc(dev, qcom->num_clocks,
|
|
sizeof(struct clk *), GFP_KERNEL);
|
|
if (!qcom->clks)
|
|
return -ENOMEM;
|
|
|
|
for (i = 0; i < qcom->num_clocks; i++) {
|
|
struct clk *clk;
|
|
int ret;
|
|
|
|
clk = of_clk_get(np, i);
|
|
if (IS_ERR(clk)) {
|
|
while (--i >= 0)
|
|
clk_put(qcom->clks[i]);
|
|
return PTR_ERR(clk);
|
|
}
|
|
|
|
ret = clk_prepare_enable(clk);
|
|
if (ret < 0) {
|
|
while (--i >= 0) {
|
|
clk_disable_unprepare(qcom->clks[i]);
|
|
clk_put(qcom->clks[i]);
|
|
}
|
|
clk_put(clk);
|
|
|
|
return ret;
|
|
}
|
|
|
|
qcom->clks[i] = clk;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct property_entry dwc3_qcom_acpi_properties[] = {
|
|
PROPERTY_ENTRY_STRING("dr_mode", "host"),
|
|
{}
|
|
};
|
|
|
|
static const struct software_node dwc3_qcom_swnode = {
|
|
.properties = dwc3_qcom_acpi_properties,
|
|
};
|
|
|
|
static int dwc3_qcom_acpi_register_core(struct platform_device *pdev)
|
|
{
|
|
struct dwc3_qcom *qcom = platform_get_drvdata(pdev);
|
|
struct device *dev = &pdev->dev;
|
|
struct resource *res, *child_res = NULL;
|
|
struct platform_device *pdev_irq = qcom->urs_usb ? qcom->urs_usb :
|
|
pdev;
|
|
int irq;
|
|
int ret;
|
|
|
|
qcom->dwc3 = platform_device_alloc("dwc3", PLATFORM_DEVID_AUTO);
|
|
if (!qcom->dwc3)
|
|
return -ENOMEM;
|
|
|
|
qcom->dwc3->dev.parent = dev;
|
|
qcom->dwc3->dev.type = dev->type;
|
|
qcom->dwc3->dev.dma_mask = dev->dma_mask;
|
|
qcom->dwc3->dev.dma_parms = dev->dma_parms;
|
|
qcom->dwc3->dev.coherent_dma_mask = dev->coherent_dma_mask;
|
|
|
|
child_res = kcalloc(2, sizeof(*child_res), GFP_KERNEL);
|
|
if (!child_res)
|
|
return -ENOMEM;
|
|
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
if (!res) {
|
|
dev_err(&pdev->dev, "failed to get memory resource\n");
|
|
ret = -ENODEV;
|
|
goto out;
|
|
}
|
|
|
|
child_res[0].flags = res->flags;
|
|
child_res[0].start = res->start;
|
|
child_res[0].end = child_res[0].start +
|
|
qcom->acpi_pdata->dwc3_core_base_size;
|
|
|
|
irq = platform_get_irq(pdev_irq, 0);
|
|
child_res[1].flags = IORESOURCE_IRQ;
|
|
child_res[1].start = child_res[1].end = irq;
|
|
|
|
ret = platform_device_add_resources(qcom->dwc3, child_res, 2);
|
|
if (ret) {
|
|
dev_err(&pdev->dev, "failed to add resources\n");
|
|
goto out;
|
|
}
|
|
|
|
ret = device_add_software_node(&qcom->dwc3->dev, &dwc3_qcom_swnode);
|
|
if (ret < 0) {
|
|
dev_err(&pdev->dev, "failed to add properties\n");
|
|
goto out;
|
|
}
|
|
|
|
ret = platform_device_add(qcom->dwc3);
|
|
if (ret) {
|
|
dev_err(&pdev->dev, "failed to add device\n");
|
|
device_remove_software_node(&qcom->dwc3->dev);
|
|
}
|
|
|
|
out:
|
|
kfree(child_res);
|
|
return ret;
|
|
}
|
|
|
|
static int dwc3_qcom_of_register_core(struct platform_device *pdev)
|
|
{
|
|
struct dwc3_qcom *qcom = platform_get_drvdata(pdev);
|
|
struct device_node *np = pdev->dev.of_node, *dwc3_np;
|
|
struct device *dev = &pdev->dev;
|
|
struct property *prop;
|
|
int ret;
|
|
|
|
dwc3_np = of_get_compatible_child(np, "snps,dwc3");
|
|
if (!dwc3_np) {
|
|
dev_err(dev, "failed to find dwc3 core child\n");
|
|
return -ENODEV;
|
|
}
|
|
|
|
prop = devm_kzalloc(dev, sizeof(*prop), GFP_KERNEL);
|
|
if (!prop) {
|
|
ret = -ENOMEM;
|
|
dev_err(dev, "unable to allocate memory for property\n");
|
|
goto node_put;
|
|
}
|
|
|
|
prop->name = "tx-fifo-resize";
|
|
ret = of_add_property(dwc3_np, prop);
|
|
if (ret) {
|
|
dev_err(dev, "unable to add property\n");
|
|
goto node_put;
|
|
}
|
|
|
|
ret = of_platform_populate(np, NULL, NULL, dev);
|
|
if (ret) {
|
|
dev_err(dev, "failed to register dwc3 core - %d\n", ret);
|
|
goto node_put;
|
|
}
|
|
|
|
qcom->dwc3 = of_find_device_by_node(dwc3_np);
|
|
if (!qcom->dwc3) {
|
|
ret = -ENODEV;
|
|
dev_err(dev, "failed to get dwc3 platform device\n");
|
|
}
|
|
|
|
node_put:
|
|
of_node_put(dwc3_np);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static struct platform_device *
|
|
dwc3_qcom_create_urs_usb_platdev(struct device *dev)
|
|
{
|
|
struct fwnode_handle *fwh;
|
|
struct acpi_device *adev;
|
|
char name[8];
|
|
int ret;
|
|
int id;
|
|
|
|
/* Figure out device id */
|
|
ret = sscanf(fwnode_get_name(dev->fwnode), "URS%d", &id);
|
|
if (!ret)
|
|
return NULL;
|
|
|
|
/* Find the child using name */
|
|
snprintf(name, sizeof(name), "USB%d", id);
|
|
fwh = fwnode_get_named_child_node(dev->fwnode, name);
|
|
if (!fwh)
|
|
return NULL;
|
|
|
|
adev = to_acpi_device_node(fwh);
|
|
if (!adev)
|
|
return NULL;
|
|
|
|
return acpi_create_platform_device(adev, NULL);
|
|
}
|
|
|
|
static int dwc3_qcom_probe(struct platform_device *pdev)
|
|
{
|
|
struct device_node *np = pdev->dev.of_node;
|
|
struct device *dev = &pdev->dev;
|
|
struct dwc3_qcom *qcom;
|
|
struct resource *res, *parent_res = NULL;
|
|
int ret, i;
|
|
bool ignore_pipe_clk;
|
|
|
|
qcom = devm_kzalloc(&pdev->dev, sizeof(*qcom), GFP_KERNEL);
|
|
if (!qcom)
|
|
return -ENOMEM;
|
|
|
|
platform_set_drvdata(pdev, qcom);
|
|
qcom->dev = &pdev->dev;
|
|
|
|
if (has_acpi_companion(dev)) {
|
|
qcom->acpi_pdata = acpi_device_get_match_data(dev);
|
|
if (!qcom->acpi_pdata) {
|
|
dev_err(&pdev->dev, "no supporting ACPI device data\n");
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
qcom->resets = devm_reset_control_array_get_optional_exclusive(dev);
|
|
if (IS_ERR(qcom->resets)) {
|
|
ret = PTR_ERR(qcom->resets);
|
|
dev_err(&pdev->dev, "failed to get resets, err=%d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
ret = reset_control_assert(qcom->resets);
|
|
if (ret) {
|
|
dev_err(&pdev->dev, "failed to assert resets, err=%d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
usleep_range(10, 1000);
|
|
|
|
ret = reset_control_deassert(qcom->resets);
|
|
if (ret) {
|
|
dev_err(&pdev->dev, "failed to deassert resets, err=%d\n", ret);
|
|
goto reset_assert;
|
|
}
|
|
|
|
ret = dwc3_qcom_clk_init(qcom, of_clk_get_parent_count(np));
|
|
if (ret) {
|
|
dev_err(dev, "failed to get clocks\n");
|
|
goto reset_assert;
|
|
}
|
|
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
|
|
if (np) {
|
|
parent_res = res;
|
|
} else {
|
|
parent_res = kmemdup(res, sizeof(struct resource), GFP_KERNEL);
|
|
if (!parent_res)
|
|
return -ENOMEM;
|
|
|
|
parent_res->start = res->start +
|
|
qcom->acpi_pdata->qscratch_base_offset;
|
|
parent_res->end = parent_res->start +
|
|
qcom->acpi_pdata->qscratch_base_size;
|
|
|
|
if (qcom->acpi_pdata->is_urs) {
|
|
qcom->urs_usb = dwc3_qcom_create_urs_usb_platdev(dev);
|
|
if (!qcom->urs_usb) {
|
|
dev_err(dev, "failed to create URS USB platdev\n");
|
|
return -ENODEV;
|
|
}
|
|
}
|
|
}
|
|
|
|
qcom->qscratch_base = devm_ioremap_resource(dev, parent_res);
|
|
if (IS_ERR(qcom->qscratch_base)) {
|
|
ret = PTR_ERR(qcom->qscratch_base);
|
|
goto clk_disable;
|
|
}
|
|
|
|
ret = dwc3_qcom_setup_irq(pdev);
|
|
if (ret) {
|
|
dev_err(dev, "failed to setup IRQs, err=%d\n", ret);
|
|
goto clk_disable;
|
|
}
|
|
|
|
/*
|
|
* Disable pipe_clk requirement if specified. Used when dwc3
|
|
* operates without SSPHY and only HS/FS/LS modes are supported.
|
|
*/
|
|
ignore_pipe_clk = device_property_read_bool(dev,
|
|
"qcom,select-utmi-as-pipe-clk");
|
|
if (ignore_pipe_clk)
|
|
dwc3_qcom_select_utmi_clk(qcom);
|
|
|
|
if (np)
|
|
ret = dwc3_qcom_of_register_core(pdev);
|
|
else
|
|
ret = dwc3_qcom_acpi_register_core(pdev);
|
|
|
|
if (ret) {
|
|
dev_err(dev, "failed to register DWC3 Core, err=%d\n", ret);
|
|
goto depopulate;
|
|
}
|
|
|
|
ret = dwc3_qcom_interconnect_init(qcom);
|
|
if (ret)
|
|
goto depopulate;
|
|
|
|
qcom->mode = usb_get_dr_mode(&qcom->dwc3->dev);
|
|
|
|
/* enable vbus override for device mode */
|
|
if (qcom->mode == USB_DR_MODE_PERIPHERAL)
|
|
dwc3_qcom_vbus_overrride_enable(qcom, true);
|
|
|
|
/* register extcon to override sw_vbus on Vbus change later */
|
|
ret = dwc3_qcom_register_extcon(qcom);
|
|
if (ret)
|
|
goto interconnect_exit;
|
|
|
|
device_init_wakeup(&pdev->dev, 1);
|
|
qcom->is_suspended = false;
|
|
pm_runtime_set_active(dev);
|
|
pm_runtime_enable(dev);
|
|
pm_runtime_forbid(dev);
|
|
|
|
return 0;
|
|
|
|
interconnect_exit:
|
|
dwc3_qcom_interconnect_exit(qcom);
|
|
depopulate:
|
|
if (np)
|
|
of_platform_depopulate(&pdev->dev);
|
|
else
|
|
platform_device_put(pdev);
|
|
clk_disable:
|
|
for (i = qcom->num_clocks - 1; i >= 0; i--) {
|
|
clk_disable_unprepare(qcom->clks[i]);
|
|
clk_put(qcom->clks[i]);
|
|
}
|
|
reset_assert:
|
|
reset_control_assert(qcom->resets);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int dwc3_qcom_remove(struct platform_device *pdev)
|
|
{
|
|
struct dwc3_qcom *qcom = platform_get_drvdata(pdev);
|
|
struct device *dev = &pdev->dev;
|
|
int i;
|
|
|
|
device_remove_software_node(&qcom->dwc3->dev);
|
|
of_platform_depopulate(dev);
|
|
|
|
for (i = qcom->num_clocks - 1; i >= 0; i--) {
|
|
clk_disable_unprepare(qcom->clks[i]);
|
|
clk_put(qcom->clks[i]);
|
|
}
|
|
qcom->num_clocks = 0;
|
|
|
|
dwc3_qcom_interconnect_exit(qcom);
|
|
reset_control_assert(qcom->resets);
|
|
|
|
pm_runtime_allow(dev);
|
|
pm_runtime_disable(dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int __maybe_unused dwc3_qcom_pm_suspend(struct device *dev)
|
|
{
|
|
struct dwc3_qcom *qcom = dev_get_drvdata(dev);
|
|
int ret = 0;
|
|
|
|
ret = dwc3_qcom_suspend(qcom);
|
|
if (!ret)
|
|
qcom->pm_suspended = true;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int __maybe_unused dwc3_qcom_pm_resume(struct device *dev)
|
|
{
|
|
struct dwc3_qcom *qcom = dev_get_drvdata(dev);
|
|
int ret;
|
|
|
|
ret = dwc3_qcom_resume(qcom);
|
|
if (!ret)
|
|
qcom->pm_suspended = false;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int __maybe_unused dwc3_qcom_runtime_suspend(struct device *dev)
|
|
{
|
|
struct dwc3_qcom *qcom = dev_get_drvdata(dev);
|
|
|
|
return dwc3_qcom_suspend(qcom);
|
|
}
|
|
|
|
static int __maybe_unused dwc3_qcom_runtime_resume(struct device *dev)
|
|
{
|
|
struct dwc3_qcom *qcom = dev_get_drvdata(dev);
|
|
|
|
return dwc3_qcom_resume(qcom);
|
|
}
|
|
|
|
static const struct dev_pm_ops dwc3_qcom_dev_pm_ops = {
|
|
SET_SYSTEM_SLEEP_PM_OPS(dwc3_qcom_pm_suspend, dwc3_qcom_pm_resume)
|
|
SET_RUNTIME_PM_OPS(dwc3_qcom_runtime_suspend, dwc3_qcom_runtime_resume,
|
|
NULL)
|
|
};
|
|
|
|
static const struct of_device_id dwc3_qcom_of_match[] = {
|
|
{ .compatible = "qcom,dwc3" },
|
|
{ .compatible = "qcom,msm8996-dwc3" },
|
|
{ .compatible = "qcom,msm8998-dwc3" },
|
|
{ .compatible = "qcom,sdm845-dwc3" },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(of, dwc3_qcom_of_match);
|
|
|
|
#ifdef CONFIG_ACPI
|
|
static const struct dwc3_acpi_pdata sdm845_acpi_pdata = {
|
|
.qscratch_base_offset = SDM845_QSCRATCH_BASE_OFFSET,
|
|
.qscratch_base_size = SDM845_QSCRATCH_SIZE,
|
|
.dwc3_core_base_size = SDM845_DWC3_CORE_SIZE,
|
|
.hs_phy_irq_index = 1,
|
|
.dp_hs_phy_irq_index = 4,
|
|
.dm_hs_phy_irq_index = 3,
|
|
.ss_phy_irq_index = 2
|
|
};
|
|
|
|
static const struct dwc3_acpi_pdata sdm845_acpi_urs_pdata = {
|
|
.qscratch_base_offset = SDM845_QSCRATCH_BASE_OFFSET,
|
|
.qscratch_base_size = SDM845_QSCRATCH_SIZE,
|
|
.dwc3_core_base_size = SDM845_DWC3_CORE_SIZE,
|
|
.hs_phy_irq_index = 1,
|
|
.dp_hs_phy_irq_index = 4,
|
|
.dm_hs_phy_irq_index = 3,
|
|
.ss_phy_irq_index = 2,
|
|
.is_urs = true,
|
|
};
|
|
|
|
static const struct acpi_device_id dwc3_qcom_acpi_match[] = {
|
|
{ "QCOM2430", (unsigned long)&sdm845_acpi_pdata },
|
|
{ "QCOM0304", (unsigned long)&sdm845_acpi_urs_pdata },
|
|
{ "QCOM0497", (unsigned long)&sdm845_acpi_urs_pdata },
|
|
{ "QCOM04A6", (unsigned long)&sdm845_acpi_pdata },
|
|
{ },
|
|
};
|
|
MODULE_DEVICE_TABLE(acpi, dwc3_qcom_acpi_match);
|
|
#endif
|
|
|
|
static struct platform_driver dwc3_qcom_driver = {
|
|
.probe = dwc3_qcom_probe,
|
|
.remove = dwc3_qcom_remove,
|
|
.driver = {
|
|
.name = "dwc3-qcom",
|
|
.pm = &dwc3_qcom_dev_pm_ops,
|
|
.of_match_table = dwc3_qcom_of_match,
|
|
.acpi_match_table = ACPI_PTR(dwc3_qcom_acpi_match),
|
|
},
|
|
};
|
|
|
|
module_platform_driver(dwc3_qcom_driver);
|
|
|
|
MODULE_LICENSE("GPL v2");
|
|
MODULE_DESCRIPTION("DesignWare DWC3 QCOM Glue Driver");
|