From patchwork Fri Feb 22 20:12:25 2019 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Parshuram Raju Thombare X-Patchwork-Id: 1047109 X-Patchwork-Delegate: davem@davemloft.net Return-Path: X-Original-To: patchwork-incoming-netdev@ozlabs.org Delivered-To: patchwork-incoming-netdev@ozlabs.org Authentication-Results: ozlabs.org; spf=none (mailfrom) smtp.mailfrom=vger.kernel.org (client-ip=209.132.180.67; helo=vger.kernel.org; envelope-from=netdev-owner@vger.kernel.org; receiver=) Authentication-Results: ozlabs.org; dmarc=pass (p=none dis=none) header.from=cadence.com Authentication-Results: ozlabs.org; dkim=pass (2048-bit key; unprotected) header.d=cadence.com header.i=@cadence.com header.b="OuHY1HYi"; dkim=pass (1024-bit key; unprotected) header.d=cadence.com header.i=@cadence.com header.b="PGhPzSWG"; dkim-atps=neutral Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by ozlabs.org (Postfix) with ESMTP id 445jF914GKz9sBL for ; Sat, 23 Feb 2019 07:12:45 +1100 (AEDT) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1726974AbfBVUMk (ORCPT ); Fri, 22 Feb 2019 15:12:40 -0500 Received: from mx0b-0014ca01.pphosted.com ([208.86.201.193]:58628 "EHLO mx0a-0014ca01.pphosted.com" rhost-flags-OK-OK-OK-FAIL) by vger.kernel.org with ESMTP id S1725900AbfBVUMk (ORCPT ); Fri, 22 Feb 2019 15:12:40 -0500 Received: from pps.filterd (m0042333.ppops.net [127.0.0.1]) by mx0b-0014ca01.pphosted.com (8.16.0.27/8.16.0.27) with SMTP id x1MK3dgG018272; Fri, 22 Feb 2019 12:12:33 -0800 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=cadence.com; h=date : from : to : subject : message-id : mime-version : content-type; s=proofpoint; bh=ubLMrNAd7nvNuje5CpD6D+Pd5U3ecKAguLqX7aIbkLI=; b=OuHY1HYiwV4squC7uiN3roxJTW1S/JyslDvG0spuq+goak/faqzjf+R5VUCNsg/dOoem pFSoE0Jas9U5lUDdB1LfPSnJreupbtmgq1QKtUALCdRozuO/ZHcBOjeN40xCNeN6SV/l QZHlB3AowGtg3h8PdW6lMQVxgb7gUv+wQ4b9K+XrEisZfOUjWAChUHr+F34uNmibsnna cAU08rdG3t2cKulWAnM9ckU5GTVKRnFmaWervISHRjnLzEWyaMzwPOLfJzhLaHaG7mVo +jO8VBAdQMsT+LF5wNdhvuUDMNfdo20qhkbesyDhYH9EpqiZ0S2hQC7vyDxBwHiiv0m8 cg== Authentication-Results: cadence.com; spf=pass smtp.mailfrom=pthombar@cadence.com Received: from nam03-dm3-obe.outbound.protection.outlook.com (mail-dm3nam03lp2054.outbound.protection.outlook.com [104.47.41.54]) by mx0b-0014ca01.pphosted.com with ESMTP id 2qspmmrb3j-1 (version=TLSv1.2 cipher=ECDHE-RSA-AES256-SHA384 bits=256 verify=NOT); Fri, 22 Feb 2019 12:12:32 -0800 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=cadence.com; s=selector1; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=ubLMrNAd7nvNuje5CpD6D+Pd5U3ecKAguLqX7aIbkLI=; b=PGhPzSWGcq2B9RjbV4AuAAQHGaftOOadnFGZgf6XgJa7Cn6SuJ8zWyuJsFgTUz8pEnrG4pu8+ruZuDdgcftc8e28kZ6u+znx3DsF82H9Yjg7pXrRiwJj7JJPzuoOQDc3tJ6lFu4Bu231GJShW7c3HKMNc491mpAZ/4tKg8oPxVs= Received: from BYAPR07CA0070.namprd07.prod.outlook.com (2603:10b6:a03:60::47) by MW2PR07MB3977.namprd07.prod.outlook.com (2603:10b6:907:5::30) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.1622.18; Fri, 22 Feb 2019 20:12:29 +0000 Received: from CO1NAM05FT036.eop-nam05.prod.protection.outlook.com (2a01:111:f400:7e50::200) by BYAPR07CA0070.outlook.office365.com (2603:10b6:a03:60::47) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_CBC_SHA384) id 15.20.1643.15 via Frontend Transport; Fri, 22 Feb 2019 20:12:29 +0000 Received-SPF: SoftFail (protection.outlook.com: domain of transitioning cadence.com discourages use of 158.140.1.28 as permitted sender) Received: from sjmaillnx1.cadence.com (158.140.1.28) by CO1NAM05FT036.mail.protection.outlook.com (10.152.96.149) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_CBC_SHA384) id 15.20.1665.5 via Frontend Transport; Fri, 22 Feb 2019 20:12:29 +0000 Received: from maileu3.global.cadence.com (maileu3.cadence.com [10.160.88.99]) by sjmaillnx1.cadence.com (8.14.4/8.14.4) with ESMTP id x1MKCQe7031191 (version=TLSv1/SSLv3 cipher=AES256-SHA bits=256 verify=OK); Fri, 22 Feb 2019 12:12:27 -0800 X-CrossPremisesHeadersFilteredBySendConnector: maileu3.global.cadence.com Received: from maileu3.global.cadence.com (10.160.88.99) by maileu3.global.cadence.com (10.160.88.99) with Microsoft SMTP Server (TLS) id 15.0.1367.3; Fri, 22 Feb 2019 21:12:25 +0100 Received: from lvlogina.cadence.com (10.165.176.102) by maileu3.global.cadence.com (10.160.88.99) with Microsoft SMTP Server (TLS) id 15.0.1367.3 via Frontend Transport; Fri, 22 Feb 2019 21:12:25 +0100 Received: from lvlogina.cadence.com (localhost.localdomain [127.0.0.1]) by lvlogina.cadence.com (8.14.4/8.14.4) with ESMTP id x1MKCPVk019412; Fri, 22 Feb 2019 20:12:25 GMT Received: (from pthombar@localhost) by lvlogina.cadence.com (8.14.4/8.14.4/Submit) id x1MKCPTN019400; Fri, 22 Feb 2019 20:12:25 GMT Date: Fri, 22 Feb 2019 20:12:25 +0000 From: Parshuram Thombare To: , , , , , , , , , , Subject: [PATCH 1/3] net: ethernet: add support for PCS and 2.5G speed Message-ID: <20190222201225.GA15633@lvlogina.cadence.com> MIME-Version: 1.0 Content-Disposition: inline User-Agent: Mutt/1.5.20 (2009-12-10) X-OrganizationHeadersPreserved: maileu3.global.cadence.com X-EOPAttributedMessage: 0 X-Forefront-Antispam-Report: CIP:158.140.1.28; IPV:CAL; SCL:-1; CTRY:US; EFV:NLI; SFV:NSPM; SFS:(10009020)(136003)(39860400002)(376002)(346002)(396003)(2980300002)(189003)(199004)(36092001)(336012)(426003)(486006)(186003)(26005)(126002)(476003)(246002)(8676002)(97756001)(86362001)(2201001)(2906002)(46406003)(23726003)(50466002)(47776003)(316002)(106466001)(105596002)(42186006)(33656002)(305945005)(7636002)(356004)(5660300002)(110136005)(16586007)(58126008)(87636003)(26826003)(478600001)(8936002)(1076003)(14444005)(18370500001)(921003)(1121003); DIR:OUT; SFP:1101; SCL:1; SRVR:MW2PR07MB3977; H:sjmaillnx1.cadence.com; FPR:; SPF:SoftFail; LANG:en; PTR:corp.cadence.com; MX:1; A:1; X-MS-PublicTrafficType: Email X-MS-Office365-Filtering-Correlation-Id: afa3c3fa-bfc8-497e-0c47-08d69902124f X-Microsoft-Antispam: BCL:0; PCL:0; RULEID:(2390118)(7020095)(4652040)(8989299)(5600110)(711020)(4605104)(4534185)(4627221)(201703031133081)(201702281549075)(8990200)(2017052603328)(7153060); SRVR:MW2PR07MB3977; X-MS-TrafficTypeDiagnostic: MW2PR07MB3977: X-Microsoft-Exchange-Diagnostics: 1; MW2PR07MB3977; 20:DoU8TmOrbmcG/c3MdyArC8G0295sftTQHu4hdBGF3pMJMA+czejzji6sioyNIQfyq52pyLX2H+NmMio9YViWdB2dkADZd65+9OPS4NNkWluLM0dxdVnpwVjIKxLwWZBdfUto8hagGNbc0T14o6wyi+3BSPLAg2HVA9zmnSDuvtaFBRoi3fMvFB3NZlqBgLm006kuW9jyNr7UHYmLaW8atgc3C8aknOt1/dXeWtdT0Zhp9feY+G1kKMEB9hXkc4lsBSoP2ZzJKZsT/OjCp2O1NSgeN9BU+6wHQU7mAZkCtcAqcYUWmhfMgqmuTQgIfSik1Gc34nDFdeCfHyVZPmcTEoyl7XMdAspoM0nFum5Bqtz6KxtJSu0Lv9AFVV9IBi7tKNdhEhyAPX3Ql74qCN9jctSecNw+X6iYZeXR0zu6ixd91TDFRlHdOEVS4FQu9/mvnV3eDbWWIbSwOD83HddLa5AHux9xKBds5mlTXiYPXvLI0TC++V+CH4QMAeC0402m X-Microsoft-Antispam-PRVS: X-Forefront-PRVS: 09565527D6 X-Microsoft-Exchange-Diagnostics: 1; MW2PR07MB3977; 23:juexpUtxnp+lZGeRgKSwQ8RjEe6rlzZ4qL/3usW/fYokMpFKj0GUTXs4gmmi1GZi9iFWtv42ttA2tbPvgqKrt3d9DOu3nTteMoqBBtaR27OfVRH4e+In9EFvdsI9sCplwBpaJuhE9n4vL0fAwHbGhfc0gADzCR4mThRFBIPbyyVUXvhoq+Vjlfe6mAfP+wSIoPIhtjJHo1FOXz2VbAcNVnT/M6uxxvMC82u+nn0Jvohx/Rno+9cEbBED584isFw4vjIJzEI+In+GcQUh83xKiJrg9PqvdvPu/QbBT634PI2QsDpoT2VFezdEOFN102QgFG6Sb1YMwX9PeCAsKt1DhePCId55FzFVCpHj1c2mJvrkPCiRo1Bbm4UN/pb5zTR1f8GbFt8izEyACB8ojjnJZYLVC+Y9Ql8RF57Bc3o4mbkg9BYuYgm70DvnQU+ZEnEOQ4BeLy4qMr3jQ8DfAplx7P9E//BHT64kibmVaDcLYNAV1ZwmVJSqUOd05B/MmV8xnvLat0bHXNU3hKBQUcy6qaP5PFQTn+Xy0RrkmeURxShpRf7w1ULx4Yl6UKY1oJw+GUKjPcW2HAUYWLYon8gwh1lUZKrhSZMxspOnUvd/ylMGD/6e6JlVuiNXECBArVzxoq2EZANAaXVI/JJlSahaLrK5EuPQ35sWOw9kQ1E2aXJdOKGY6On1YQhZ6D0l3SXxlwpcNfkR3pQq/sb4ZKm4XZTFd0menHOmtMo3i1avwtfBPNBkRlWKDKvYY3XmIJZaR8mQyFAe3XrHlWIN9c0jiu48BfccLSS7EoxH3vitLfGKMP8/Hi+Gjg1ok5qbNiV9iNkY+gTlMKBGQ+BWi+is8Bv/vIg6KWveZOycNW8e1SjP/fleJhlX9OUEPU9DE47/vI75qQEa/tvnOKyc/l2XiSO6L5c6anYZXGma2kfJr/TsHfTO8xkugz+aDVajnLA2VoeaGn4jDYeJd8yGe+2+SOmeGrxKhosOZONOe3GxMMkmglVWqmWtplH6R0DYK0GhUeFlhRmq8bAbmHPm1CywXZ27zWuD5RmgW6KHfLjtrKQ= X-MS-Exchange-SenderADCheck: 1 X-Microsoft-Antispam-Message-Info: 0KXIUDXkRiKxWAbX2JbtYcEGkvU4U7ZKOfBMPRIWgs98sD7OT/B/suRp1Kn7q7wjuwGTVNjX8Hrw+JWoXIPM59qZPQZSNIhbzh59fYifIbzcxxzgL7CVehvZkTerIbehw40arHaxilH15OBFlyAZCT3XzkgGF5TP/M5pWmon5Um01LFyucoFnas6xvF0/Q3WN/Z4dxXhB6Lvwe9/BFW+4kE/0zN8XfNf2pByI9fxXbzXSRMj48zpDehv36v8z53IFtuHFCGh24tu1MRQvEmP0z5jS7o8/1AF1BVdM/Qm2/S/1yn5e2JuslvHIQqHnBIdtbaW9uUhGWKWyhdBgWTZQkjLutNe+X37xH2PzBZSMfLvZstBiFdRZcN8lxzFcFiqcJ4VGWGTug9TC0ojTkoAi8uCflkHdPlyvj7kM4HyQr8= X-Microsoft-Exchange-Diagnostics: 1; MW2PR07MB3977; 20:s8vsdACoHpCT1MS5NduROFP08JTeyxjYN93o60VWrmRpDdyWIqYKvnHLw/LoZ+f6XI3QQUdwVsxFSNvqpBr3WbNVpzB1pWVYtcbUnFJFQMU4KIdHSvYkumR/G8YJPVHY62HKKXFk8NPsjH/Y0+11W5tWE1QYeUEW2eRuIyGL7h6WiAPlQU9CVPiV2+JSZosqHUixihuQ/v5hejZwaUgoAjOTH9fyKxxMLRVuRWH1cBfI4OWuCEt6rQwFxnXJ52SE X-OriginatorOrg: cadence.com X-MS-Exchange-CrossTenant-OriginalArrivalTime: 22 Feb 2019 20:12:29.3066 (UTC) X-MS-Exchange-CrossTenant-Network-Message-Id: afa3c3fa-bfc8-497e-0c47-08d69902124f X-MS-Exchange-CrossTenant-Id: d36035c5-6ce6-4662-a3dc-e762e61ae4c9 X-MS-Exchange-CrossTenant-OriginalAttributedTenantConnectingIp: TenantId=d36035c5-6ce6-4662-a3dc-e762e61ae4c9; Ip=[158.140.1.28]; Helo=[sjmaillnx1.cadence.com] X-MS-Exchange-CrossTenant-FromEntityHeader: HybridOnPrem X-MS-Exchange-Transport-CrossTenantHeadersStamped: MW2PR07MB3977 X-Proofpoint-SPF-Result: pass X-Proofpoint-SPF-Record: v=spf1 include:_spf.salesforce.com include:mktomail.com include:spf-0014ca01.pphosted.com include:spf.protection.outlook.com include:auth.msgapp.com include:spf.mandrillapp.com ~all X-Proofpoint-Virus-Version: vendor=fsecure engine=2.50.10434:, , definitions=2019-02-22_13:, , signatures=0 X-Proofpoint-Spam-Details: rule=outbound_check_notspam policy=outbound_check score=0 priorityscore=1501 malwarescore=0 suspectscore=0 phishscore=0 bulkscore=0 spamscore=0 clxscore=1015 lowpriorityscore=0 mlxscore=0 impostorscore=0 mlxlogscore=999 adultscore=0 classifier=spam adjust=0 reason=mlx scancount=1 engine=8.0.1-1810050000 definitions=main-1902220138 Sender: netdev-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: netdev@vger.kernel.org This patch add support for PCS (for SGMII interface) and 2.5Gbps MAC in Cadence ethernet controller driver. Signed-off-by: Parshuram Thombare --- drivers/net/ethernet/cadence/macb.h | 20 ++++ drivers/net/ethernet/cadence/macb_main.c | 154 +++++++++++++++++++++++------- 2 files changed, 140 insertions(+), 34 deletions(-) diff --git a/drivers/net/ethernet/cadence/macb.h b/drivers/net/ethernet/cadence/macb.h index 9bbaad9..bed4ded 100644 --- a/drivers/net/ethernet/cadence/macb.h +++ b/drivers/net/ethernet/cadence/macb.h @@ -79,6 +79,7 @@ #define MACB_RBQPH 0x04D4 /* GEM register offsets. */ +#define GEM_NCR 0x0000 /* Network Control */ #define GEM_NCFGR 0x0004 /* Network Config */ #define GEM_USRIO 0x000c /* User IO */ #define GEM_DMACFG 0x0010 /* DMA Configuration */ @@ -273,6 +274,10 @@ #define MACB_IRXFCS_OFFSET 19 #define MACB_IRXFCS_SIZE 1 +/* GEM specific NCR bitfields. */ +#define GEM_TWO_PT_FIVE_GIG_OFFSET 29 +#define GEM_TWO_PT_FIVE_GIG_SIZE 1 + /* GEM specific NCFGR bitfields. */ #define GEM_GBE_OFFSET 10 /* Gigabit mode enable */ #define GEM_GBE_SIZE 1 @@ -463,6 +468,8 @@ #define GEM_IRQCOR_SIZE 1 #define GEM_DBWDEF_OFFSET 25 #define GEM_DBWDEF_SIZE 3 +#define GEM_NO_PCS_OFFSET 0 +#define GEM_NO_PCS_SIZE 1 /* Bitfields in DCFG2. */ #define GEM_RX_PKT_BUFF_OFFSET 20 @@ -648,6 +655,19 @@ #define MACB_CAPS_GIGABIT_MODE_AVAILABLE 0x20000000 #define MACB_CAPS_SG_DISABLED 0x40000000 #define MACB_CAPS_MACB_IS_GEM 0x80000000 +#define MACB_CAPS_PCS 0x01000000 +#define MACB_CAPS_TWO_PT_FIVE_GIG_SPEED 0x02000000 + +#define MACB_GEM7010_IDNUM 0x009 +#define MACB_GEM7014_IDNUM 0x107 +#define MACB_GEM7014A_IDNUM 0x207 +#define MACB_GEM7016_IDNUM 0x10a +#define MACB_GEM7017_IDNUM 0x00a +#define MACB_GEM7017A_IDNUM 0x20a +#define MACB_GEM7020_IDNUM 0x003 +#define MACB_GEM7021_IDNUM 0x00c +#define MACB_GEM7021A_IDNUM 0x20c +#define MACB_GEM7022_IDNUM 0x00b /* LSO settings */ #define MACB_LSO_UFO_ENABLE 0x01 diff --git a/drivers/net/ethernet/cadence/macb_main.c b/drivers/net/ethernet/cadence/macb_main.c index f2915f2..4f4f8e5 100644 --- a/drivers/net/ethernet/cadence/macb_main.c +++ b/drivers/net/ethernet/cadence/macb_main.c @@ -361,26 +361,50 @@ static int macb_mdio_write(struct mii_bus *bus, int mii_id, int regnum, * macb_set_tx_clk() - Set a clock to a new frequency * @clk Pointer to the clock to change * @rate New frequency in Hz + * @interafce Phy interface * @dev Pointer to the struct net_device */ -static void macb_set_tx_clk(struct clk *clk, int speed, struct net_device *dev) +static void macb_set_tx_clk(struct clk *clk, int speed, + phy_interface_t interface, struct net_device *dev) { long ferr, rate, rate_rounded; if (!clk) return; - switch (speed) { - case SPEED_10: + if (interface == PHY_INTERFACE_MODE_GMII || + interface == PHY_INTERFACE_MODE_MII) { + switch (speed) { + case SPEED_10: rate = 2500000; break; - case SPEED_100: + case SPEED_100: rate = 25000000; break; - case SPEED_1000: + case SPEED_1000: rate = 125000000; break; - default: + default: + return; + } + } else if (interface == PHY_INTERFACE_MODE_SGMII) { + switch (speed) { + case SPEED_10: + rate = 1250000; + break; + case SPEED_100: + rate = 12500000; + break; + case SPEED_1000: + rate = 125000000; + break; + case SPEED_2500: + rate = 312500000; + break; + default: + return; + } + } else { return; } @@ -410,30 +434,49 @@ static void macb_handle_link_change(struct net_device *dev) spin_lock_irqsave(&bp->lock, flags); - if (phydev->link) { - if ((bp->speed != phydev->speed) || - (bp->duplex != phydev->duplex)) { - u32 reg; - - reg = macb_readl(bp, NCFGR); - reg &= ~(MACB_BIT(SPD) | MACB_BIT(FD)); - if (macb_is_gem(bp)) - reg &= ~GEM_BIT(GBE); + if (phydev->link && (bp->speed != phydev->speed || + bp->duplex != phydev->duplex)) { + u32 reg; - if (phydev->duplex) - reg |= MACB_BIT(FD); + reg = macb_readl(bp, NCFGR); + reg &= ~(MACB_BIT(SPD) | MACB_BIT(FD)); + if (macb_is_gem(bp)) + reg &= ~GEM_BIT(GBE); + if (phydev->duplex) + reg |= MACB_BIT(FD); + macb_or_gem_writel(bp, NCFGR, reg); + + if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII && + (phydev->speed == SPEED_1000 || + phydev->speed == SPEED_2500)) { + if (bp->caps & MACB_CAPS_TWO_PT_FIVE_GIG_SPEED) { + reg = gem_readl(bp, NCR) & + ~GEM_BIT(TWO_PT_FIVE_GIG); + gem_writel(bp, NCR, reg); + } + gem_writel(bp, NCFGR, GEM_BIT(GBE) | + gem_readl(bp, NCFGR)); + if (bp->caps & MACB_CAPS_TWO_PT_FIVE_GIG_SPEED && + phydev->speed == SPEED_2500) + gem_writel(bp, NCR, gem_readl(bp, NCR) | + GEM_BIT(TWO_PT_FIVE_GIG)); + } else if (phydev->speed == SPEED_1000) { + gem_writel(bp, NCFGR, GEM_BIT(GBE) | + gem_readl(bp, NCFGR)); + } else { + if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII) { + reg = gem_readl(bp, NCFGR); + reg &= ~(GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL)); + gem_writel(bp, NCFGR, reg); + } if (phydev->speed == SPEED_100) - reg |= MACB_BIT(SPD); - if (phydev->speed == SPEED_1000 && - bp->caps & MACB_CAPS_GIGABIT_MODE_AVAILABLE) - reg |= GEM_BIT(GBE); - - macb_or_gem_writel(bp, NCFGR, reg); - - bp->speed = phydev->speed; - bp->duplex = phydev->duplex; - status_change = 1; + macb_writel(bp, NCFGR, MACB_BIT(SPD) | + macb_readl(bp, NCFGR)); } + + bp->speed = phydev->speed; + bp->duplex = phydev->duplex; + status_change = 1; } if (phydev->link != bp->link) { @@ -453,7 +496,8 @@ static void macb_handle_link_change(struct net_device *dev) /* Update the TX clock rate if and only if the link is * up and there has been a link change. */ - macb_set_tx_clk(bp->tx_clk, phydev->speed, dev); + macb_set_tx_clk(bp->tx_clk, phydev->speed, + bp->phy_interface, dev); netif_carrier_on(dev); netdev_info(dev, "link up (%d/%s)\n", @@ -543,10 +587,16 @@ static int macb_mii_probe(struct net_device *dev) } /* mask with MAC supported features */ - if (macb_is_gem(bp) && bp->caps & MACB_CAPS_GIGABIT_MODE_AVAILABLE) - phy_set_max_speed(phydev, SPEED_1000); - else - phy_set_max_speed(phydev, SPEED_100); + if (macb_is_gem(bp)) { + linkmode_copy(phydev->supported, PHY_GBIT_FEATURES); + if (bp->caps & MACB_CAPS_TWO_PT_FIVE_GIG_SPEED) + linkmode_set_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, + phydev->supported); + } else { + linkmode_copy(phydev->supported, PHY_BASIC_FEATURES); + } + + linkmode_copy(phydev->advertising, phydev->supported); if (bp->caps & MACB_CAPS_NO_GIGABIT_HALF) phy_remove_link_mode(phydev, @@ -2217,8 +2267,6 @@ static void macb_init_hw(struct macb *bp) macb_set_hwaddr(bp); config = macb_mdc_clk_div(bp); - if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII) - config |= GEM_BIT(SGMIIEN) | GEM_BIT(PCSSEL); config |= MACB_BF(RBOF, NET_IP_ALIGN); /* Make eth data aligned */ config |= MACB_BIT(PAE); /* PAuse Enable */ config |= MACB_BIT(DRFCS); /* Discard Rx FCS */ @@ -3255,6 +3303,23 @@ static void macb_configure_caps(struct macb *bp, dcfg = gem_readl(bp, DCFG1); if (GEM_BFEXT(IRQCOR, dcfg) == 0) bp->caps |= MACB_CAPS_ISR_CLEAR_ON_WRITE; + if (GEM_BFEXT(NO_PCS, dcfg) == 0) + bp->caps |= MACB_CAPS_PCS; + switch (MACB_BFEXT(IDNUM, macb_readl(bp, MID))) { + case MACB_GEM7016_IDNUM: + case MACB_GEM7017_IDNUM: + case MACB_GEM7017A_IDNUM: + case MACB_GEM7020_IDNUM: + case MACB_GEM7021_IDNUM: + case MACB_GEM7021A_IDNUM: + case MACB_GEM7022_IDNUM: + if (bp->caps & MACB_CAPS_PCS) + bp->caps |= MACB_CAPS_TWO_PT_FIVE_GIG_SPEED; + break; + + default: + break; + } dcfg = gem_readl(bp, DCFG2); if ((dcfg & (GEM_BIT(RX_PKT_BUFF) | GEM_BIT(TX_PKT_BUFF))) == 0) bp->caps |= MACB_CAPS_FIFO_MODE; @@ -4110,7 +4175,28 @@ static int macb_probe(struct platform_device *pdev) else bp->phy_interface = PHY_INTERFACE_MODE_MII; } else { + switch (err) { + case PHY_INTERFACE_MODE_SGMII: + if (bp->caps & MACB_CAPS_PCS) { + bp->phy_interface = PHY_INTERFACE_MODE_SGMII; + break; + } + /* Fallthrough */ + + default: + if (macb_is_gem(bp)) + err = PHY_INTERFACE_MODE_GMII; + else + err = PHY_INTERFACE_MODE_MII; + /* Fallthrough */ + + case PHY_INTERFACE_MODE_GMII: + case PHY_INTERFACE_MODE_RGMII: + case PHY_INTERFACE_MODE_MII: + case PHY_INTERFACE_MODE_RMII: bp->phy_interface = err; + break; + } } /* IP specific init */ From patchwork Fri Feb 22 20:12:42 2019 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Parshuram Raju Thombare X-Patchwork-Id: 1047111 X-Patchwork-Delegate: davem@davemloft.net Return-Path: X-Original-To: patchwork-incoming-netdev@ozlabs.org Delivered-To: patchwork-incoming-netdev@ozlabs.org Authentication-Results: ozlabs.org; spf=none (mailfrom) smtp.mailfrom=vger.kernel.org (client-ip=209.132.180.67; helo=vger.kernel.org; envelope-from=netdev-owner@vger.kernel.org; receiver=) Authentication-Results: ozlabs.org; dmarc=pass (p=none dis=none) header.from=cadence.com Authentication-Results: ozlabs.org; dkim=pass (2048-bit key; unprotected) header.d=cadence.com header.i=@cadence.com header.b="FWu755Up"; dkim=pass (1024-bit key; unprotected) header.d=cadence.com header.i=@cadence.com header.b="rmlwPu03"; dkim-atps=neutral Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by ozlabs.org (Postfix) with ESMTP id 445jFT0dq0z9sBL for ; Sat, 23 Feb 2019 07:13:01 +1100 (AEDT) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1727123AbfBVUM4 (ORCPT ); Fri, 22 Feb 2019 15:12:56 -0500 Received: from mx0b-0014ca01.pphosted.com ([208.86.201.193]:58730 "EHLO mx0a-0014ca01.pphosted.com" rhost-flags-OK-OK-OK-FAIL) by vger.kernel.org with ESMTP id S1725900AbfBVUMz (ORCPT ); Fri, 22 Feb 2019 15:12:55 -0500 Received: from pps.filterd (m0042333.ppops.net [127.0.0.1]) by mx0b-0014ca01.pphosted.com (8.16.0.27/8.16.0.27) with SMTP id x1MK3dgI018272; Fri, 22 Feb 2019 12:12:49 -0800 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=cadence.com; h=date : from : to : subject : message-id : mime-version : content-type; s=proofpoint; bh=5A9X9+yb8ElteRaR0WL5jzjgqB508eNOU8Lyh+ir/pQ=; b=FWu755UpLiTVJApRMpSGzKD7cOTFqR1PFbmUXJpDnu7tDVBioIJRzRsi8zp5pJzOWSnm tooDmn7B9bfPfaihybis6hSjGZQ6ATm6iCnqHpCQCZ9Vlwcriu5ZbltH1vjvqnoHQyEI nS1SyMc5zYlpQXkyUTU4yKyq6+5V0AKC76QrG29aTAIxOd8EibdPtqv0UOv9F2BgyEz5 Z8J9W3ecokWZ2KV66O7rNagWlGoSTAuKJn4VDXqTgoYgFjOExW8nfWkEBAiiLq02jYHB jLc9B5Re8Am0B29d9xfak1+koXaGC0ds7VaFRZ5xu9lynI0NWCrD9dBDalvurTTTpjw3 hw== Authentication-Results: cadence.com; spf=pass smtp.mailfrom=pthombar@cadence.com Received: from nam03-dm3-obe.outbound.protection.outlook.com (mail-dm3nam03lp2056.outbound.protection.outlook.com [104.47.41.56]) by mx0b-0014ca01.pphosted.com with ESMTP id 2qspmmrb4d-1 (version=TLSv1.2 cipher=ECDHE-RSA-AES256-SHA384 bits=256 verify=NOT); Fri, 22 Feb 2019 12:12:49 -0800 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=cadence.com; s=selector1; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=5A9X9+yb8ElteRaR0WL5jzjgqB508eNOU8Lyh+ir/pQ=; b=rmlwPu03ZA0W0aG8CG+2ljuGZOfjJjZhSS7qQye0DxEyHhMh+3NU37ITaAk6cXXWJKuXzEJjsXTtBTib7oB4rapIHc5/Z34AWF9azLH0SDRBtKiPISPWUgM9lWeCdHx9ofT5GTDTPQ8DOaZIgANI4b5p4nPMmo2Ld2UXWg9+Jj0= Received: from DM5PR07CA0081.namprd07.prod.outlook.com (2603:10b6:4:ad::46) by CY1PR07MB2248.namprd07.prod.outlook.com (2a01:111:e400:5a10::22) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.1643.18; Fri, 22 Feb 2019 20:12:46 +0000 Received: from BY2NAM05FT049.eop-nam05.prod.protection.outlook.com (2a01:111:f400:7e52::208) by DM5PR07CA0081.outlook.office365.com (2603:10b6:4:ad::46) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.1622.16 via Frontend Transport; Fri, 22 Feb 2019 20:12:46 +0000 Received-SPF: SoftFail (protection.outlook.com: domain of transitioning cadence.com discourages use of 158.140.1.28 as permitted sender) Received: from sjmaillnx2.cadence.com (158.140.1.28) by BY2NAM05FT049.mail.protection.outlook.com (10.152.100.186) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.1665.5 via Frontend Transport; Fri, 22 Feb 2019 20:12:45 +0000 Received: from maileu3.global.cadence.com (maileu3.cadence.com [10.160.88.99]) by sjmaillnx2.cadence.com (8.14.4/8.14.4) with ESMTP id x1MKChgM005227 (version=TLSv1/SSLv3 cipher=AES256-SHA bits=256 verify=OK); Fri, 22 Feb 2019 12:12:45 -0800 X-CrossPremisesHeadersFilteredBySendConnector: maileu3.global.cadence.com Received: from maileu3.global.cadence.com (10.160.88.99) by maileu3.global.cadence.com (10.160.88.99) with Microsoft SMTP Server (TLS) id 15.0.1367.3; Fri, 22 Feb 2019 21:12:42 +0100 Received: from lvlogina.cadence.com (10.165.176.102) by maileu3.global.cadence.com (10.160.88.99) with Microsoft SMTP Server (TLS) id 15.0.1367.3 via Frontend Transport; Fri, 22 Feb 2019 21:12:42 +0100 Received: from lvlogina.cadence.com (localhost.localdomain [127.0.0.1]) by lvlogina.cadence.com (8.14.4/8.14.4) with ESMTP id x1MKCgXA023091; Fri, 22 Feb 2019 20:12:42 GMT Received: (from pthombar@localhost) by lvlogina.cadence.com (8.14.4/8.14.4/Submit) id x1MKCgqC023080; Fri, 22 Feb 2019 20:12:42 GMT Date: Fri, 22 Feb 2019 20:12:42 +0000 From: Parshuram Thombare To: , , , , , , , , , , Subject: [PATCH 2/3] net: ethernet: add c45 PHY support in MDIO read/write functions. Message-ID: <20190222201242.GA20889@lvlogina.cadence.com> MIME-Version: 1.0 Content-Disposition: inline User-Agent: Mutt/1.5.20 (2009-12-10) X-OrganizationHeadersPreserved: maileu3.global.cadence.com X-EOPAttributedMessage: 0 X-Forefront-Antispam-Report: CIP:158.140.1.28; IPV:CAL; SCL:-1; CTRY:US; EFV:NLI; SFV:NSPM; SFS:(10009020)(346002)(396003)(376002)(136003)(39850400004)(2980300002)(199004)(189003)(36092001)(106466001)(7636002)(8936002)(305945005)(8676002)(105596002)(246002)(1076003)(5660300002)(356004)(86362001)(2201001)(47776003)(186003)(26826003)(478600001)(426003)(33656002)(23726003)(87636003)(97756001)(46406003)(42186006)(486006)(336012)(476003)(126002)(50466002)(16586007)(26005)(58126008)(110136005)(2906002)(316002)(18370500001)(921003)(1121003); DIR:OUT; SFP:1101; SCL:1; SRVR:CY1PR07MB2248; H:sjmaillnx2.cadence.com; FPR:; SPF:SoftFail; LANG:en; PTR:corp.cadence.com; A:1; MX:1; X-MS-PublicTrafficType: Email X-MS-Office365-Filtering-Correlation-Id: 2ecb45c6-9d6c-4eb3-af63-08d699021c1d X-Microsoft-Antispam: BCL:0; PCL:0; RULEID:(2390118)(7020095)(4652040)(8989299)(5600110)(711020)(4605104)(4534185)(4627221)(201703031133081)(201702281549075)(8990200)(2017052603328)(7153060); SRVR:CY1PR07MB2248; X-MS-TrafficTypeDiagnostic: CY1PR07MB2248: X-Microsoft-Exchange-Diagnostics: 1; CY1PR07MB2248; 20:0MI0Og23tmla/XA3M1FRIMzJulbvvY3N3pQehqDTVlKIQsqQoFgHsf83E+uCUhi8sMicjIIsjOB8eamyRA3yVQOHS+JKp2NDe0yusJL74cvyEpwdA+xTIX1hBb4tDhOLHpHfqvyDOidGcCmr+Y+WkCPA7O0SbmIMFlATPqcQtLKMuE3epgyTxl6rLPeowSaGYlE3gDJAijqG/C56MlWFBmGsNXOETCe3HVzcHL8RNeZuNobFl7TRU9k5BuOnXc4avZ/vhfLUOQPRUe2pDDiB5cYH9ufKmpKVWX0bPKtRxMExLakx05VFIqu3GwlkCQIeZxE0U1cW7sTmWSUlJr6R1Qd7KBVyZBXulFxk0bjBZLv/sGtk7vTrQI08kf3S4MFthmAxCMZc1EzMUBK4IgQTFhK/5O0y0F9YiYbteJCfQoCOT7eqiYJT9TN/bxpOC63UCRToFzCeySVyJuhVeQ1Ypt+vcskDlUCTD+hxJFGU/am78tshnYHYczN8mFAPFzTt X-Microsoft-Antispam-PRVS: X-Forefront-PRVS: 09565527D6 X-Microsoft-Exchange-Diagnostics: 1; CY1PR07MB2248; 23:mIgmtvycF3XJbMV4C6wRd1VWCZrPtgX5/+dIfhkRZR924K8jdEf/JJGNb9jrspTn69tYZO57wlww3OcggQTXXbk7eqZykf1FR83tD9Z305GUaw5PAGDo0ZvTVtbgbc/VbOKFHsd7oaNS6LefbmTuViAOEsMNWumg5WBrmSdglU08m8I8LUvYabjPOR+voax8mHhTGbAMC6lbAdWL3ysEohsl+/ZqIUNVIKwWX540Mw4t5Cutyi7QGn7M8TfCU5s+ChI+Dav0VY9dBI3fm35gBHVSw/rQq9vaql0occ4U8xhpjuphkLgqg1bZ00I9eSx3zcBYV5TixtPTNrdcu4eHtIUP9SJ58BLRuXZRPM7Qa9OuxW++sA4e4yQ5OS2IZ+08lOsIuwIrnVjAuEKxTCYfurMZ2EfdUdUjwz8ueOVBjKCk68NKdMuRRC+FQHgmujeWdez9gsGMVJq+AUiD1ogFvHmzBowm8U6kRA00Y6SkCQjsbcYfiNSVrQ7+Qlh3Q7fwgCCTSgZsZVmzdH0rPSyz3+q+XNIGkvLi6meJcRuPNBW0vOvh2wyfyxE7cnDVXq6IWm13rSHf06cJ3cpp8X93M4D5b1ttA0ufOFU+3rL5LIoXDF/9R/zIM18Uco6scpcdfEvGWS04/HEYw0WZLtzSjF6NWRWgloovrtOz1aSbEEOfx2g1rmYHatOcyAYx2EOC7lUUKGfKHRUomDvU8LcdR2mrro95J0XLWEAK5HkVPZs4lqTs99KahfEJtogpgBwMc9lGS65KFPG0PAezdccFT/JiAjlYi2VBNO3OSQEteEHPox5G1kk2mjPTPHBOb6cc810Anw9HDxGWnYK/r72rrxUb8uX45NgTFXMVdL00LiEbb4v6ayxAny+c4QifVjvplMLsWxzU72aFYg9RWJu7reFd2XtHLwbAmUrhfftWcvdIw2UksgFQL/Gh23EnpJLUSzKHC7yw5oQETgECHJ+vwphtq2I2ndHmz4Yf1NVgGzFZ1ZLHTEnBKJZjEdbhdHwAJ+TUhMaahYi6PdN4duRZ3g== X-MS-Exchange-SenderADCheck: 1 X-Microsoft-Antispam-Message-Info: aRA85flw5X7pwnXBQZz3YDGSFMucFkdagRvKnpAJF1WwlCIaDpt9a+eoGyXVBozppraDfOadQJE7xmZKR41Pmdgo9Axs1JNtAQl5W+XlAACGglHnKW2rrW9uiDKoLphcsdL4s+aqNkO/RbVueXPrVZ5jY9BV2Q3LTO4dsYeg3eYZmUOM9cdjZqZQWYTOSo2d0etIfU16D6/JUy4p72k5kidfVU8rVo0e4JmO0O5j3I0xAztf1lBVUyCKirQtsrY1pfpgGX68JSxlsbGtnN8OYj0YpLVhX/T4AFIv51dHVFadmSw7mxLeV9b7bjWCXFZr3P5Lg1hNzYcAmpewBqsl3SJ9rqJ4/J0nGFmPlu/ElYMuONxmtd7vRBFaCeTicj7LCcR4fOIfCpWu2H5VF+5jioemNEgMzIUA/uqrqR7f9FY= X-Microsoft-Exchange-Diagnostics: 1; CY1PR07MB2248; 20:ftmO2NUjEY2Be0ZuizSQfLEZ5rNJT/IPBn0vu6c6X9lIDNu/3fTXtAKuEoVuvBhoyTysh5rO+Wmdrip04UVb4AuHtr/avJWq1KmaTUWRINg5VusTvLlFxiOKw4OPXxtADRSrrluM+0a99azhS17uSpR6kiGc0epK5U3lTKBVxxQXC45xUWm3kdKc5/TUN/AaeBZtT0vC/gPKNeMQxH7XCbwtl5G6uAqWQxU8+NfY8rs4JkJzyOMjeTFuHFF12zo+ X-OriginatorOrg: cadence.com X-MS-Exchange-CrossTenant-OriginalArrivalTime: 22 Feb 2019 20:12:45.9585 (UTC) X-MS-Exchange-CrossTenant-Network-Message-Id: 2ecb45c6-9d6c-4eb3-af63-08d699021c1d X-MS-Exchange-CrossTenant-Id: d36035c5-6ce6-4662-a3dc-e762e61ae4c9 X-MS-Exchange-CrossTenant-OriginalAttributedTenantConnectingIp: TenantId=d36035c5-6ce6-4662-a3dc-e762e61ae4c9; Ip=[158.140.1.28]; Helo=[sjmaillnx2.cadence.com] X-MS-Exchange-CrossTenant-FromEntityHeader: HybridOnPrem X-MS-Exchange-Transport-CrossTenantHeadersStamped: CY1PR07MB2248 X-Proofpoint-SPF-Result: pass X-Proofpoint-SPF-Record: v=spf1 include:_spf.salesforce.com include:mktomail.com include:spf-0014ca01.pphosted.com include:spf.protection.outlook.com include:auth.msgapp.com include:spf.mandrillapp.com ~all X-Proofpoint-Virus-Version: vendor=fsecure engine=2.50.10434:, , definitions=2019-02-22_13:, , signatures=0 X-Proofpoint-Spam-Details: rule=outbound_check_notspam policy=outbound_check score=0 priorityscore=1501 malwarescore=0 suspectscore=0 phishscore=0 bulkscore=0 spamscore=0 clxscore=1011 lowpriorityscore=0 mlxscore=0 impostorscore=0 mlxlogscore=948 adultscore=0 classifier=spam adjust=0 reason=mlx scancount=1 engine=8.0.1-1810050000 definitions=main-1902220138 Sender: netdev-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: netdev@vger.kernel.org This patch modify MDIO read/write functions to support communication with C45 PHY in Cadence ethernet controller driver. Signed-off-by: Parshuram Thombare --- drivers/net/ethernet/cadence/macb.h | 15 +++++-- drivers/net/ethernet/cadence/macb_main.c | 61 ++++++++++++++++++++++++----- 2 files changed, 61 insertions(+), 15 deletions(-) diff --git a/drivers/net/ethernet/cadence/macb.h b/drivers/net/ethernet/cadence/macb.h index bed4ded..59c23e0 100644 --- a/drivers/net/ethernet/cadence/macb.h +++ b/drivers/net/ethernet/cadence/macb.h @@ -636,10 +636,17 @@ #define GEM_CLK_DIV96 5 /* Constants for MAN register */ -#define MACB_MAN_SOF 1 -#define MACB_MAN_WRITE 1 -#define MACB_MAN_READ 2 -#define MACB_MAN_CODE 2 +#define MACB_MAN_C22_SOF 1 +#define MACB_MAN_C22_WRITE 1 +#define MACB_MAN_C22_READ 2 +#define MACB_MAN_C22_CODE 2 + +#define MACB_MAN_C45_SOF 0 +#define MACB_MAN_C45_ADDR 0 +#define MACB_MAN_C45_WRITE 1 +#define MACB_MAN_C45_POST_READ_INCR 2 +#define MACB_MAN_C45_READ 3 +#define MACB_MAN_C45_CODE 2 /* Capability mask bits */ #define MACB_CAPS_ISR_CLEAR_ON_WRITE 0x00000001 diff --git a/drivers/net/ethernet/cadence/macb_main.c b/drivers/net/ethernet/cadence/macb_main.c index 4f4f8e5..2494abf 100644 --- a/drivers/net/ethernet/cadence/macb_main.c +++ b/drivers/net/ethernet/cadence/macb_main.c @@ -323,11 +323,30 @@ static int macb_mdio_read(struct mii_bus *bus, int mii_id, int regnum) struct macb *bp = bus->priv; int value; - macb_writel(bp, MAN, (MACB_BF(SOF, MACB_MAN_SOF) - | MACB_BF(RW, MACB_MAN_READ) - | MACB_BF(PHYA, mii_id) - | MACB_BF(REGA, regnum) - | MACB_BF(CODE, MACB_MAN_CODE))); + if (regnum & MII_ADDR_C45) { + macb_writel(bp, MAN, (MACB_BF(SOF, MACB_MAN_C45_SOF) + | MACB_BF(RW, MACB_MAN_C45_ADDR) + | MACB_BF(PHYA, mii_id) + | MACB_BF(REGA, (regnum >> 16) & 0x1F) + | MACB_BF(DATA, regnum & 0xFFFF) + | MACB_BF(CODE, MACB_MAN_C45_CODE))); + + /* wait for end of transfer */ + while (!MACB_BFEXT(IDLE, macb_readl(bp, NSR))) + cpu_relax(); + + macb_writel(bp, MAN, (MACB_BF(SOF, MACB_MAN_C45_SOF) + | MACB_BF(RW, MACB_MAN_C45_READ) + | MACB_BF(PHYA, mii_id) + | MACB_BF(REGA, (regnum >> 16) & 0x1F) + | MACB_BF(CODE, MACB_MAN_C45_CODE))); + } else { + macb_writel(bp, MAN, (MACB_BF(SOF, MACB_MAN_C22_SOF) + | MACB_BF(RW, MACB_MAN_C22_READ) + | MACB_BF(PHYA, mii_id) + | MACB_BF(REGA, regnum) + | MACB_BF(CODE, MACB_MAN_C22_CODE))); + } /* wait for end of transfer */ while (!MACB_BFEXT(IDLE, macb_readl(bp, NSR))) @@ -343,12 +362,32 @@ static int macb_mdio_write(struct mii_bus *bus, int mii_id, int regnum, { struct macb *bp = bus->priv; - macb_writel(bp, MAN, (MACB_BF(SOF, MACB_MAN_SOF) - | MACB_BF(RW, MACB_MAN_WRITE) - | MACB_BF(PHYA, mii_id) - | MACB_BF(REGA, regnum) - | MACB_BF(CODE, MACB_MAN_CODE) - | MACB_BF(DATA, value))); + if (regnum & MII_ADDR_C45) { + macb_writel(bp, MAN, (MACB_BF(SOF, MACB_MAN_C45_SOF) + | MACB_BF(RW, MACB_MAN_C45_ADDR) + | MACB_BF(PHYA, mii_id) + | MACB_BF(REGA, (regnum >> 16) & 0x1F) + | MACB_BF(DATA, regnum & 0xFFFF) + | MACB_BF(CODE, MACB_MAN_C45_CODE))); + + /* wait for end of transfer */ + while (!MACB_BFEXT(IDLE, macb_readl(bp, NSR))) + cpu_relax(); + + macb_writel(bp, MAN, (MACB_BF(SOF, MACB_MAN_C45_SOF) + | MACB_BF(RW, MACB_MAN_C45_WRITE) + | MACB_BF(PHYA, mii_id) + | MACB_BF(REGA, (regnum >> 16) & 0x1F) + | MACB_BF(CODE, MACB_MAN_C45_CODE) + | MACB_BF(DATA, value))); //Data + } else { + macb_writel(bp, MAN, (MACB_BF(SOF, MACB_MAN_C22_SOF) + | MACB_BF(RW, MACB_MAN_C22_WRITE) + | MACB_BF(PHYA, mii_id) + | MACB_BF(REGA, regnum) + | MACB_BF(CODE, MACB_MAN_C22_CODE) + | MACB_BF(DATA, value))); + } /* wait for end of transfer */ while (!MACB_BFEXT(IDLE, macb_readl(bp, NSR))) From patchwork Fri Feb 22 20:13:09 2019 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Parshuram Raju Thombare X-Patchwork-Id: 1047112 X-Patchwork-Delegate: davem@davemloft.net Return-Path: X-Original-To: patchwork-incoming-netdev@ozlabs.org Delivered-To: patchwork-incoming-netdev@ozlabs.org Authentication-Results: ozlabs.org; spf=none (mailfrom) smtp.mailfrom=vger.kernel.org (client-ip=209.132.180.67; helo=vger.kernel.org; envelope-from=netdev-owner@vger.kernel.org; receiver=) Authentication-Results: ozlabs.org; dmarc=pass (p=none dis=none) header.from=cadence.com Authentication-Results: ozlabs.org; dkim=pass (2048-bit key; unprotected) header.d=cadence.com header.i=@cadence.com header.b="KCxuoRBf"; dkim=pass (1024-bit key; unprotected) header.d=cadence.com header.i=@cadence.com header.b="WxhrSeUo"; dkim-atps=neutral Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by ozlabs.org (Postfix) with ESMTP id 445jGT2xpvz9sBL for ; Sat, 23 Feb 2019 07:13:53 +1100 (AEDT) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1727212AbfBVUNs (ORCPT ); Fri, 22 Feb 2019 15:13:48 -0500 Received: from mx0a-0014ca01.pphosted.com ([208.84.65.235]:58008 "EHLO mx0a-0014ca01.pphosted.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1725900AbfBVUNr (ORCPT ); Fri, 22 Feb 2019 15:13:47 -0500 Received: from pps.filterd (m0042385.ppops.net [127.0.0.1]) by mx0a-0014ca01.pphosted.com (8.16.0.27/8.16.0.27) with SMTP id x1MKBoZm012444; Fri, 22 Feb 2019 12:13:18 -0800 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=cadence.com; h=date : from : to : subject : message-id : mime-version : content-type; s=proofpoint; bh=e+KrvsSYuBqKPA7cIDS0Y+18LLEf+pLYpx7Qrezy8is=; b=KCxuoRBfrdcNBZXAzyUPkZvT+4DwiZUMcnkR9C7MyBB6gEh+cqmNTpNS0fGFF5dAze7+ R2SuRKX3hFnxjEGHvJBiz8SHQ+Z6vzPWu6ft/OzFwvjLAbAOZtUvHShQLvI90Y39L6bW U+SbVckkzRhMc2M9WL9CBCojCpSPnLip0EoQ+WkNAUW1UVWBSj3NBHHypfc43AEltlbe Wo06hriAV3f6tmX8XZayWcwDAEXRlTQsAq624AG61+VRhdfqXHhvVe356xV8qcn/G/bH PLdCrxfzoymdYS5eD0fD8u3RSq2XWQi2eWaN/47WIPxLMqlMQbO+RrQ/LEQUAWstzBRb nA== Authentication-Results: cadence.com; spf=pass smtp.mailfrom=pthombar@cadence.com Received: from nam03-co1-obe.outbound.protection.outlook.com (mail-co1nam03lp2055.outbound.protection.outlook.com [104.47.40.55]) by mx0a-0014ca01.pphosted.com with ESMTP id 2qsqnjqxhr-1 (version=TLSv1.2 cipher=ECDHE-RSA-AES256-SHA384 bits=256 verify=NOT); Fri, 22 Feb 2019 12:13:17 -0800 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=cadence.com; s=selector1; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=e+KrvsSYuBqKPA7cIDS0Y+18LLEf+pLYpx7Qrezy8is=; b=WxhrSeUoZOWHcoj7HtGZp565SDcbCv7/XKQ1lZHklcjKdrz5ZJX/hKvlewLEOE8/QZOwSI3xdrTLkqTikN/aygfQNzcH8Nzf769DS2OJ3osB+vQKnrwn5YsPzIkiFAxUM6kvxVFaUlUu+2b3bo/fwoJCkDUSw+yqtb9kXRXQVNs= Received: from BYAPR07CA0092.namprd07.prod.outlook.com (2603:10b6:a03:12b::33) by DM5PR07MB3098.namprd07.prod.outlook.com (2603:10b6:3:de::8) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.1622.19; Fri, 22 Feb 2019 20:13:15 +0000 Received: from DM3NAM05FT059.eop-nam05.prod.protection.outlook.com (2a01:111:f400:7e51::200) by BYAPR07CA0092.outlook.office365.com (2603:10b6:a03:12b::33) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_CBC_SHA384) id 15.20.1622.16 via Frontend Transport; Fri, 22 Feb 2019 20:13:14 +0000 Received-SPF: SoftFail (protection.outlook.com: domain of transitioning cadence.com discourages use of 199.43.4.28 as permitted sender) Received: from rmmaillnx1.cadence.com (199.43.4.28) by DM3NAM05FT059.mail.protection.outlook.com (10.152.98.176) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_CBC_SHA384) id 15.20.1665.5 via Frontend Transport; Fri, 22 Feb 2019 20:13:13 +0000 Received: from maileu3.global.cadence.com (maileu3.cadence.com [10.160.88.99]) by rmmaillnx1.cadence.com (8.14.4/8.14.4) with ESMTP id x1MKDACM023883 (version=TLSv1/SSLv3 cipher=AES256-SHA bits=256 verify=OK); Fri, 22 Feb 2019 15:13:12 -0500 X-CrossPremisesHeadersFilteredBySendConnector: maileu3.global.cadence.com Received: from maileu3.global.cadence.com (10.160.88.99) by maileu3.global.cadence.com (10.160.88.99) with Microsoft SMTP Server (TLS) id 15.0.1367.3; Fri, 22 Feb 2019 21:13:09 +0100 Received: from lvlogina.cadence.com (10.165.176.102) by maileu3.global.cadence.com (10.160.88.99) with Microsoft SMTP Server (TLS) id 15.0.1367.3 via Frontend Transport; Fri, 22 Feb 2019 21:13:09 +0100 Received: from lvlogina.cadence.com (localhost.localdomain [127.0.0.1]) by lvlogina.cadence.com (8.14.4/8.14.4) with ESMTP id x1MKD9hq027384; Fri, 22 Feb 2019 20:13:09 GMT Received: (from pthombar@localhost) by lvlogina.cadence.com (8.14.4/8.14.4/Submit) id x1MKD9HR027368; Fri, 22 Feb 2019 20:13:09 GMT Date: Fri, 22 Feb 2019 20:13:09 +0000 From: Parshuram Thombare To: , , , , , , , , , , Subject: [PATCH 3/3] net: ethernet: add support for high speed mac and usxgmii pcs Message-ID: <20190222201309.GA23470@lvlogina.cadence.com> MIME-Version: 1.0 Content-Disposition: inline User-Agent: Mutt/1.5.20 (2009-12-10) X-OrganizationHeadersPreserved: maileu3.global.cadence.com X-EOPAttributedMessage: 0 X-Forefront-Antispam-Report: CIP:199.43.4.28; IPV:CAL; SCL:-1; CTRY:US; EFV:NLI; SFV:NSPM; SFS:(10009020)(376002)(396003)(136003)(39860400002)(346002)(2980300002)(199004)(189003)(36092001)(2201001)(486006)(426003)(23726003)(126002)(476003)(46406003)(2906002)(106466001)(478600001)(105596002)(87636003)(336012)(68736007)(33656002)(26826003)(16586007)(42186006)(26005)(110136005)(316002)(186003)(86362001)(53936002)(58126008)(69596002)(305945005)(81156014)(97756001)(97736004)(81166006)(50466002)(8676002)(8936002)(5660300002)(356004)(47776003)(14444005)(1076003)(18370500001)(921003)(1121003); DIR:OUT; SFP:1101; SCL:1; SRVR:DM5PR07MB3098; H:rmmaillnx1.cadence.com; FPR:; SPF:SoftFail; LANG:en; PTR:InfoDomainNonexistent; A:1; MX:1; X-MS-PublicTrafficType: Email X-MS-Office365-Filtering-Correlation-Id: 827e669f-7c7f-48ee-f1de-08d699022d09 X-Microsoft-Antispam: BCL:0; PCL:0; RULEID:(2390118)(7020095)(4652040)(8989299)(5600110)(711020)(4605104)(4534185)(4627221)(201703031133081)(201702281549075)(8990200)(2017052603328)(7153060); SRVR:DM5PR07MB3098; X-MS-TrafficTypeDiagnostic: DM5PR07MB3098: X-Microsoft-Exchange-Diagnostics: 1; DM5PR07MB3098; 20:iVdrvg/YpYyiRjquaQfDf1hb/1Uw9I9nsPRLpJ7YEiOUqr8a2sncWMkKu6ackG47gP057rRIViAQu9GOo/f09MJqUub1UDtpb54AHvb2rCX9uYeomynsN+eBC94I7WqYCqFFmT3k0NTa5mfV1o1wfl4RbC/aH1bEQg6uwPfHS/BH7JbR2LlrtJDKgqB0zbFUWNWLYYYoUDsm3cY2NAkJRUwxqZeyyZvYWNU6vEY2YiMxJ+wBwIfZeZjed8dcXaU+zHbL1XBtOhvK2ENkKP8OAqcCoTZVJuZ74au3q9Fl8yx5z1ALT4CeUML0Y1Hn7sMyB4FMME5obJhjQF+8sF/LOyZ5qQX+NGOIKmA716xWczIfjFMsrpZFCvQY/LXWR5ByCEBsk1V8+NPGMhyRYy7sTD0/s3ZAlZbo/ItN+4SRNRTFujeA2p1kiMY5GBIVINlm+yKfO8AadlrcEeF9v0IJ7uBz3/caVAgBG4ImNGqaB8P3mSmmerrteTglq8NrMJzV X-Microsoft-Antispam-PRVS: X-Forefront-PRVS: 09565527D6 X-Microsoft-Exchange-Diagnostics: 1; DM5PR07MB3098; 23:fn7/VpKiim5qRb0vngTk8m1kBUta4Nk9uYiwnzQVlwAyO5EIsZ+ot78+OiZVkul8ejxt3T9DY3gAreUKpQWlmzKLHF/Yuz3Dc0ZDiLw9/ya0VXB/FymCwM+cZ4LHKFk0y9xtnquwvGh5rkBiBuLjikd/RCygzIgbt1+kOKvVBvY1SU5UDRQFshlI3k5mfzoM9BBnIFp9F4wj8OkvSDcPpPfbZ6nZWMu1Ocud250xigs8aQymSqmVlVR/PTnaKxKCIMPs8CIgRNUNEcg7lj5+r896dV91en57evwV31viM2G2Xw2tVQciH7Al59iE6DucF1KEI9nqu16Gzmyk8S6WY9AKaNdG13slOnQ+97TyM9niQV3MROSkg88VImhRupyVJs7r8Ke9Lw2W0LrZDhbnBM3nXzFnMLQrojG/9wHc5c1032uthAFMFwJtXPB3ByZ+AQazHP7526Ec2IfIDFuk0AnpVPw8Rs11SXNoDDhR0ZDLniB60Xka/i1KWie1u09T9T5X9JJZpo+xBHAfKZ/AqvAKKFNGl9gv2dBgqcSOQ7M9hg/idXW3VqpiCBccmBfiAEHxtIs3YeO/9EISYSXb+rv1Ez/NsvZCeZKAUtbHD7L6reQLn/utiRKFv84SOA2gmxmo2vCWC8tbiO1/m5qe56attezTjpcItcFNLWxCQuCEQzMW0Dr4rCvR4qLYmItt0X/BAxoTmauCi+El4VW7iW4IrVmB1bpcbcq2AxjVN+LmAj2GOwpF+O3/Qi6jm94xlss/4j3WFMeA+82WcbhEIhdmVC0fSe8R8DRhIZ+5BJFvmu6H4cltFcUPhz75qIiWTmp8Pt8guvD1Fui2x6nsOVlFvwFQQw2MgyHgOn6MPvf02hoU5l9DXbiPjf6gqgmq0kRKBTjYjP2Fj+gqzuW0naIQmUBd/rX4g6BBbPhwIQ/+yDfzngfmHBNWEZWUOiCmYWNBthMQdicBxdE9dDogZl5HZEE+C+9kVrMYh5PpoMzJoQHnvXlV599s9HIJiq1OMiNsi2z4BOHJIIBlw3K8UGw70Oh7pU2fCl1zudU9Hypuqs6MEpSXxQkRSUpfyiGH2fxEEQf9fqz2i1S3+vMNyfuYssPamCw9NXVk3oFeiqG3B0XuOQazgfg4f0ZhnKnO X-MS-Exchange-SenderADCheck: 1 X-Microsoft-Antispam-Message-Info: XJHtTr86LONU5stceZshKYcS13vbHpXE6NTwqt3Mh1ivqZ4iC+5QrDrVjXvEyCbLclee1Rc9KxpFFhqKOrUPOmkoN9/0LQCYW5sND0Ihs20M4jKPd6qZXQLFVxeuvnURUErMnyQTioeLylEfaFDbng07WYGTAe0NgftuNex/Fp6RwW/P2amvq3/Iizw8dHpFSstZuhOamPlKsu9Sq8hxXzv+2ZK5vZEmXTJqqreGpGI7hgnxm417tb777vCp2MxJOS1Iq1A2s4fWhI8i13spBDBWQjkZSyEDPaEWPis8Da/JrKVeF2VjVlwml7ehsOgn+Q1rrvt1AV5P5HETn86xk2XgrwMT8B9M/YNMj+ir1OTCCcygSWozmbLqDu3kJ6JzESksKT4KnvcL1cSx8fx/OsQ/+cMRA9BCEZaZVQfu0kI= X-Microsoft-Exchange-Diagnostics: 1; DM5PR07MB3098; 20:irKnJ36/0u6PjhA3a2klCJWhIcFdFXe0Gen6VYIXuKHQEncBPLTXKFYKaLsSTblmQl0z5wVkhmAd5Lr2uW/1UoIq64bVIv7syTiHVAMQ4F+IeupGGTOxgod64OFQ1odkdnEjRah35VaxobU8uVLTaIXAHMUR5LP1LQrGCtObnbq+AYSxijFCP0P3sIgYUwKH+be6f3qJZ9VzSP3GcBcxgkP/ZWY+dZKUS14ZtYbaB0Wm9TvvJlKS+o006BjRpnGu X-OriginatorOrg: cadence.com X-MS-Exchange-CrossTenant-OriginalArrivalTime: 22 Feb 2019 20:13:13.9821 (UTC) X-MS-Exchange-CrossTenant-Network-Message-Id: 827e669f-7c7f-48ee-f1de-08d699022d09 X-MS-Exchange-CrossTenant-Id: d36035c5-6ce6-4662-a3dc-e762e61ae4c9 X-MS-Exchange-CrossTenant-OriginalAttributedTenantConnectingIp: TenantId=d36035c5-6ce6-4662-a3dc-e762e61ae4c9; Ip=[199.43.4.28]; Helo=[rmmaillnx1.cadence.com] X-MS-Exchange-CrossTenant-FromEntityHeader: HybridOnPrem X-MS-Exchange-Transport-CrossTenantHeadersStamped: DM5PR07MB3098 X-Proofpoint-SPF-Result: pass X-Proofpoint-SPF-Record: v=spf1 include:_spf.salesforce.com include:mktomail.com include:spf-0014ca01.pphosted.com include:spf.protection.outlook.com include:auth.msgapp.com include:spf.mandrillapp.com ~all X-Proofpoint-Virus-Version: vendor=fsecure engine=2.50.10434:, , definitions=2019-02-22_13:, , signatures=0 X-Proofpoint-Spam-Details: rule=outbound_check_notspam policy=outbound_check score=0 priorityscore=1501 malwarescore=0 suspectscore=0 phishscore=0 bulkscore=0 spamscore=0 clxscore=1015 lowpriorityscore=0 mlxscore=0 impostorscore=0 mlxlogscore=999 adultscore=0 classifier=spam adjust=0 reason=mlx scancount=1 engine=8.0.1-1810050000 definitions=main-1902220139 Sender: netdev-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: netdev@vger.kernel.org This patch add support for (10G) high speed mac, usxgmii pcs and usxgmii interface in Cadence ethernet controller driver. Signed-off-by: Parshuram Thombare --- drivers/net/ethernet/cadence/macb.h | 33 +++++++++ drivers/net/ethernet/cadence/macb_main.c | 110 ++++++++++++++++++++++++++++-- include/linux/phy.h | 3 + 3 files changed, 140 insertions(+), 6 deletions(-) diff --git a/drivers/net/ethernet/cadence/macb.h b/drivers/net/ethernet/cadence/macb.h index 59c23e0..34df014 100644 --- a/drivers/net/ethernet/cadence/macb.h +++ b/drivers/net/ethernet/cadence/macb.h @@ -84,6 +84,7 @@ #define GEM_USRIO 0x000c /* User IO */ #define GEM_DMACFG 0x0010 /* DMA Configuration */ #define GEM_JML 0x0048 /* Jumbo Max Length */ +#define GEM_HS_MAC_CONFIG 0x0050 /* GEM high speed config */ #define GEM_HRB 0x0080 /* Hash Bottom */ #define GEM_HRT 0x0084 /* Hash Top */ #define GEM_SA1B 0x0088 /* Specific1 Bottom */ @@ -168,6 +169,9 @@ #define GEM_DCFG7 0x0298 /* Design Config 7 */ #define GEM_DCFG8 0x029C /* Design Config 8 */ #define GEM_DCFG10 0x02A4 /* Design Config 10 */ +#define GEM_DCFG12 0x02AC /* Design Config 12 */ +#define GEM_USX_CONTROL 0x0A80 /* USXGMII control register */ +#define GEM_USX_STATUS 0x0A88 /* USXGMII status register */ #define GEM_TXBDCTRL 0x04cc /* TX Buffer Descriptor control register */ #define GEM_RXBDCTRL 0x04d0 /* RX Buffer Descriptor control register */ @@ -275,6 +279,8 @@ #define MACB_IRXFCS_SIZE 1 /* GEM specific NCR bitfields. */ +#define GEM_ENABLE_HS_MAC_OFFSET 31 +#define GEM_ENABLE_HS_MAC_SIZE 1 #define GEM_TWO_PT_FIVE_GIG_OFFSET 29 #define GEM_TWO_PT_FIVE_GIG_SIZE 1 @@ -463,6 +469,10 @@ #define MACB_REV_OFFSET 0 #define MACB_REV_SIZE 16 +/* Bitfield in HS_MAC_CONFIG */ +#define GEM_HS_MAC_SPEED_OFFSET 0 +#define GEM_HS_MAC_SPEED_SIZE 3 + /* Bitfields in DCFG1. */ #define GEM_IRQCOR_OFFSET 23 #define GEM_IRQCOR_SIZE 1 @@ -504,6 +514,28 @@ #define GEM_RXBD_RDBUFF_OFFSET 8 #define GEM_RXBD_RDBUFF_SIZE 4 +/* Bitfields in DCFG12. */ +#define GEM_HIGH_SPEED_OFFSET 26 +#define GEM_HIGH_SPEED_SIZE 1 + +/* Bitfields in USX_CONTROL. */ +#define GEM_USX_CTRL_SPEED_OFFSET 14 +#define GEM_USX_CTRL_SPEED_SIZE 3 +#define GEM_SERDES_RATE_OFFSET 12 +#define GEM_SERDES_RATE_SIZE 2 +#define GEM_TX_EN_OFFSET 1 +#define GEM_TX_EN_SIZE 1 +#define GEM_SIGNAL_OK_OFFSET 0 +#define GEM_SIGNAL_OK_SIZE 1 + +/* Bitfields in USX_STATUS. */ +#define GEM_USX_TX_FAULT_OFFSET 28 +#define GEM_USX_TX_FAULT_SIZE 1 +#define GEM_USX_RX_FAULT_OFFSET 27 +#define GEM_USX_RX_FAULT_SIZE 1 +#define GEM_USX_BLOCK_LOCK_OFFSET 0 +#define GEM_USX_BLOCK_LOCK_SIZE 1 + /* Bitfields in TISUBN */ #define GEM_SUBNSINCR_OFFSET 0 #define GEM_SUBNSINCR_SIZE 16 @@ -664,6 +696,7 @@ #define MACB_CAPS_MACB_IS_GEM 0x80000000 #define MACB_CAPS_PCS 0x01000000 #define MACB_CAPS_TWO_PT_FIVE_GIG_SPEED 0x02000000 +#define MACB_CAPS_HIGH_SPEED 0x04000000 #define MACB_GEM7010_IDNUM 0x009 #define MACB_GEM7014_IDNUM 0x107 diff --git a/drivers/net/ethernet/cadence/macb_main.c b/drivers/net/ethernet/cadence/macb_main.c index 2494abf..0e0acf9 100644 --- a/drivers/net/ethernet/cadence/macb_main.c +++ b/drivers/net/ethernet/cadence/macb_main.c @@ -79,6 +79,21 @@ */ #define MACB_HALT_TIMEOUT 1230 +enum { + HS_MAC_SPEED_100M, + HS_MAC_SPEED_1000M, + HS_MAC_SPEED_2500M, + HS_MAC_SPEED_5000M, + HS_MAC_SPEED_10000M, + HS_MAC_SPEED_25000M, +}; + +enum { + MACB_SERDES_RATE_5_PT_15625Gbps, + MACB_SERDES_RATE_10_PT_3125Gbps, + MACB_SERDES_RATE_25_PT_78125Gbps, +}; + /* DMA buffer descriptor might be different size * depends on hardware configuration: * @@ -443,6 +458,20 @@ static void macb_set_tx_clk(struct clk *clk, int speed, default: return; } + } else if (interface == PHY_INTERFACE_MODE_USXGMII) { + struct macb *bp = netdev_priv(dev); + u32 serdes_rate = GEM_BFEXT(SERDES_RATE, + gem_readl(bp, USX_CONTROL)); + switch (serdes_rate) { + case MACB_SERDES_RATE_5_PT_15625Gbps: + rate = 78125000; + break; + case MACB_SERDES_RATE_10_PT_3125Gbps: + rate = 156250000; + break; + default: + return; + } } else { return; } @@ -475,7 +504,7 @@ static void macb_handle_link_change(struct net_device *dev) if (phydev->link && (bp->speed != phydev->speed || bp->duplex != phydev->duplex)) { - u32 reg; + u32 reg, speed; reg = macb_readl(bp, NCFGR); reg &= ~(MACB_BIT(SPD) | MACB_BIT(FD)); @@ -485,7 +514,53 @@ static void macb_handle_link_change(struct net_device *dev) reg |= MACB_BIT(FD); macb_or_gem_writel(bp, NCFGR, reg); - if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII && + if ((bp->phy_interface == PHY_INTERFACE_MODE_USXGMII || + bp->phy_interface == PHY_INTERFACE_MODE_XGMII) && + phydev->speed >= SPEED_100) { + gem_writel(bp, NCR, gem_readl(bp, NCR) | + GEM_BIT(ENABLE_HS_MAC)); + if (bp->phy_interface == PHY_INTERFACE_MODE_USXGMII) { + /* Setup USXGMII PCS */ + reg = gem_readl(bp, USX_CONTROL); + reg = GEM_BFINS(SERDES_RATE, + MACB_SERDES_RATE_5_PT_15625Gbps, + reg); + gem_writel(bp, USX_CONTROL, reg | + GEM_BIT(TX_EN) | + GEM_BIT(SIGNAL_OK)); + while (!GEM_BFEXT(USX_BLOCK_LOCK, + gem_readl(bp, USX_STATUS))) + cpu_relax(); + } + switch (phydev->speed) { + case SPEED_10000: + speed = HS_MAC_SPEED_10000M; + break; + + case SPEED_5000: + speed = HS_MAC_SPEED_5000M; + break; + + case SPEED_2500: + speed = HS_MAC_SPEED_2500M; + break; + + case SPEED_1000: + speed = HS_MAC_SPEED_1000M; + break; + + default: + case SPEED_100: + speed = HS_MAC_SPEED_100M; + break; + } + gem_writel(bp, HS_MAC_CONFIG, + GEM_BFINS(HS_MAC_SPEED, speed, + gem_readl(bp, HS_MAC_CONFIG))); + gem_writel(bp, USX_CONTROL, + GEM_BFINS(USX_CTRL_SPEED, speed, + gem_readl(bp, USX_CONTROL))); + } else if (bp->phy_interface == PHY_INTERFACE_MODE_SGMII && (phydev->speed == SPEED_1000 || phydev->speed == SPEED_2500)) { if (bp->caps & MACB_CAPS_TWO_PT_FIVE_GIG_SPEED) { @@ -627,10 +702,15 @@ static int macb_mii_probe(struct net_device *dev) /* mask with MAC supported features */ if (macb_is_gem(bp)) { - linkmode_copy(phydev->supported, PHY_GBIT_FEATURES); - if (bp->caps & MACB_CAPS_TWO_PT_FIVE_GIG_SPEED) - linkmode_set_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, - phydev->supported); + if (bp->caps & MACB_CAPS_HIGH_SPEED) { + linkmode_copy(phydev->supported, PHY_10GBIT_FEATURES); + } else { + u32 bitmask = ETHTOOL_LINK_MODE_2500baseT_Full_BIT; + + linkmode_copy(phydev->supported, PHY_GBIT_FEATURES); + if (bp->caps & MACB_CAPS_TWO_PT_FIVE_GIG_SPEED) + linkmode_set_bit(bitmask, phydev->supported); + } } else { linkmode_copy(phydev->supported, PHY_BASIC_FEATURES); } @@ -3344,6 +3424,9 @@ static void macb_configure_caps(struct macb *bp, bp->caps |= MACB_CAPS_ISR_CLEAR_ON_WRITE; if (GEM_BFEXT(NO_PCS, dcfg) == 0) bp->caps |= MACB_CAPS_PCS; + dcfg = gem_readl(bp, DCFG12); + if (GEM_BFEXT(HIGH_SPEED, dcfg) == 1) + bp->caps |= MACB_CAPS_HIGH_SPEED; switch (MACB_BFEXT(IDNUM, macb_readl(bp, MID))) { case MACB_GEM7016_IDNUM: case MACB_GEM7017_IDNUM: @@ -4215,6 +4298,21 @@ static int macb_probe(struct platform_device *pdev) bp->phy_interface = PHY_INTERFACE_MODE_MII; } else { switch (err) { + case PHY_INTERFACE_MODE_USXGMII: + if ((bp->caps & MACB_CAPS_HIGH_SPEED) && + (bp->caps & MACB_CAPS_PCS)) { + bp->phy_interface = PHY_INTERFACE_MODE_USXGMII; + break; + } + /* Fallthrough */ + + case PHY_INTERFACE_MODE_XGMII: + if (bp->caps & MACB_CAPS_HIGH_SPEED) { + bp->phy_interface = PHY_INTERFACE_MODE_XGMII; + break; + } + /* Fallthrough */ + case PHY_INTERFACE_MODE_SGMII: if (bp->caps & MACB_CAPS_PCS) { bp->phy_interface = PHY_INTERFACE_MODE_SGMII; diff --git a/include/linux/phy.h b/include/linux/phy.h index 8e9fc57..b627e30 100644 --- a/include/linux/phy.h +++ b/include/linux/phy.h @@ -94,6 +94,7 @@ PHY_INTERFACE_MODE_RTBI, PHY_INTERFACE_MODE_SMII, PHY_INTERFACE_MODE_XGMII, + PHY_INTERFACE_MODE_USXGMII, PHY_INTERFACE_MODE_MOCA, PHY_INTERFACE_MODE_QSGMII, PHY_INTERFACE_MODE_TRGMII, @@ -162,6 +163,8 @@ unsigned int phy_supported_speeds(struct phy_device *phy, return "smii"; case PHY_INTERFACE_MODE_XGMII: return "xgmii"; + case PHY_INTERFACE_MODE_USXGMII: + return "usxgmii"; case PHY_INTERFACE_MODE_MOCA: return "moca"; case PHY_INTERFACE_MODE_QSGMII: