Received: by 2002:a5d:9c59:0:0:0:0:0 with SMTP id 25csp2582494iof; Wed, 8 Jun 2022 07:57:50 -0700 (PDT) X-Google-Smtp-Source: ABdhPJx5+lWFaE4qTIYF5NzJ0i6E6LproAjllJ/XhZ9JQARWjmOn9YmatCupPbsL9MOLTvUFYYe3 X-Received: by 2002:a63:fb11:0:b0:3fc:46b9:4c68 with SMTP id o17-20020a63fb11000000b003fc46b94c68mr30241241pgh.327.1654700270548; Wed, 08 Jun 2022 07:57:50 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1654700270; cv=none; d=google.com; s=arc-20160816; b=ule4UfLNfR3j2Jf+zbOIQ4P8oVX8z5J8MWUxZRxPD91yUxgnuAmcbOFyZtqqD5Y6sE KXsp4PUZJxye4abZH/CHXIwzA5VqiVrwXxnhDKZgjR/9iLutsFHY6CHxLmJCEYcLqDhL HbXpA2WZ1v9XpXhLY8mizMgYQAaPdRRoV5ySzeuBJGjmPH7lZuUoT8ax3ZjyO+hwESMS M8rY36a7jlroovYN6okWQqvDbMJNsvP8irTFQbRLwxJfjO2h57EygHyTFeoWTx2EJ3LK JBB0e8PV1lbkne5Nn4OT8pCieL9qz/TCoX/5ufzXnm+4i5mGywJF5m6jNzyRkVQwTGpy +Xgw== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:content-transfer-encoding:in-reply-to:from :references:cc:to:content-language:subject:user-agent:mime-version :date:message-id:dkim-signature; bh=n94KTbDvO4PEWFQndM+SULdaDetWII1DVouQbGrJ5MI=; b=lTr2dDMtnZ+AaT82vq7a80XmBNjwVomtxhfuSGTF+gFCrdSfg5ImRQDJU4ghKeBNxG ugpYBJMA6rRJtg5vASVo4PyiSNssoGfQ/jX3VVTaEOLCbki/RDbPRp9MzC/wi2dGlUrb A32v646N1ItdpB9WKGcbpIIgwSLpeXetytBq7OkCk6YXLLENWeqS8Et3OAGAPtqdjL1L CsmRw/3XWdAGzXJHR0Ckc/5l7gRN4OkcQW+7n+QKNrLOihLd+C69xB0pykS2DKlukyw+ /8QghVA82bqnFgPn0bEPqP+iz/oPaatKRweCw1HsordqDU8pn/LJb8q/1pook10l/za8 V/XA== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@quicinc.com header.s=qcdkim header.b="czzZYvT/"; spf=softfail (google.com: domain of transitioning linux-kernel-owner@vger.kernel.org does not designate 23.128.96.19 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=quicinc.com Return-Path: Received: from lindbergh.monkeyblade.net (lindbergh.monkeyblade.net. [23.128.96.19]) by mx.google.com with ESMTPS id a12-20020a170902eccc00b0015ce3e35354si19133710plh.90.2022.06.08.07.57.50 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Wed, 08 Jun 2022 07:57:50 -0700 (PDT) Received-SPF: softfail (google.com: domain of transitioning linux-kernel-owner@vger.kernel.org does not designate 23.128.96.19 as permitted sender) client-ip=23.128.96.19; Authentication-Results: mx.google.com; dkim=pass header.i=@quicinc.com header.s=qcdkim header.b="czzZYvT/"; spf=softfail (google.com: domain of transitioning linux-kernel-owner@vger.kernel.org does not designate 23.128.96.19 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=quicinc.com Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by lindbergh.monkeyblade.net (Postfix) with ESMTP id CB1883A695C; Wed, 8 Jun 2022 07:30:06 -0700 (PDT) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S241343AbiFHO3w (ORCPT + 99 others); Wed, 8 Jun 2022 10:29:52 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:60536 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S241114AbiFHO3v (ORCPT ); Wed, 8 Jun 2022 10:29:51 -0400 Received: from alexa-out.qualcomm.com (alexa-out.qualcomm.com [129.46.98.28]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 9B27D3A0E74; Wed, 8 Jun 2022 07:29:48 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=quicinc.com; i=@quicinc.com; q=dns/txt; s=qcdkim; t=1654698589; x=1686234589; h=message-id:date:mime-version:subject:to:cc:references: from:in-reply-to:content-transfer-encoding; bh=n94KTbDvO4PEWFQndM+SULdaDetWII1DVouQbGrJ5MI=; b=czzZYvT/mv1I0+BxbIEiLpXSF0fMopOm1G7tIJbq1Umuz4bDGQGTjqEt 0NpCfvADkDjeu4sPgwOOSoy7j8DT4WBY1qokWjUbl3njieskK5EAcuxp3 YaDvTXaUSIq7nURaZ3w+XBrf9hP5YpW6oVQmGruJA5EtVsU/PY3YsHjCS w=; Received: from ironmsg-lv-alpha.qualcomm.com ([10.47.202.13]) by alexa-out.qualcomm.com with ESMTP; 08 Jun 2022 07:29:48 -0700 X-QCInternal: smtphost Received: from nasanex01c.na.qualcomm.com ([10.47.97.222]) by ironmsg-lv-alpha.qualcomm.com with ESMTP/TLS/ECDHE-RSA-AES256-GCM-SHA384; 08 Jun 2022 07:29:47 -0700 Received: from nalasex01a.na.qualcomm.com (10.47.209.196) by nasanex01c.na.qualcomm.com (10.47.97.222) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.2.986.22; Wed, 8 Jun 2022 07:29:47 -0700 Received: from [10.216.34.67] (10.80.80.8) by nalasex01a.na.qualcomm.com (10.47.209.196) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.2.986.22; Wed, 8 Jun 2022 07:29:42 -0700 Message-ID: <2564b493-1c6d-813d-9b35-79f9047d535e@quicinc.com> Date: Wed, 8 Jun 2022 19:59:39 +0530 MIME-Version: 1.0 User-Agent: Mozilla/5.0 (Windows NT 10.0; Win64; x64; rv:91.0) Gecko/20100101 Thunderbird/91.9.0 Subject: Re: [PATCH 3/3] usb: dwc3: Refactor PHY logic to support Multiport Controller Content-Language: en-US To: Andrew Halaney CC: Greg Kroah-Hartman , Rob Herring , Philipp Zabel , "Krzysztof Kozlowski" , Felipe Balbi , Bjorn Andersson , , , , , , References: <1653985217-20953-1-git-send-email-quic_harshq@quicinc.com> <1653985217-20953-4-git-send-email-quic_harshq@quicinc.com> <20220601195311.xvyqzez247djomcr@halaneylaptop> <365b8a54-5177-d728-5a95-dc561c1971ef@quicinc.com> <20220606130426.zcblqxuscpn4p6hm@halaneylaptop> From: Harsh Agarwal In-Reply-To: <20220606130426.zcblqxuscpn4p6hm@halaneylaptop> Content-Type: text/plain; charset="UTF-8"; format=flowed Content-Transfer-Encoding: 7bit X-Originating-IP: [10.80.80.8] X-ClientProxiedBy: nasanex01b.na.qualcomm.com (10.46.141.250) To nalasex01a.na.qualcomm.com (10.47.209.196) X-Spam-Status: No, score=-3.2 required=5.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,HEADER_FROM_DIFFERENT_DOMAINS, MAILING_LIST_MULTI,NICE_REPLY_A,RDNS_NONE,SPF_HELO_NONE, T_SCC_BODY_TEXT_LINE autolearn=unavailable autolearn_force=no version=3.4.6 X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on lindbergh.monkeyblade.net Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org On 6/6/2022 6:34 PM, Andrew Halaney wrote: > On Sun, Jun 05, 2022 at 11:51:38PM +0530, Harsh Agarwal wrote: >> On 6/2/2022 1:23 AM, Andrew Halaney wrote: >>> On Tue, May 31, 2022 at 01:50:17PM +0530, Harsh Agarwal wrote: >>>> Currently the DWC3 driver supports only single port controller >>>> which requires at most 2 PHYs ie HS and SS PHYs. >>>> >>>> But some SOCs have a "multiport" USB DWC3 controller where a >>>> single controller supports multiple ports and each port have >>>> their own PHYs. Refactor PHY logic to support the same. >>>> >>>> Signed-off-by: Harsh Agarwal >>>> --- >>>> drivers/usb/dwc3/core.c | 400 +++++++++++++++++++++++++++++++++------------- >>>> drivers/usb/dwc3/core.h | 12 +- >>>> drivers/usb/dwc3/drd.c | 16 +- >>>> drivers/usb/dwc3/gadget.c | 4 +- >>>> 4 files changed, 305 insertions(+), 127 deletions(-) >>>> >>>> diff --git a/drivers/usb/dwc3/core.c b/drivers/usb/dwc3/core.c >>>> index 5734219..5cc799e 100644 >>>> --- a/drivers/usb/dwc3/core.c >>>> +++ b/drivers/usb/dwc3/core.c >>>> @@ -120,7 +120,7 @@ static void __dwc3_set_mode(struct work_struct *work) >>>> { >>>> struct dwc3 *dwc = work_to_dwc(work); >>>> unsigned long flags; >>>> - int ret; >>>> + int i, ret; >>>> u32 reg; >>>> mutex_lock(&dwc->mutex); >>>> @@ -189,10 +189,13 @@ static void __dwc3_set_mode(struct work_struct *work) >>>> if (ret) { >>>> dev_err(dwc->dev, "failed to initialize host\n"); >>>> } else { >>>> - if (dwc->usb2_phy) >>>> - otg_set_vbus(dwc->usb2_phy->otg, true); >>>> - phy_set_mode(dwc->usb2_generic_phy, PHY_MODE_USB_HOST); >>>> - phy_set_mode(dwc->usb3_generic_phy, PHY_MODE_USB_HOST); >>>> + for (i = 0; i < dwc->num_usb2_phy; i++) { >>>> + if (dwc->usb2_phy[i]) >>>> + otg_set_vbus(dwc->usb2_phy[i]->otg, true); >>>> + phy_set_mode(dwc->usb2_generic_phy[i], PHY_MODE_USB_HOST); >>>> + } >>>> + for (i = 0; i < dwc->num_usb3_phy; i++) >>>> + phy_set_mode(dwc->usb3_generic_phy[i], PHY_MODE_USB_HOST); >>>> if (dwc->dis_split_quirk) { >>>> reg = dwc3_readl(dwc->regs, DWC3_GUCTL3); >>>> reg |= DWC3_GUCTL3_SPLITDISABLE; >>>> @@ -205,10 +208,10 @@ static void __dwc3_set_mode(struct work_struct *work) >>>> dwc3_event_buffers_setup(dwc); >>>> - if (dwc->usb2_phy) >>>> - otg_set_vbus(dwc->usb2_phy->otg, false); >>>> - phy_set_mode(dwc->usb2_generic_phy, PHY_MODE_USB_DEVICE); >>>> - phy_set_mode(dwc->usb3_generic_phy, PHY_MODE_USB_DEVICE); >>>> + if (dwc->usb2_phy[0]) >>>> + otg_set_vbus(dwc->usb2_phy[0]->otg, false); >>>> + phy_set_mode(dwc->usb2_generic_phy[0], PHY_MODE_USB_DEVICE); >>>> + phy_set_mode(dwc->usb3_generic_phy[0], PHY_MODE_USB_DEVICE); >>>> ret = dwc3_gadget_init(dwc); >>>> if (ret) >>>> @@ -656,6 +659,7 @@ static int dwc3_core_ulpi_init(struct dwc3 *dwc) >>>> */ >>>> static int dwc3_phy_setup(struct dwc3 *dwc) >>>> { >>>> + int i; >>>> unsigned int hw_mode; >>>> u32 reg; >>>> @@ -716,7 +720,8 @@ static int dwc3_phy_setup(struct dwc3 *dwc) >>>> if (dwc->dis_del_phy_power_chg_quirk) >>>> reg &= ~DWC3_GUSB3PIPECTL_DEPOCHANGE; >>>> - dwc3_writel(dwc->regs, DWC3_GUSB3PIPECTL(0), reg); >>>> + for (i = 0; i < dwc->num_usb3_phy; i++) >>>> + dwc3_writel(dwc->regs, DWC3_GUSB3PIPECTL(i), reg); >>>> reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYCFG(0)); >>>> @@ -730,7 +735,8 @@ static int dwc3_phy_setup(struct dwc3 *dwc) >>>> } else if (dwc->hsphy_interface && >>>> !strncmp(dwc->hsphy_interface, "ulpi", 4)) { >>>> reg |= DWC3_GUSB2PHYCFG_ULPI_UTMI; >>>> - dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(0), reg); >>>> + for (i = 0; i < dwc->num_usb2_phy; i++) >>>> + dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(i), reg); >>>> } else { >>>> /* Relying on default value. */ >>>> if (!(reg & DWC3_GUSB2PHYCFG_ULPI_UTMI)) >>>> @@ -787,7 +793,8 @@ static int dwc3_phy_setup(struct dwc3 *dwc) >>>> if (dwc->dis_u2_freeclk_exists_quirk) >>>> reg &= ~DWC3_GUSB2PHYCFG_U2_FREECLK_EXISTS; >>>> - dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(0), reg); >>>> + for (i = 0; i < dwc->num_usb2_phy; i++) >>>> + dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(i), reg); >>>> return 0; >>>> } >>>> @@ -826,17 +833,23 @@ static void dwc3_clk_disable(struct dwc3 *dwc) >>>> static void dwc3_core_exit(struct dwc3 *dwc) >>>> { >>>> + int i; >>>> dwc3_event_buffers_cleanup(dwc); >>>> - usb_phy_shutdown(dwc->usb2_phy); >>>> - usb_phy_shutdown(dwc->usb3_phy); >>>> - phy_exit(dwc->usb2_generic_phy); >>>> - phy_exit(dwc->usb3_generic_phy); >>>> + for (i = 0; i < dwc->num_usb2_phy; i++) { >>>> + usb_phy_shutdown(dwc->usb2_phy[i]); >>>> + usb_phy_set_suspend(dwc->usb2_phy[i], 1); >>>> + phy_exit(dwc->usb2_generic_phy[i]); >>>> + phy_power_off(dwc->usb2_generic_phy[i]); >>>> + } >>>> + >>>> + for (i = 0; i < dwc->num_usb3_phy; i++) { >>>> + usb_phy_shutdown(dwc->usb3_phy[i]); >>>> + usb_phy_set_suspend(dwc->usb3_phy[i], 1); >>>> + phy_exit(dwc->usb3_generic_phy[i]); >>>> + phy_power_off(dwc->usb3_generic_phy[i]); >>>> + } >>>> - usb_phy_set_suspend(dwc->usb2_phy, 1); >>>> - usb_phy_set_suspend(dwc->usb3_phy, 1); >>>> - phy_power_off(dwc->usb2_generic_phy); >>>> - phy_power_off(dwc->usb3_generic_phy); >>>> dwc3_clk_disable(dwc); >>>> reset_control_assert(dwc->reset); >>>> } >>>> @@ -1039,7 +1052,7 @@ static int dwc3_core_init(struct dwc3 *dwc) >>>> { >>>> unsigned int hw_mode; >>>> u32 reg; >>>> - int ret; >>>> + int ret, i; >>>> hw_mode = DWC3_GHWPARAMS0_MODE(dwc->hwparams.hwparams0); >>>> @@ -1067,16 +1080,24 @@ static int dwc3_core_init(struct dwc3 *dwc) >>>> dwc->phys_ready = true; >>>> } >>>> - usb_phy_init(dwc->usb2_phy); >>>> - usb_phy_init(dwc->usb3_phy); >>>> - ret = phy_init(dwc->usb2_generic_phy); >>>> - if (ret < 0) >>>> - goto err0a; >>>> + for (i = 0; i < dwc->num_usb2_phy; i++) >>>> + usb_phy_init(dwc->usb2_phy[i]); >>>> + for (i = 0; i < dwc->num_usb3_phy; i++) >>>> + usb_phy_init(dwc->usb3_phy[i]); >>>> - ret = phy_init(dwc->usb3_generic_phy); >>>> - if (ret < 0) { >>>> - phy_exit(dwc->usb2_generic_phy); >>>> - goto err0a; >>>> + for (i = 0; i < dwc->num_usb2_phy; i++) { >>>> + ret = phy_init(dwc->usb2_generic_phy[i]); >>>> + if (ret < 0) >>>> + goto err0a; >>> Should we clean up the prior phys that did not fail? There's a couple >>> loops where that question stands in this patch. >> I am just keeping the Generic PHY implementation as is. >> Earlier also we were cleaning up the HS PHY incase >> SS PHY fails, so keeping the same for Multiport. >> For you please point out if you find any major concern here? > Earlier, there was only one usb2_generic_phy/usb3_generic_phy, so if > phy_init(usb2_generic_phy) returned an error, it wasn't initialized, and > it did not need a matching call to phy_exit(usb2_generic_phy). > > That is being called though ifthe superspeed phy fails since the > highspeed one did successfully init, so things are cleaned up in the > old cases. > > My point now is that, say with 4 highspeed phys, the 3rd one fails. > i.e. phy_init(usb2_generic_phy[i]) where i == 2. In that case we don't > ever call phy_exit() on the first two phys. I wouldn't say it is a > major concern, but cleanup here is not fully done. > > You could do something like this to do clean it all up, kind of annoying > though: > > for (i = 0; i < dwc->num_usb2_phy; i++) { > ret = phy_init(dwc->usb2_generic_phy[i]); > if (ret < 0) { > /* clean up prior phys we initialized */ > for (j = 0; j < i; j++) > phy_exit(usb2_generic_phy[j]); > goto err0a; > } > } > > Thanks, > Andrew yes agree with your analysis. Also, if any SSPHY init fails, then clear already initialized SSPHYs and HSPHYs. I am thinking instead of adding all this logic, we can just do "goto err1" instead of "goto err0a". Similar approach if usb_phy_init fails ( Non-Generic phys) > >>>> + } >>>> + >>>> + for (i = 0; i < dwc->num_usb3_phy; i++) { >>>> + ret = phy_init(dwc->usb3_generic_phy[i]); >>>> + if (ret < 0) { >>>> + for (i = 0; i < dwc->num_usb2_phy; i++) >>>> + phy_exit(dwc->usb2_generic_phy[i]); >>>> + goto err0a; >>>> + } >>>> } >>>> ret = dwc3_core_soft_reset(dwc); >>>> @@ -1086,15 +1107,19 @@ static int dwc3_core_init(struct dwc3 *dwc) >>>> if (hw_mode == DWC3_GHWPARAMS0_MODE_DRD && >>>> !DWC3_VER_IS_WITHIN(DWC3, ANY, 194A)) { >>>> if (!dwc->dis_u3_susphy_quirk) { >>>> - reg = dwc3_readl(dwc->regs, DWC3_GUSB3PIPECTL(0)); >>>> - reg |= DWC3_GUSB3PIPECTL_SUSPHY; >>>> - dwc3_writel(dwc->regs, DWC3_GUSB3PIPECTL(0), reg); >>>> + for (i = 0; i < dwc->num_usb3_phy; i++) { >>>> + reg = dwc3_readl(dwc->regs, DWC3_GUSB3PIPECTL(i)); >>>> + reg |= DWC3_GUSB3PIPECTL_SUSPHY; >>>> + dwc3_writel(dwc->regs, DWC3_GUSB3PIPECTL(i), reg); >>>> + } >>>> } >>>> if (!dwc->dis_u2_susphy_quirk) { >>>> - reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYCFG(0)); >>>> - reg |= DWC3_GUSB2PHYCFG_SUSPHY; >>>> - dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(0), reg); >>>> + for (i = 0; i < dwc->num_usb2_phy; i++) { >>>> + reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYCFG(i)); >>>> + reg |= DWC3_GUSB2PHYCFG_SUSPHY; >>>> + dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(i), reg); >>>> + } >>>> } >>>> } >>>> @@ -1113,15 +1138,19 @@ static int dwc3_core_init(struct dwc3 *dwc) >>>> dwc3_set_incr_burst_type(dwc); >>>> - usb_phy_set_suspend(dwc->usb2_phy, 0); >>>> - usb_phy_set_suspend(dwc->usb3_phy, 0); >>>> - ret = phy_power_on(dwc->usb2_generic_phy); >>>> - if (ret < 0) >>>> - goto err2; >>>> + for (i = 0; i < dwc->num_usb2_phy; i++) { >>>> + usb_phy_set_suspend(dwc->usb2_phy[i], 0); >>>> + ret = phy_power_on(dwc->usb2_generic_phy[i]); >>>> + if (ret < 0) >>>> + goto err2; >>>> + } >>>> - ret = phy_power_on(dwc->usb3_generic_phy); >>>> - if (ret < 0) >>>> - goto err3; >>>> + for (i = 0; i < dwc->num_usb3_phy; i++) { >>>> + usb_phy_set_suspend(dwc->usb3_phy[i], 0); >>>> + ret = phy_power_on(dwc->usb3_generic_phy[i]); >>>> + if (ret < 0) >>>> + goto err3; >>>> + } >>>> ret = dwc3_event_buffers_setup(dwc); >>>> if (ret) { >>>> @@ -1229,20 +1258,29 @@ static int dwc3_core_init(struct dwc3 *dwc) >>>> return 0; >>>> err4: >>>> - phy_power_off(dwc->usb3_generic_phy); >>>> + for (i = 0; i < dwc->num_usb3_phy; i++) >>>> + phy_power_off(dwc->usb3_generic_phy[i]); >>>> err3: >>>> - phy_power_off(dwc->usb2_generic_phy); >>>> + for (i = 0; i < dwc->num_usb2_phy; i++) >>>> + phy_power_off(dwc->usb2_generic_phy[i]); >>>> err2: >>>> - usb_phy_set_suspend(dwc->usb2_phy, 1); >>>> - usb_phy_set_suspend(dwc->usb3_phy, 1); >>>> + for (i = 0; i < dwc->num_usb2_phy; i++) >>>> + usb_phy_set_suspend(dwc->usb2_phy[i], 1); >>>> + for (i = 0; i < dwc->num_usb3_phy; i++) >>>> + usb_phy_set_suspend(dwc->usb3_phy[i], 1); >>>> err1: >>>> - usb_phy_shutdown(dwc->usb2_phy); >>>> - usb_phy_shutdown(dwc->usb3_phy); >>>> - phy_exit(dwc->usb2_generic_phy); >>>> - phy_exit(dwc->usb3_generic_phy); >>>> + for (i = 0; i < dwc->num_usb2_phy; i++) { >>>> + usb_phy_shutdown(dwc->usb2_phy[i]); >>>> + phy_exit(dwc->usb2_generic_phy[i]); >>>> + } >>>> + >>>> + for (i = 0; i < dwc->num_usb3_phy; i++) { >>>> + usb_phy_shutdown(dwc->usb3_phy[i]); >>>> + phy_exit(dwc->usb3_generic_phy[i]); >>>> + } >>>> err0a: >>>> dwc3_ulpi_exit(dwc); >>>> @@ -1251,53 +1289,172 @@ static int dwc3_core_init(struct dwc3 *dwc) >>>> return ret; >>>> } >>>> -static int dwc3_core_get_phy(struct dwc3 *dwc) >>>> +static struct usb_phy *dwc3_core_get_phy_by_handle_with_node(struct device *dev, >>>> + const char *phandle, u8 index, struct device_node *lookup_node) >>>> +{ >>>> + struct device_node *node; >>>> + struct usb_phy *phy; >>>> + >>>> + node = of_parse_phandle(lookup_node, phandle, index); >>>> + if (!node) { >>>> + dev_err(dev, "failed to get %s phandle in %pOF node\n", phandle, >>>> + dev->of_node); >>>> + return ERR_PTR(-ENODEV); >>>> + } >>>> + phy = devm_usb_get_phy_by_node(dev, node, NULL); >>>> + of_node_put(node); >>>> + return phy; >>>> +} >>>> + >>>> +static int dwc3_count_phys(struct dwc3 *dwc, struct device_node *lookup_node) >>>> +{ >>>> + int count; >>>> + >>>> + count = of_count_phandle_with_args(lookup_node, "phys", NULL); >>>> + >>>> + if (count == -ENOENT) >>>> + count = of_count_phandle_with_args(lookup_node, "usb-phy", NULL); >>>> + >>>> + if (count == 1) { >>>> + dwc->num_usb2_phy++; >>>> + } else if (count == 2) { >>>> + dwc->num_usb2_phy++; >>>> + dwc->num_usb3_phy++; >>>> + } else { >>>> + return count; >>>> + } >>>> + return 0; >>>> +} >>>> + >>>> +static int dwc3_extract_num_phys(struct dwc3 *dwc) >>>> +{ >>>> + struct device_node *ports, *port; >>>> + int ret; >>>> + >>>> + /* Find if any "multiport" child is present inside DWC3*/ >>> Nit, space after DWC3 >> Done >>>> + for_each_available_child_of_node(dwc->dev->of_node, ports) { >>>> + if (!strcmp(ports->name, "multiport")) >>>> + break; >>>> + } >>>> + if (!ports) { >>>> + dwc->num_usb2_phy = 1; >>>> + dwc->num_usb3_phy = 1; >>>> + } else { >>>> + for_each_available_child_of_node(ports, port) { >>>> + ret = dwc3_count_phys(dwc, port); >>>> + if (ret) >>>> + return ret; >>>> + } >>>> + } >>>> + dev_info(dwc->dev, "Num of HS and SS PHY are %u %u\n", dwc->num_usb2_phy, >>>> + dwc->num_usb3_phy); >>>> + >>>> + dwc->usb2_phy = devm_kzalloc(dwc->dev, >>>> + sizeof(*dwc->usb2_phy) * dwc->num_usb2_phy, GFP_KERNEL); >>>> + if (!dwc->usb2_phy) >>>> + return -ENOMEM; >>>> + >>>> + dwc->usb3_phy = devm_kzalloc(dwc->dev, >>>> + sizeof(*dwc->usb3_phy) * dwc->num_usb3_phy, GFP_KERNEL); >>>> + if (!dwc->usb3_phy) >>>> + return -ENOMEM; >>>> + >>>> + dwc->usb2_generic_phy = devm_kzalloc(dwc->dev, >>>> + sizeof(*dwc->usb2_generic_phy) * dwc->num_usb2_phy, GFP_KERNEL); >>>> + if (!dwc->usb2_generic_phy) >>>> + return -ENOMEM; >>>> + >>>> + dwc->usb3_generic_phy = devm_kzalloc(dwc->dev, >>>> + sizeof(*dwc->usb3_generic_phy) * dwc->num_usb3_phy, GFP_KERNEL); >>>> + if (!dwc->usb3_generic_phy) >>>> + return -ENOMEM; >>>> + >>>> + return 0; >>>> +} >>>> + >>>> +static int dwc3_core_get_phy_by_node(struct dwc3 *dwc, >>>> + struct device_node *lookup_node, int i) >>>> { >>>> struct device *dev = dwc->dev; >>>> - struct device_node *node = dev->of_node; >>>> - int ret; >>>> + int ret; >>>> - if (node) { >>>> - dwc->usb2_phy = devm_usb_get_phy_by_phandle(dev, "usb-phy", 0); >>>> - dwc->usb3_phy = devm_usb_get_phy_by_phandle(dev, "usb-phy", 1); >>>> + if (lookup_node) { >>>> + dwc->usb2_phy[i] = devm_of_usb_get_phy_by_phandle(dev, >>>> + "usb-phy", 0, lookup_node); >>>> + dwc->usb3_phy[i] = devm_of_usb_get_phy_by_phandle(dev, >>>> + "usb-phy", 1, lookup_node); >>>> } else { >>>> - dwc->usb2_phy = devm_usb_get_phy(dev, USB_PHY_TYPE_USB2); >>>> - dwc->usb3_phy = devm_usb_get_phy(dev, USB_PHY_TYPE_USB3); >>>> + dwc->usb2_phy[i] = devm_usb_get_phy(dev, USB_PHY_TYPE_USB2); >>>> + dwc->usb3_phy[i] = devm_usb_get_phy(dev, USB_PHY_TYPE_USB3); >>>> } >>>> - if (IS_ERR(dwc->usb2_phy)) { >>>> - ret = PTR_ERR(dwc->usb2_phy); >>>> + if (IS_ERR(dwc->usb2_phy[i])) { >>>> + ret = PTR_ERR(dwc->usb2_phy[i]); >>>> if (ret == -ENXIO || ret == -ENODEV) >>>> - dwc->usb2_phy = NULL; >>>> + dwc->usb2_phy[i] = NULL; >>>> else >>>> return dev_err_probe(dev, ret, "no usb2 phy configured\n"); >>>> } >>>> - if (IS_ERR(dwc->usb3_phy)) { >>>> - ret = PTR_ERR(dwc->usb3_phy); >>>> + if (IS_ERR(dwc->usb3_phy[i])) { >>>> + ret = PTR_ERR(dwc->usb3_phy[i]); >>>> if (ret == -ENXIO || ret == -ENODEV) >>>> - dwc->usb3_phy = NULL; >>>> + dwc->usb3_phy[i] = NULL; >>>> else >>>> return dev_err_probe(dev, ret, "no usb3 phy configured\n"); >>>> } >>>> - dwc->usb2_generic_phy = devm_phy_get(dev, "usb2-phy"); >>>> - if (IS_ERR(dwc->usb2_generic_phy)) { >>>> - ret = PTR_ERR(dwc->usb2_generic_phy); >>>> - if (ret == -ENOSYS || ret == -ENODEV) >>>> - dwc->usb2_generic_phy = NULL; >>>> + dwc->usb2_generic_phy[i] = devm_of_phy_get(dev, lookup_node, "usb2-phy"); >>>> + if (IS_ERR(dwc->usb2_generic_phy[i])) { >>>> + ret = PTR_ERR(dwc->usb2_generic_phy[i]); >>>> + if (ret == -ENODEV) >>> I think this can be -ENOSYS if !CONFIG_GENERIC_PHY >> For now, I have added it back >>>> + dwc->usb2_generic_phy[i] = NULL; >>>> else >>>> return dev_err_probe(dev, ret, "no usb2 phy configured\n"); >>>> } >>>> - dwc->usb3_generic_phy = devm_phy_get(dev, "usb3-phy"); >>>> - if (IS_ERR(dwc->usb3_generic_phy)) { >>>> - ret = PTR_ERR(dwc->usb3_generic_phy); >>>> - if (ret == -ENOSYS || ret == -ENODEV) >>>> - dwc->usb3_generic_phy = NULL; >>>> + dwc->usb3_generic_phy[i] = devm_of_phy_get(dev, lookup_node, "usb3-phy"); >>>> + if (IS_ERR(dwc->usb3_generic_phy[i])) { >>>> + ret = PTR_ERR(dwc->usb3_generic_phy[i]); >>>> + if (ret == -ENODEV) >>>> + dwc->usb3_generic_phy[i] = NULL; >>>> else >>>> return dev_err_probe(dev, ret, "no usb3 phy configured\n"); >>>> } >>>> + return 0; >>>> +} >>>> + >>>> +static int dwc3_core_get_phy(struct dwc3 *dwc) >>>> +{ >>>> + struct device *dev = dwc->dev; >>>> + struct device_node *node = dev->of_node; >>>> + struct device_node *ports, *port; >>>> + int ret, i = 0; >>>> + >>>> + ret = dwc3_extract_num_phys(dwc); >>>> + if (ret) { >>>> + dev_err(dwc->dev, "Unable to extract number of PHYs\n"); >>>> + return ret; >>>> + } >>>> + >>>> + /* Find if any "multiport" child is present inside DWC3*/ >>> Nit, space after DWC3 >> Done >>>> + for_each_available_child_of_node(node, ports) { >>>> + if (!strcmp(ports->name, "multiport")) >>>> + break; >>>> + } >>>> + >>>> + if (!ports) { >>>> + ret = dwc3_core_get_phy_by_node(dwc, node, 0); >>>> + if (ret) >>>> + return ret; >>>> + } else { >>>> + for_each_available_child_of_node(ports, port) { >>>> + ret = dwc3_core_get_phy_by_node(dwc, port, i); >>>> + if (ret) >>>> + return ret; >>>> + i++; >>>> + } >>>> + } >>>> return 0; >>>> } >>>> @@ -1305,16 +1462,16 @@ static int dwc3_core_get_phy(struct dwc3 *dwc) >>>> static int dwc3_core_init_mode(struct dwc3 *dwc) >>>> { >>>> struct device *dev = dwc->dev; >>>> - int ret; >>>> + int i, ret; >>>> switch (dwc->dr_mode) { >>>> case USB_DR_MODE_PERIPHERAL: >>>> dwc3_set_prtcap(dwc, DWC3_GCTL_PRTCAP_DEVICE); >>>> - if (dwc->usb2_phy) >>>> - otg_set_vbus(dwc->usb2_phy->otg, false); >>>> - phy_set_mode(dwc->usb2_generic_phy, PHY_MODE_USB_DEVICE); >>>> - phy_set_mode(dwc->usb3_generic_phy, PHY_MODE_USB_DEVICE); >>>> + if (dwc->usb2_phy[0]) >>>> + otg_set_vbus(dwc->usb2_phy[0]->otg, false); >>>> + phy_set_mode(dwc->usb2_generic_phy[0], PHY_MODE_USB_DEVICE); >>>> + phy_set_mode(dwc->usb3_generic_phy[0], PHY_MODE_USB_DEVICE); >>>> ret = dwc3_gadget_init(dwc); >>>> if (ret) >>>> @@ -1323,10 +1480,15 @@ static int dwc3_core_init_mode(struct dwc3 *dwc) >>>> case USB_DR_MODE_HOST: >>>> dwc3_set_prtcap(dwc, DWC3_GCTL_PRTCAP_HOST); >>>> - if (dwc->usb2_phy) >>>> - otg_set_vbus(dwc->usb2_phy->otg, true); >>>> - phy_set_mode(dwc->usb2_generic_phy, PHY_MODE_USB_HOST); >>>> - phy_set_mode(dwc->usb3_generic_phy, PHY_MODE_USB_HOST); >>>> + for (i = 0; i < dwc->num_usb3_phy; i++) { >>>> + if (dwc->usb2_phy[i]) >>>> + otg_set_vbus(dwc->usb2_phy[i]->otg, true); >>>> + phy_set_mode(dwc->usb2_generic_phy[i], PHY_MODE_USB_HOST); >>>> + } >>>> + >>>> + >>>> + for (i = 0; i < dwc->num_usb3_phy; i++) >>>> + phy_set_mode(dwc->usb3_generic_phy[i], PHY_MODE_USB_HOST); >>>> ret = dwc3_host_init(dwc); >>>> if (ret) >>>> @@ -1674,7 +1836,7 @@ static int dwc3_probe(struct platform_device *pdev) >>>> struct resource *res, dwc_res; >>>> struct dwc3 *dwc; >>>> - int ret; >>>> + int ret, i; >>>> void __iomem *regs; >>>> @@ -1839,15 +2001,18 @@ static int dwc3_probe(struct platform_device *pdev) >>>> dwc3_debugfs_exit(dwc); >>>> dwc3_event_buffers_cleanup(dwc); >>>> - usb_phy_shutdown(dwc->usb2_phy); >>>> - usb_phy_shutdown(dwc->usb3_phy); >>>> - phy_exit(dwc->usb2_generic_phy); >>>> - phy_exit(dwc->usb3_generic_phy); >>>> - >>>> - usb_phy_set_suspend(dwc->usb2_phy, 1); >>>> - usb_phy_set_suspend(dwc->usb3_phy, 1); >>>> - phy_power_off(dwc->usb2_generic_phy); >>>> - phy_power_off(dwc->usb3_generic_phy); >>>> + for (i = 0; i < dwc->num_usb2_phy; i++) { >>>> + usb_phy_shutdown(dwc->usb2_phy[i]); >>>> + usb_phy_set_suspend(dwc->usb2_phy[i], 1); >>>> + phy_exit(dwc->usb2_generic_phy[i]); >>>> + phy_power_off(dwc->usb2_generic_phy[i]); >>>> + } >>>> + for (i = 0; i < dwc->num_usb3_phy; i++) { >>>> + usb_phy_shutdown(dwc->usb3_phy[i]); >>>> + usb_phy_set_suspend(dwc->usb3_phy[i], 1); >>>> + phy_exit(dwc->usb3_generic_phy[i]); >>>> + phy_power_off(dwc->usb3_generic_phy[i]); >>>> + } >>>> dwc3_ulpi_exit(dwc); >>>> @@ -1929,6 +2094,7 @@ static int dwc3_core_init_for_resume(struct dwc3 *dwc) >>>> static int dwc3_suspend_common(struct dwc3 *dwc, pm_message_t msg) >>>> { >>>> + int i; >>>> unsigned long flags; >>>> u32 reg; >>>> @@ -1951,17 +2117,21 @@ static int dwc3_suspend_common(struct dwc3 *dwc, pm_message_t msg) >>>> /* Let controller to suspend HSPHY before PHY driver suspends */ >>>> if (dwc->dis_u2_susphy_quirk || >>>> dwc->dis_enblslpm_quirk) { >>>> - reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYCFG(0)); >>>> - reg |= DWC3_GUSB2PHYCFG_ENBLSLPM | >>>> - DWC3_GUSB2PHYCFG_SUSPHY; >>>> - dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(0), reg); >>>> - >>>> - /* Give some time for USB2 PHY to suspend */ >>>> - usleep_range(5000, 6000); >>>> + for (i = 0; i < dwc->num_usb2_phy; i++) { >>>> + reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYCFG(i)); >>>> + reg |= DWC3_GUSB2PHYCFG_ENBLSLPM | >>>> + DWC3_GUSB2PHYCFG_SUSPHY; >>>> + dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(i), reg); >>>> + >>>> + /* Give some time for USB2 PHY to suspend */ >>>> + usleep_range(5000, 6000); >>>> + } >>>> } >>>> - phy_pm_runtime_put_sync(dwc->usb2_generic_phy); >>>> - phy_pm_runtime_put_sync(dwc->usb3_generic_phy); >>>> + for (i = 0; i < dwc->num_usb2_phy; i++) >>>> + phy_pm_runtime_put_sync(dwc->usb2_generic_phy[i]); >>>> + for (i = 0; i < dwc->num_usb3_phy; i++) >>>> + phy_pm_runtime_put_sync(dwc->usb3_generic_phy[i]); >>>> break; >>>> case DWC3_GCTL_PRTCAP_OTG: >>>> /* do nothing during runtime_suspend */ >>>> @@ -1989,7 +2159,7 @@ static int dwc3_suspend_common(struct dwc3 *dwc, pm_message_t msg) >>>> static int dwc3_resume_common(struct dwc3 *dwc, pm_message_t msg) >>>> { >>>> unsigned long flags; >>>> - int ret; >>>> + int i, ret; >>>> u32 reg; >>>> switch (dwc->current_dr_role) { >>>> @@ -2012,17 +2182,21 @@ static int dwc3_resume_common(struct dwc3 *dwc, pm_message_t msg) >>>> break; >>>> } >>>> /* Restore GUSB2PHYCFG bits that were modified in suspend */ >>>> - reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYCFG(0)); >>>> - if (dwc->dis_u2_susphy_quirk) >>>> - reg &= ~DWC3_GUSB2PHYCFG_SUSPHY; >>>> + for (i = 0; i < dwc->num_usb2_phy; i++) { >>>> + reg = dwc3_readl(dwc->regs, DWC3_GUSB2PHYCFG(i)); >>>> + if (dwc->dis_u2_susphy_quirk) >>>> + reg &= ~DWC3_GUSB2PHYCFG_SUSPHY; >>>> - if (dwc->dis_enblslpm_quirk) >>>> - reg &= ~DWC3_GUSB2PHYCFG_ENBLSLPM; >>>> + if (dwc->dis_enblslpm_quirk) >>>> + reg &= ~DWC3_GUSB2PHYCFG_ENBLSLPM; >>>> - dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(0), reg); >>>> + dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(i), reg); >>>> + } >>>> - phy_pm_runtime_get_sync(dwc->usb2_generic_phy); >>>> - phy_pm_runtime_get_sync(dwc->usb3_generic_phy); >>>> + for (i = 0; i < dwc->num_usb2_phy; i++) >>>> + phy_pm_runtime_get_sync(dwc->usb2_generic_phy[i]); >>>> + for (i = 0; i < dwc->num_usb3_phy; i++) >>>> + phy_pm_runtime_get_sync(dwc->usb3_generic_phy[i]); >>>> break; >>>> case DWC3_GCTL_PRTCAP_OTG: >>>> /* nothing to do on runtime_resume */ >>>> diff --git a/drivers/usb/dwc3/core.h b/drivers/usb/dwc3/core.h >>>> index 81c486b..c169bf1 100644 >>>> --- a/drivers/usb/dwc3/core.h >>>> +++ b/drivers/usb/dwc3/core.h >>>> @@ -1020,6 +1020,8 @@ struct dwc3_scratchpad_array { >>>> * @usb_psy: pointer to power supply interface. >>>> * @usb2_phy: pointer to USB2 PHY >>>> * @usb3_phy: pointer to USB3 PHY >>>> + * @num_usb2_phy: Number of HS ports controlled by the core >>>> + * @num_dsphy: Number of SS ports controlled by the core >>> s/num_dsphy/num_usb3_phy/ >> Done >>>> * @usb2_generic_phy: pointer to USB2 PHY >>>> * @usb3_generic_phy: pointer to USB3 PHY >>>> * @phys_ready: flag to indicate that PHYs are ready >>>> @@ -1147,11 +1149,13 @@ struct dwc3 { >>>> struct reset_control *reset; >>>> - struct usb_phy *usb2_phy; >>>> - struct usb_phy *usb3_phy; >>>> + struct usb_phy **usb2_phy; >>>> + struct usb_phy **usb3_phy; >>>> + u32 num_usb2_phy; >>>> + u32 num_usb3_phy; >>>> - struct phy *usb2_generic_phy; >>>> - struct phy *usb3_generic_phy; >>>> + struct phy **usb2_generic_phy; >>>> + struct phy **usb3_generic_phy; >>>> bool phys_ready; >>>> diff --git a/drivers/usb/dwc3/drd.c b/drivers/usb/dwc3/drd.c >>>> index 039bf24..404643f 100644 >>>> --- a/drivers/usb/dwc3/drd.c >>>> +++ b/drivers/usb/dwc3/drd.c >>>> @@ -384,10 +384,10 @@ void dwc3_otg_update(struct dwc3 *dwc, bool ignore_idstatus) >>>> if (ret) { >>>> dev_err(dwc->dev, "failed to initialize host\n"); >>>> } else { >>>> - if (dwc->usb2_phy) >>>> - otg_set_vbus(dwc->usb2_phy->otg, true); >>>> - if (dwc->usb2_generic_phy) >>>> - phy_set_mode(dwc->usb2_generic_phy, >>>> + if (dwc->usb2_phy[0]) >>>> + otg_set_vbus(dwc->usb2_phy[0]->otg, true); >>>> + if (dwc->usb2_generic_phy[0]) >>>> + phy_set_mode(dwc->usb2_generic_phy[0], >>>> PHY_MODE_USB_HOST); >>>> } >>>> break; >>>> @@ -398,10 +398,10 @@ void dwc3_otg_update(struct dwc3 *dwc, bool ignore_idstatus) >>>> dwc3_event_buffers_setup(dwc); >>>> spin_unlock_irqrestore(&dwc->lock, flags); >>>> - if (dwc->usb2_phy) >>>> - otg_set_vbus(dwc->usb2_phy->otg, false); >>>> - if (dwc->usb2_generic_phy) >>>> - phy_set_mode(dwc->usb2_generic_phy, >>>> + if (dwc->usb2_phy[0]) >>>> + otg_set_vbus(dwc->usb2_phy[0]->otg, false); >>>> + if (dwc->usb2_generic_phy[0]) >>>> + phy_set_mode(dwc->usb2_generic_phy[0], >>>> PHY_MODE_USB_DEVICE); >>>> ret = dwc3_gadget_init(dwc); >>>> if (ret) >>>> diff --git a/drivers/usb/dwc3/gadget.c b/drivers/usb/dwc3/gadget.c >>>> index 00427d1..e3b2a17 100644 >>>> --- a/drivers/usb/dwc3/gadget.c >>>> +++ b/drivers/usb/dwc3/gadget.c >>>> @@ -2872,8 +2872,8 @@ static int dwc3_gadget_vbus_draw(struct usb_gadget *g, unsigned int mA) >>>> union power_supply_propval val = {0}; >>>> int ret; >>>> - if (dwc->usb2_phy) >>>> - return usb_phy_set_power(dwc->usb2_phy, mA); >>>> + if (dwc->usb2_phy[0]) >>>> + return usb_phy_set_power(dwc->usb2_phy[0], mA); >>>> if (!dwc->usb_psy) >>>> return -EOPNOTSUPP; >>>> -- >>>> 2.7.4 >>>>