From patchwork Fri Aug 9 04:10:24 2019 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Peng Fan X-Patchwork-Id: 1144318 X-Patchwork-Delegate: lukma@denx.de Return-Path: X-Original-To: incoming@patchwork.ozlabs.org Delivered-To: patchwork-incoming@bilbo.ozlabs.org Authentication-Results: ozlabs.org; spf=none (mailfrom) smtp.mailfrom=lists.denx.de (client-ip=81.169.180.215; helo=lists.denx.de; envelope-from=u-boot-bounces@lists.denx.de; receiver=) Authentication-Results: ozlabs.org; dmarc=fail (p=none dis=none) header.from=nxp.com Authentication-Results: ozlabs.org; dkim=fail reason="signature verification failed" (1024-bit key; unprotected) header.d=nxp.com header.i=@nxp.com header.b="F8nf0hQy"; dkim-atps=neutral Received: from lists.denx.de (dione.denx.de [81.169.180.215]) by ozlabs.org (Postfix) with ESMTP id 464Wy22td8z9sN4 for ; Fri, 9 Aug 2019 14:11:06 +1000 (AEST) Received: by lists.denx.de (Postfix, from userid 105) id 06B08C21E35; Fri, 9 Aug 2019 04:10:38 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on lists.denx.de X-Spam-Level: X-Spam-Status: No, score=0.0 required=5.0 tests=SPF_HELO_PASS, T_DKIM_INVALID autolearn=unavailable autolearn_force=no version=3.4.0 Received: from lists.denx.de (localhost [IPv6:::1]) by lists.denx.de (Postfix) with ESMTP id 896DFC21F58; Fri, 9 Aug 2019 04:10:35 +0000 (UTC) Received: by lists.denx.de (Postfix, from userid 105) id 48DBDC21E3B; Fri, 9 Aug 2019 04:10:28 +0000 (UTC) Received: from EUR02-HE1-obe.outbound.protection.outlook.com (mail-eopbgr10080.outbound.protection.outlook.com [40.107.1.80]) by lists.denx.de (Postfix) with ESMTPS id 5D4D5C21EFF for ; Fri, 9 Aug 2019 04:10:25 +0000 (UTC) ARC-Seal: i=1; a=rsa-sha256; s=arcselector9901; d=microsoft.com; cv=none; b=J3m5+kBImaiVCL7O05SqY4J8oO7YHzC+1Mmb4t2PYEMlCgDAC+b5dsJHMxSMBq/FP+td04j5SGahaiJcd25RxjIoSKnFS4dUbpW5jUoiePLHrjye2jkdjFyCV10pqspntK3KroIaJ22KhsP7dl/DvBhM8qZy8yGGnSggTIug/quLHe49vpzQcKvL5z3KyHxtcZJ4tPpwZMgAw0f/842AyfWmDCqAWtb4ugzP9ZTsRChiQZvGt/prSRq5RNyRTDzqaXTcl3f/Km4jss/YtLabKtD5lNh8uE9eZiq0AsyFD3ht3279bGzqox/7B/Py+MVKLpzDYnmsI8GTNmBwqg4nAQ== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=microsoft.com; s=arcselector9901; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=/YyEsMoxbcr+AZKXuFYbo8cDfgyfUcZVwB9GgeVTvGA=; b=ArCosDIShs39l4vxVQb+as4pBIWu7P/A3dirn9lZFx+23UITOSwG87qVsagjlhwuMFVLZM+3Wb2GyZNUsz+0GhaItxLOx97/4Pde+AEHcfcjg8lbBd1FBL8ShxUVuaS19Bkvdn4V67WeTzxNKPd+0c5YZCv2Mx4EUfFDQXQg8qt/VoeR3DD52lQdnY4nOEQh2ijijNKHUkxE9kzOq8+GCTxfTfTKkIVYj5iZKTFpLyaTTozko0RFmmA18z0NyTp0nrdU/D89bHTqNZNts2ymTbJ5423WLUhBK3czYyJcTlmUMmfuC6qYTWXv7uKMoBixOX6i53a2CttibrvMJHHKrA== ARC-Authentication-Results: i=1; mx.microsoft.com 1; spf=pass smtp.mailfrom=nxp.com; dmarc=pass action=none header.from=nxp.com; dkim=pass header.d=nxp.com; arc=none DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=nxp.com; s=selector2; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=/YyEsMoxbcr+AZKXuFYbo8cDfgyfUcZVwB9GgeVTvGA=; b=F8nf0hQytS7Sfa5XHtRWRyQEe6SItTAuDMDtTNv2gOLZLrCq2n56vJV+/wS8p5sddu/ADhlA4LoCPOPraE/6Iqwtqx/QoAMDaVDaAobk99uPH/GX+KsWaexUQgaNDlLLAREpFPZYu0oXqzfZhVFEdGniKok1Ra0+Tw+d3rm/p4A= Received: from DB7PR04MB4490.eurprd04.prod.outlook.com (52.135.138.150) by DB7PR04MB4329.eurprd04.prod.outlook.com (52.135.128.157) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.2157.16; Fri, 9 Aug 2019 04:10:24 +0000 Received: from DB7PR04MB4490.eurprd04.prod.outlook.com ([fe80::ccc8:8:c071:8283]) by DB7PR04MB4490.eurprd04.prod.outlook.com ([fe80::ccc8:8:c071:8283%5]) with mapi id 15.20.2157.020; Fri, 9 Aug 2019 04:10:24 +0000 From: Peng Fan To: "lukma@denx.de" Thread-Topic: [PATCH V2 3/4] clk: imx: add i.MX8M composite clk support Thread-Index: AQHVTmhesfEsDNLB3UWxpsRvfpL95g== Date: Fri, 9 Aug 2019 04:10:24 +0000 Message-ID: <20190809042551.31904-4-peng.fan@nxp.com> References: <20190809042551.31904-1-peng.fan@nxp.com> In-Reply-To: <20190809042551.31904-1-peng.fan@nxp.com> Accept-Language: en-US Content-Language: en-US X-MS-Has-Attach: X-MS-TNEF-Correlator: x-mailer: git-send-email 2.16.4 x-clientproxiedby: HK0PR01CA0026.apcprd01.prod.exchangelabs.com (2603:1096:203:3e::14) To DB7PR04MB4490.eurprd04.prod.outlook.com (2603:10a6:5:36::22) authentication-results: spf=none (sender IP is ) smtp.mailfrom=peng.fan@nxp.com; x-ms-exchange-messagesentrepresentingtype: 1 x-originating-ip: [119.31.174.71] x-ms-publictraffictype: Email x-ms-office365-filtering-correlation-id: 499252e2-5dfa-4cbd-ccbb-08d71c7f80a6 x-ms-office365-filtering-ht: Tenant x-microsoft-antispam: BCL:0; PCL:0; RULEID:(2390118)(7020095)(4652040)(8989299)(4534185)(4627221)(201703031133081)(201702281549075)(8990200)(5600148)(711020)(4605104)(1401327)(4618075)(2017052603328)(7193020); SRVR:DB7PR04MB4329; x-ms-traffictypediagnostic: DB7PR04MB4329: x-ms-exchange-transport-forked: True x-microsoft-antispam-prvs: x-ms-oob-tlc-oobclassifiers: OLM:229; x-forefront-prvs: 01244308DF x-forefront-antispam-report: SFV:NSPM; SFS:(10009020)(4636009)(396003)(346002)(136003)(376002)(366004)(39860400002)(189003)(199004)(11346002)(2616005)(71200400001)(99286004)(476003)(316002)(26005)(71190400001)(102836004)(8936002)(486006)(50226002)(5640700003)(6486002)(86362001)(5660300002)(186003)(1076003)(76176011)(44832011)(446003)(2501003)(256004)(52116002)(2906002)(6916009)(386003)(6506007)(3846002)(6116002)(6436002)(4326008)(53936002)(81166006)(64756008)(66946007)(478600001)(8676002)(66066001)(1730700003)(66476007)(66446008)(54906003)(66556008)(81156014)(2351001)(36756003)(25786009)(305945005)(6512007)(14454004)(7736002); DIR:OUT; SFP:1101; SCL:1; SRVR:DB7PR04MB4329; H:DB7PR04MB4490.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-ms-exchange-senderadcheck: 1 x-microsoft-antispam-message-info: vPay7lca2E4uIan9UkTodwFBcQsohTt/rKGzJmWxIq89MD2x+OxU26pPc7gs0LZvqyHQ0+nDcGrNw153MdYQKx3fX2Jh8VJdfZoxrbXdrny1MsZkonoJdiI7HC4xC4POf3FBoJUDLqVhrX8xI3DmTg9cEduzNQAqnLxwHDp9w6bDLP2paEFjEFhzVUXeVgIJIA7o/148m5VjW5+DGsh2TO5rqspHw73WB6XZEGIxZXbDnz1lHQnT9N5I/r5eRW6JY9dMMD6KrIebpCv0DioA58S21V978kjQ9Ltc89JQvSLl+hBam3YcAIsuxcXt4sBgqcdYmTEUJC9zZY5Fu+J009Vzcs5PvEday/lEc8Ps/EFykWQSY46jtzz1GIvSHyCCb11xaMgGtpuLh0MBQ2kJiRwtjlALi/DjlVDiXclMpJI= MIME-Version: 1.0 X-OriginatorOrg: nxp.com X-MS-Exchange-CrossTenant-Network-Message-Id: 499252e2-5dfa-4cbd-ccbb-08d71c7f80a6 X-MS-Exchange-CrossTenant-originalarrivaltime: 09 Aug 2019 04:10:24.2972 (UTC) X-MS-Exchange-CrossTenant-fromentityheader: Hosted X-MS-Exchange-CrossTenant-id: 686ea1d3-bc2b-4c6f-a92c-d99c5c301635 X-MS-Exchange-CrossTenant-mailboxtype: HOSTED X-MS-Exchange-CrossTenant-userprincipalname: YGFLtB4m1ONjl8gTNJonQhU4w8fcoHhED3Yr0KiCSfRdFQ+CRqpuXq9Ex69tNdpU9HCZGMAqfPEm5bWXMBy1xg== X-MS-Exchange-Transport-CrossTenantHeadersStamped: DB7PR04MB4329 Cc: "u-boot@lists.denx.de" , dl-uboot-imx Subject: [U-Boot] [PATCH V2 3/4] clk: imx: add i.MX8M composite clk support X-BeenThere: u-boot@lists.denx.de X-Mailman-Version: 2.1.18 Precedence: list List-Id: U-Boot discussion List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Errors-To: u-boot-bounces@lists.denx.de Sender: "U-Boot" Import i.MX8M composite clk from Linux Kernel 5.3.0-rc2 Signed-off-by: Peng Fan --- drivers/clk/imx/clk-composite-8m.c | 170 +++++++++++++++++++++++++++++++++++++ 1 file changed, 170 insertions(+) create mode 100644 drivers/clk/imx/clk-composite-8m.c diff --git a/drivers/clk/imx/clk-composite-8m.c b/drivers/clk/imx/clk-composite-8m.c new file mode 100644 index 0000000000..57ebbc3bb0 --- /dev/null +++ b/drivers/clk/imx/clk-composite-8m.c @@ -0,0 +1,170 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * Copyright 2019 NXP + */ + +#include +#include +#include +#include +#include +#include +#include +#include "clk.h" + +#define UBOOT_DM_CLK_IMX_COMPOSITE "imx_clk_composite" + +#define PCG_PREDIV_SHIFT 16 +#define PCG_PREDIV_WIDTH 3 +#define PCG_PREDIV_MAX 8 + +#define PCG_DIV_SHIFT 0 +#define PCG_DIV_WIDTH 6 +#define PCG_DIV_MAX 64 + +#define PCG_PCS_SHIFT 24 +#define PCG_PCS_MASK 0x7 + +#define PCG_CGC_SHIFT 28 + +static unsigned long imx8m_clk_composite_divider_recalc_rate(struct clk *clk) +{ + struct clk_divider *divider = (struct clk_divider *)to_clk_divider(clk); + struct clk_composite *composite = (struct clk_composite *)clk->data; + ulong parent_rate = clk_get_parent_rate(&composite->clk); + unsigned long prediv_rate; + unsigned int prediv_value; + unsigned int div_value; + + debug("%s: name %s prate: %lu reg: %p\n", __func__, + (&composite->clk)->dev->name, parent_rate, divider->reg); + prediv_value = readl(divider->reg) >> divider->shift; + prediv_value &= clk_div_mask(divider->width); + + prediv_rate = divider_recalc_rate(clk, parent_rate, prediv_value, + NULL, divider->flags, + divider->width); + + div_value = readl(divider->reg) >> PCG_DIV_SHIFT; + div_value &= clk_div_mask(PCG_DIV_WIDTH); + + return divider_recalc_rate(clk, prediv_rate, div_value, NULL, + divider->flags, PCG_DIV_WIDTH); +} + +static int imx8m_clk_composite_compute_dividers(unsigned long rate, + unsigned long parent_rate, + int *prediv, int *postdiv) +{ + int div1, div2; + int error = INT_MAX; + int ret = -EINVAL; + + *prediv = 1; + *postdiv = 1; + + for (div1 = 1; div1 <= PCG_PREDIV_MAX; div1++) { + for (div2 = 1; div2 <= PCG_DIV_MAX; div2++) { + int new_error = ((parent_rate / div1) / div2) - rate; + + if (abs(new_error) < abs(error)) { + *prediv = div1; + *postdiv = div2; + error = new_error; + ret = 0; + } + } + } + return ret; +} + +/* + * The clk are not binded to a dev, because it is part of composite clk + * use composite clk to get dev + */ +static ulong imx8m_clk_composite_divider_set_rate(struct clk *clk, + unsigned long rate) +{ + struct clk_divider *divider = (struct clk_divider *)to_clk_divider(clk); + struct clk_composite *composite = (struct clk_composite *)clk->data; + ulong parent_rate = clk_get_parent_rate(&composite->clk); + int prediv_value; + int div_value; + int ret; + u32 val; + + ret = imx8m_clk_composite_compute_dividers(rate, parent_rate, + &prediv_value, &div_value); + if (ret) + return -EINVAL; + + val = readl(divider->reg); + val &= ~((clk_div_mask(divider->width) << divider->shift) | + (clk_div_mask(PCG_DIV_WIDTH) << PCG_DIV_SHIFT)); + + val |= (u32)(prediv_value - 1) << divider->shift; + val |= (u32)(div_value - 1) << PCG_DIV_SHIFT; + writel(val, divider->reg); + + return clk_get_rate(&composite->clk); +} + +static const struct clk_ops imx8m_clk_composite_divider_ops = { + .get_rate = imx8m_clk_composite_divider_recalc_rate, + .set_rate = imx8m_clk_composite_divider_set_rate, +}; + +struct clk *imx8m_clk_composite_flags(const char *name, + const char * const *parent_names, + int num_parents, void __iomem *reg, + unsigned long flags) +{ + struct clk *clk = ERR_PTR(-ENOMEM); + struct clk_divider *div = NULL; + struct clk_gate *gate = NULL; + struct clk_mux *mux = NULL; + + mux = kzalloc(sizeof(*mux), GFP_KERNEL); + if (!mux) + goto fail; + + mux->reg = reg; + mux->shift = PCG_PCS_SHIFT; + mux->mask = PCG_PCS_MASK; + mux->num_parents = num_parents; + mux->flags = flags; + mux->parent_names = parent_names; + + div = kzalloc(sizeof(*div), GFP_KERNEL); + if (!div) + goto fail; + + div->reg = reg; + div->shift = PCG_PREDIV_SHIFT; + div->width = PCG_PREDIV_WIDTH; + div->flags = CLK_DIVIDER_ROUND_CLOSEST | flags; + + gate = kzalloc(sizeof(*gate), GFP_KERNEL); + if (!gate) + goto fail; + + gate->reg = reg; + gate->bit_idx = PCG_CGC_SHIFT; + gate->flags = flags; + + clk = clk_register_composite(NULL, name, + parent_names, num_parents, + &mux->clk, &clk_mux_ops, &div->clk, + &imx8m_clk_composite_divider_ops, + &gate->clk, &clk_gate_ops, flags); + if (IS_ERR(clk)) + goto fail; + + return clk; + +fail: + kfree(gate); + kfree(div); + kfree(mux); + return ERR_CAST(clk); +}