From patchwork Thu Nov 15 08:56:34 2018 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Aisheng Dong X-Patchwork-Id: 10683851 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork-2.web.codeaurora.org (Postfix) with ESMTP id 42EC317EE for ; Thu, 15 Nov 2018 08:56:58 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 3052229B7E for ; Thu, 15 Nov 2018 08:56:58 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 24BB82B678; Thu, 15 Nov 2018 08:56:58 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-8.0 required=2.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,MAILING_LIST_MULTI,RCVD_IN_DNSWL_HI autolearn=ham version=3.3.1 Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 683B029B7E for ; Thu, 15 Nov 2018 08:56:57 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1728719AbeKOTDu (ORCPT ); Thu, 15 Nov 2018 14:03:50 -0500 Received: from mail-eopbgr00067.outbound.protection.outlook.com ([40.107.0.67]:52896 "EHLO EUR02-AM5-obe.outbound.protection.outlook.com" rhost-flags-OK-OK-OK-FAIL) by vger.kernel.org with ESMTP id S1728972AbeKOTDb (ORCPT ); Thu, 15 Nov 2018 14:03:31 -0500 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=nxp.com; s=selector1; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=SWL3TXgEYDNCgDD7C+hjSoeG2UGr9YgLF6oNWl+YER8=; b=vQboaLmwykatnS6BzBckoLH6WqOLfFpucZiMQLt12WUpqqiO8j8k80Xz47H53O4ljutRgDfgX5XftdaHS0DB8SEhMFJl1fDcsSIdFSSIbN1bcIMOJLT199Y1agx4L3EwQBXgWX9VCX8SzJzRpU8HwqJrEa2W0Eu8yNdBK6TZHto= Received: from AM0PR04MB4211.eurprd04.prod.outlook.com (52.134.126.21) by AM0PR04MB4740.eurprd04.prod.outlook.com (20.176.214.225) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.1294.26; Thu, 15 Nov 2018 08:56:34 +0000 Received: from AM0PR04MB4211.eurprd04.prod.outlook.com ([fe80::797a:f972:9281:6d10]) by AM0PR04MB4211.eurprd04.prod.outlook.com ([fe80::797a:f972:9281:6d10%2]) with mapi id 15.20.1294.045; Thu, 15 Nov 2018 08:56:34 +0000 From: "A.s. Dong" To: "linux-clk@vger.kernel.org" CC: "linux-arm-kernel@lists.infradead.org" , "sboyd@kernel.org" , "mturquette@baylibre.com" , "shawnguo@kernel.org" , Fabio Estevam , dl-linux-imx , "kernel@pengutronix.de" , "A.s. Dong" Subject: [PATCH V7 6/7] clk: imx: add lpcg clock support Thread-Topic: [PATCH V7 6/7] clk: imx: add lpcg clock support Thread-Index: AQHUfMEcWityy3gEa0q65yDrl29mdg== Date: Thu, 15 Nov 2018 08:56:34 +0000 Message-ID: <1542271869-18600-7-git-send-email-aisheng.dong@nxp.com> References: <1542271869-18600-1-git-send-email-aisheng.dong@nxp.com> In-Reply-To: <1542271869-18600-1-git-send-email-aisheng.dong@nxp.com> Accept-Language: zh-CN, en-US Content-Language: en-US X-MS-Has-Attach: X-MS-TNEF-Correlator: x-mailer: git-send-email 2.7.4 x-clientproxiedby: HK0PR03CA0010.apcprd03.prod.outlook.com (2603:1096:203:2e::22) To AM0PR04MB4211.eurprd04.prod.outlook.com (2603:10a6:208:66::21) authentication-results: spf=none (sender IP is ) smtp.mailfrom=aisheng.dong@nxp.com; x-ms-exchange-messagesentrepresentingtype: 1 x-originating-ip: [119.31.174.66] x-ms-publictraffictype: Email x-microsoft-exchange-diagnostics: 1;AM0PR04MB4740;6:mkE33g7vBn2KE90v45B9lwf9ldTGdejRGFmLU6gCWCFTGNZ1//tjtK8txWxWBMvSripldtO80MOj6kFjtPY9qKDEaUK0L5MXyXhe1Tu6oCcPF2me4lq5nK6G2A5IV+FsExx8pfN/rCMRvvSl0GKH684g0vmZJuaB4aHokAXbrykvmMU91hOF7Ct/NAB0V6t14le4HqCsulA6dPYPYj2AWdNX7MjNC1La/FHUDgkTIPoqj/ioO9RpCrinnGNBwvK+0IEfOiJGdgoO8WvIRsyb7oK3l+ngc+Kq1jKcmlvJxqdFaIvgaf3E7ZpgBrHBh9JGGUeOznRMBHQAk7H4XhwETQyYX6DzI1pQJdR5ezbR1emDk/4CJxmFUK4WFkQTyYyusK9uxxasFVZT8/9dU/iZ1jEw62EPOaMc8DtZNCWBIL2L0JpIDfr9cZN/VAcWKMA0XPtzCpkyXzhFZ3PCvFAp7g==;5:BTk4dCZemFO1iPCORR7Ss4S2L69igdfQlHjvrlsk5hUNPlRZfBpjB2wgIu9CpjaUzz6E4eejzoRJENh2DoYBGQLOkmkx/kuS305I5ibAosf+Km9l2AL327sMT/ouqK9goMCqRAxC8We9/+5n4IDcghZFmHLRrGSgy53gbk28FrY=;7:/XRPa4AR+qFTmC6XYMaWTmUxENZEsZz1K3iscjv0iolNMbSWRsPk305A2RhPU6YfxXolgtHO2g5EqbOxUAuneqeBzxobmg/xKl8t1fytCqhtyaU4bVBL/IE4IeNB039MWVc/II2xG96Mox9c93ffUA== x-ms-office365-filtering-correlation-id: 091ef53d-993a-4850-9172-08d64ad83e98 x-ms-office365-filtering-ht: Tenant x-microsoft-antispam: BCL:0;PCL:0;RULEID:(2390098)(7020095)(4652040)(8989299)(5600074)(711020)(4618075)(4534185)(4627221)(201703031133081)(201702281549075)(8990200)(2017052603328)(7153060)(7193020);SRVR:AM0PR04MB4740; x-ms-traffictypediagnostic: AM0PR04MB4740: x-microsoft-antispam-prvs: x-exchange-antispam-report-test: UriScan:(185117386973197); x-ms-exchange-senderadcheck: 1 x-exchange-antispam-report-cfa-test: BCL:0;PCL:0;RULEID:(8211001083)(6040522)(2401047)(5005006)(8121501046)(3002001)(10201501046)(3231415)(944501410)(52105112)(93006095)(93001095)(6055026)(148016)(149066)(150057)(6041310)(20161123558120)(20161123562045)(20161123564045)(20161123560045)(201703131423095)(201702281528075)(20161123555045)(201703061421075)(201703061406153)(201708071742011)(7699051)(76991095);SRVR:AM0PR04MB4740;BCL:0;PCL:0;RULEID:;SRVR:AM0PR04MB4740; x-forefront-prvs: 08572BD77F x-forefront-antispam-report: SFV:NSPM;SFS:(10009020)(366004)(376002)(346002)(396003)(136003)(39860400002)(189003)(199004)(54534003)(36756003)(53936002)(5640700003)(575784001)(86362001)(6512007)(7736002)(5660300001)(305945005)(2501003)(6436002)(105586002)(2351001)(97736004)(81166006)(6916009)(6116002)(50226002)(3846002)(106356001)(8936002)(66066001)(8676002)(81156014)(11346002)(478600001)(25786009)(446003)(476003)(4326008)(486006)(2616005)(2906002)(76176011)(26005)(6506007)(186003)(102836004)(52116002)(14454004)(54906003)(14444005)(386003)(256004)(316002)(99286004)(68736007)(2900100001)(71200400001)(6486002)(71190400001);DIR:OUT;SFP:1101;SCL:1;SRVR:AM0PR04MB4740;H:AM0PR04MB4211.eurprd04.prod.outlook.com;FPR:;SPF:None;LANG:en;PTR:InfoNoRecords;MX:1;A:1; received-spf: None (protection.outlook.com: nxp.com does not designate permitted sender hosts) x-microsoft-antispam-message-info: xqL5j8sGELFUsTqW/P1BypQtBS86rRqA8ebuMbKN0jmW62Ya+awFFp141/erERduvAQhWo91N82ah2aZh1+eERJaXrNL3tkcwHl8Z/mKSeiCvay/Dwn19nVyGSJyLKlae5X+3Kl/7Bx3eQjV8LkMnlcr3Z5y37DPeNRByHGdzD1iM+XPjZpUt3gwE5lGXchKGdwiqDVwubVD9qlVynq6qKQ+4DbwG4Cq4vRum3vcLAQfIUT+3vphSjEHoY7ujw9ftBbqJbyAn4x3bIXv0Mu7NcHdCqEjqaS43OmAjSr5rIU1cgPTJ0FKzivyN+x+CO+hYJ21Oj40GT8K0fLr25vcj7L2ApFtV34en/lc0LJbO60= spamdiagnosticoutput: 1:99 spamdiagnosticmetadata: NSPM MIME-Version: 1.0 X-OriginatorOrg: nxp.com X-MS-Exchange-CrossTenant-Network-Message-Id: 091ef53d-993a-4850-9172-08d64ad83e98 X-MS-Exchange-CrossTenant-originalarrivaltime: 15 Nov 2018 08:56:34.6333 (UTC) X-MS-Exchange-CrossTenant-fromentityheader: Hosted X-MS-Exchange-CrossTenant-id: 686ea1d3-bc2b-4c6f-a92c-d99c5c301635 X-MS-Exchange-Transport-CrossTenantHeadersStamped: AM0PR04MB4740 Sender: linux-clk-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-clk@vger.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP The Low-Power Clock Gate (LPCG) modules contain a local programming model to control the clock gates for the peripherals. An LPCG module is used to locally gate the clocks for the associated peripheral. And they're bedind the SCU clock. Cc: Stephen Boyd Cc: Shawn Guo Cc: Sascha Hauer Cc: Fabio Estevam Cc: Michael Turquette Signed-off-by: Dong Aisheng --- ChangeLog: v6: separate from [PATCH V5 5/9] clk: imx: scu: add scu clock gate --- drivers/clk/imx/Makefile | 3 +- drivers/clk/imx/clk-lpcg-scu.c | 108 +++++++++++++++++++++++++++++++++++++++++ drivers/clk/imx/clk-scu.h | 3 ++ 3 files changed, 113 insertions(+), 1 deletion(-) create mode 100644 drivers/clk/imx/clk-lpcg-scu.c diff --git a/drivers/clk/imx/Makefile b/drivers/clk/imx/Makefile index 8369a34..cd2b6f0 100644 --- a/drivers/clk/imx/Makefile +++ b/drivers/clk/imx/Makefile @@ -14,7 +14,8 @@ obj-$(CONFIG_MXC_CLK) += \ clk-pfd.o obj-$(CONFIG_MXC_CLK_SCU) += \ - clk-scu.o + clk-scu.o \ + clk-lpcg-scu.o obj-$(CONFIG_SOC_IMX1) += clk-imx1.o obj-$(CONFIG_SOC_IMX21) += clk-imx21.o diff --git a/drivers/clk/imx/clk-lpcg-scu.c b/drivers/clk/imx/clk-lpcg-scu.c new file mode 100644 index 0000000..54a1cb3 --- /dev/null +++ b/drivers/clk/imx/clk-lpcg-scu.c @@ -0,0 +1,108 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * Copyright 2018 NXP + * Dong Aisheng + */ + +#include +#include +#include +#include +#include + +static DEFINE_SPINLOCK(imx_lpcg_scu_lock); + +#define CLK_GATE_SCU_LPCG_MASK 0x3 +#define CLK_GATE_SCU_LPCG_HW_SEL BIT(0) +#define CLK_GATE_SCU_LPCG_SW_SEL BIT(1) + +struct clk_lpcg_scu { + struct clk_hw hw; + void __iomem *reg; + u8 bit_idx; + bool hw_gate; +}; + +#define to_clk_lpcg_scu(_hw) container_of(_hw, struct clk_lpcg_scu, hw) + +/* Write to the LPCG bits. */ +static int clk_lpcg_scu_enable(struct clk_hw *hw) +{ + struct clk_lpcg_scu *clk = to_clk_lpcg_scu(hw); + unsigned long flags = 0; + u32 reg; + + spin_lock_irqsave(&imx_lpcg_scu_lock, flags); + + if (clk->reg) { + reg = readl(clk->reg); + reg &= ~(CLK_GATE_SCU_LPCG_MASK << clk->bit_idx); + if (clk->hw_gate) + reg |= (CLK_GATE_SCU_LPCG_HW_SEL | + CLK_GATE_SCU_LPCG_SW_SEL) << clk->bit_idx; + else + reg |= (CLK_GATE_SCU_LPCG_SW_SEL << clk->bit_idx); + writel(reg, clk->reg); + } + + spin_unlock_irqrestore(&imx_lpcg_scu_lock, flags); + + return 0; +} + +static void clk_lpcg_scu_disable(struct clk_hw *hw) +{ + struct clk_lpcg_scu *clk = to_clk_lpcg_scu(hw); + unsigned long flags = 0; + u32 reg; + + spin_lock_irqsave(&imx_lpcg_scu_lock, flags); + + if (clk->reg) { + reg = readl(clk->reg); + reg &= ~(CLK_GATE_SCU_LPCG_MASK << clk->bit_idx); + writel(reg, clk->reg); + } + + spin_unlock_irqrestore(&imx_lpcg_scu_lock, flags); +} + +static const struct clk_ops clk_lpcg_scu_ops = { + .enable = clk_lpcg_scu_enable, + .disable = clk_lpcg_scu_disable, +}; + +struct clk_hw *imx_clk_lpcg_scu(const char *name, const char *parent_name, + unsigned long flags, void __iomem *reg, + u8 bit_idx, bool hw_gate) +{ + struct clk_lpcg_scu *clk; + struct clk_init_data init; + struct clk_hw *hw; + int ret; + + clk = kzalloc(sizeof(*clk), GFP_KERNEL); + if (!clk) + return ERR_PTR(-ENOMEM); + + clk->reg = reg; + clk->bit_idx = bit_idx; + clk->hw_gate = hw_gate; + + init.name = name; + init.ops = &clk_lpcg_scu_ops; + init.flags = CLK_SET_RATE_PARENT | flags; + init.parent_names = parent_name ? &parent_name : NULL; + init.num_parents = parent_name ? 1 : 0; + + clk->hw.init = &init; + + hw = &clk->hw; + ret = clk_hw_register(NULL, hw); + if (ret) { + kfree(clk); + hw = ERR_PTR(ret); + } + + return hw; +} diff --git a/drivers/clk/imx/clk-scu.h b/drivers/clk/imx/clk-scu.h index 09f381b..b8e91b1 100644 --- a/drivers/clk/imx/clk-scu.h +++ b/drivers/clk/imx/clk-scu.h @@ -18,4 +18,7 @@ static inline int imx_clk_scu_init(void) struct clk_hw *imx_clk_scu(const char *name, u32 rsrc_id, u8 clk_type); +struct clk_hw *imx_clk_lpcg_scu(const char *name, const char *parent_name, + unsigned long flags, void __iomem *reg, + u8 bit_idx, bool hw_gate); #endif