Received: by 2002:a05:7412:2a8c:b0:e2:908c:2ebd with SMTP id u12csp357191rdh; Sat, 23 Sep 2023 13:42:11 -0700 (PDT) X-Google-Smtp-Source: AGHT+IHosTZmrNK4zG8QPeTM37xf3/XDCR+yDx4QduF6kiSr14D4vCQnnHpWpcGvKUu/ZwN01q6Q X-Received: by 2002:a17:90b:3e87:b0:271:80f2:52bd with SMTP id rj7-20020a17090b3e8700b0027180f252bdmr1912316pjb.35.1695501731117; Sat, 23 Sep 2023 13:42:11 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1695501731; cv=none; d=google.com; s=arc-20160816; b=vEOJ/h4T+whqdj3BXq/jnn08erIgz3GOFlTMi2+gZXL2RQOuvbGoTUCi4UqfUO3WTO fhHIXTzlp387CH/QbHWXruvE4PPmctFUzWY5hZQ2ptY0ss3xUHAPbZg5QKPUah0HkFew nJrWbhnmS7eOLumCafRyzT7WoOBLtb2MXNly3+6wA0aBwSyBVxzecdGjNHS15nEUiPMw WDGPKnFjxB1JIsxXLnZS1nvlsZhRGRn+s6Mu5kstO5vic4UjGpJB25KaTLji8VdzZoYX 0egn9mS6k9tvb6LAyzKUPdbFFmbUVNFfmVKq04alTGsjbrbDuYh6WC16OnuJ/XRJ5Y5G QsCA== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:ui-outboundreport:content-transfer-encoding :mime-version:references:in-reply-to:message-id:date:subject:cc:to :from:dkim-signature; bh=txKzUi9c1CUEa8khMJNQImhysXEC2I+gSRMJzwiJN6g=; fh=hoOCbN8oar60nKcVCK2pa4hwKApPsZi2Sf3NmsjTkUQ=; b=kH7Md9UTreB7tOuM0YNy6+5EYP+sHJUwZRWQ+cRoQGt3Iu/gOEYy+N1hwyVm+6hLE/ 1fcRkWkx7CTI/d0Ch5b91vNu8aUQDB55UJ7u2bLzB3d4yjl7oWKag2EDvFb/ZKnFy0zp ef8zweWzyxsPdZVGx2Dt464GUmmAGRsNw8S5d6UMcMVsdozshLuBxE++OqR+KkrDxjVH 0KxzOOow7l3o/KpOcqqtvhDcJywP+dzXqEBiKNNOCRE38xvd+qiVHWPXGNGfhJM2WZ1H QDieFMd4fJQIToX1pV+/AY0GHAEKsO2wYpLgXPTyTWdrEy7BnAwIcsWwvvki56TNNXes VDmA== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@gmx.net header.s=s31663417 header.b=Q2eakrtc; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.35 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=QUARANTINE dis=NONE) header.from=gmx.net Return-Path: Received: from groat.vger.email (groat.vger.email. [23.128.96.35]) by mx.google.com with ESMTPS id ct14-20020a17090af58e00b0026f3e1e9639si8868632pjb.40.2023.09.23.13.42.10 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Sat, 23 Sep 2023 13:42:11 -0700 (PDT) Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.35 as permitted sender) client-ip=23.128.96.35; Authentication-Results: mx.google.com; dkim=pass header.i=@gmx.net header.s=s31663417 header.b=Q2eakrtc; spf=pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 23.128.96.35 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=QUARANTINE dis=NONE) header.from=gmx.net Received: from out1.vger.email (depot.vger.email [IPv6:2620:137:e000::3:0]) by groat.vger.email (Postfix) with ESMTP id 92C4480A2206; Sat, 23 Sep 2023 07:35:58 -0700 (PDT) X-Virus-Status: Clean X-Virus-Scanned: clamav-milter 0.103.10 at groat.vger.email Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S231853AbjIWOfg (ORCPT + 99 others); Sat, 23 Sep 2023 10:35:36 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:57028 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S231831AbjIWOf3 (ORCPT ); Sat, 23 Sep 2023 10:35:29 -0400 Received: from mout.gmx.net (mout.gmx.net [212.227.17.20]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 05E2411D; Sat, 23 Sep 2023 07:35:21 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=gmx.net; s=s31663417; t=1695479690; x=1696084490; i=j.neuschaefer@gmx.net; bh=T2d2ejbC2mALJ1U6tDhz01Ee1erBfjfOArAZEVtwdSM=; h=X-UI-Sender-Class:From:To:Cc:Subject:Date:In-Reply-To:References; b=Q2eakrtcpDQweTLovOKQJ7ZeYGjb/X9QM2/T08dJrPf6N7Q27mGRxyBe/bGvGv/U7h/3EV5uWvD 2L18ji5A59PjThkLHsVE89Tw7uynN9jiJTYpJ4UqFhimRstEsigAnM6GD6saUMtfaHbBIXFHOdXGH oyFJuCnsmdmGHxcn6AZ9L/WR9/p0J8ebbxd19o9g41SM27KTd+cg2JaB+WgiPyFNqciDkBPkH1jt/ mzJZPomlKT21V58QZeV8oHVYTLvZVH85tiQVQ7b9NY1NY4yJAuEIFJygsQOhYOak2uXmFndnybEVu IlUzI1ExDpUzDgNz69w+UBkaCRUzSOfgk1IQ== X-UI-Sender-Class: 724b4f7f-cbec-4199-ad4e-598c01a50d3a Received: from probook ([89.0.47.152]) by mail.gmx.net (mrgmx104 [212.227.17.168]) with ESMTPSA (Nemesis) id 1Mnaof-1rR3Ns3DQz-00jZSD; Sat, 23 Sep 2023 16:34:49 +0200 From: =?UTF-8?q?Jonathan=20Neusch=C3=A4fer?= To: linux-clk@vger.kernel.org, openbmc@lists.ozlabs.org Cc: linux-kernel@vger.kernel.org, linux-watchdog@vger.kernel.org, devicetree@vger.kernel.org, =?UTF-8?q?Jonathan=20Neusch=C3=A4fer?= , Michael Turquette , Stephen Boyd , Rob Herring , Krzysztof Kozlowski , Avi Fishman , Tomer Maimon , Tali Perry , Patrick Venture , Nancy Yuen , Benjamin Fair , Daniel Lezcano , Thomas Gleixner , Philipp Zabel , Wim Van Sebroeck , Guenter Roeck , Christophe JAILLET , Conor Dooley , Joel Stanley , Arnd Bergmann , Jacky Huang , Krzysztof Kozlowski Subject: [PATCH v9 3/3] clk: wpcm450: Add Nuvoton WPCM450 clock/reset controller driver Date: Sat, 23 Sep 2023 16:34:38 +0200 Message-Id: <20230923143438.1895461-4-j.neuschaefer@gmx.net> X-Mailer: git-send-email 2.40.1 In-Reply-To: <20230923143438.1895461-1-j.neuschaefer@gmx.net> References: <20230923143438.1895461-1-j.neuschaefer@gmx.net> MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: quoted-printable X-Provags-ID: V03:K1:UDDiR30UDZZs70KEcWs0C8jVpVZQYYM940C3cIHqDAN+YQWOPtf gY/tilJ5b9uUWidZ764dbvdI+EBPG/LK8hA80F4l9YuMVklay2VGokoXE6BiQwdSE095SWj YKYDxAuqi6JMQgpRqXjUyPgQ6JQ28c6d1RQVw0R5ptV2EemXKhk4zBQIvfiCxkJo/Fduj85 ad1Zj4u+ZxKnvssVX2IqA== UI-OutboundReport: notjunk:1;M01:P0:h0IUv0SRo+s=;ZBjKZJeclrMsHqw96CLJGaEN4RX tHbs5zuUzqABWow0cicgsQqtsA78KhGUwWk6TKuwpmzX+5mzA7zqBtjcGAGQhcBZELYBZchqb NbqTcRMk+apnK9AsycvvIJTYtImqElSKoINYQeVhP5JK3P8Yx260vv/E8G06dzHiddUgfUI5O oawJ+9Bo/e8xPp4MyjCc6dzmVjaDDmC/r2nbVUsf+2ueELRe8mp+H86mkZrbgCq6uLo1DCi9C Ayn6BzsBdSP6Wws1fIV3tL1R7Ba82Nu5B+yTRkix8ORgS3BxSk7OdaqtMD9IbXlBMA1RrtX6J v+zpvHsvYpelmSo5U6TiSxvVlLdrLWgjFBnPM7ZwQZOGs7NA9rSYuaNsY+/8RKcqv3o1KTcVO q7Yx79fmbwzIW5Jm5yyjNFLUh/b4FLrCOhu37JeTIWfZusz9oKsqdTP9glTBzGE5CeZVXFFRP CTIj8Ek6GPMbuU0NjcG0zDFkGJUKTaJxo0UH2TeQq4rYV79htn11AGqnXwXAq5HDvEOlUaaxV ZUJByUTa6vtOPekR2zGWdUYqc06bLPiXhI1TDNFlwqwlOqX2a13fwtJjUxjCJ2+pbslKHeD95 IfxWTuJU8GvWLbz7FJorjq03KOwMcwWpUtLF6q+tJGu3owxBTfgi6Lod+C+Gaq5QOfYDg4BUH QC0HHTDmofQ4YP2dMDXNeSKiZZEnjK94Puq+sVBXqHuZv5vi8VzpdNCl/mv247M61zVujtzNg 7DW6NnhLeaF+WoJgU/FKYr6C2ZEYXH6pRFwYIvDFKo9eGYZ5DYRTMmYqWKS/ONMMS/h540s83 sEDq/rS4smQlTVNqFssYVI+dVdeQ0LEb34zQ70Sh3iHVpHff8JKXEt5kupCmJluaSlxONEcHT 4oN7WwnCHJD9kqAXe17V9PaRqmiwJ0+uNJWAveBgiMiJL1HdtuHX91w0Mm1xG2zYvR/fPTqHf TwTuCcKuGZwKweVZOpuhxalSEpY= X-Spam-Status: No, score=3.0 required=5.0 tests=DKIM_SIGNED,DKIM_VALID, DKIM_VALID_AU,FREEMAIL_FORGED_FROMDOMAIN,FREEMAIL_FROM, HEADER_FROM_DIFFERENT_DOMAINS,MAILING_LIST_MULTI,RCVD_IN_SBL_CSS, SPF_HELO_NONE,SPF_PASS autolearn=no autolearn_force=no version=3.4.6 X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on groat.vger.email Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org X-Greylist: Sender passed SPF test, not delayed by milter-greylist-4.6.4 (groat.vger.email [0.0.0.0]); Sat, 23 Sep 2023 07:35:58 -0700 (PDT) X-Spam-Level: ** This driver implements the following features w.r.t. the clock and reset controller in the WPCM450 SoC: - It calculates the rates for all clocks managed by the clock controller - It leaves the clock tree mostly unchanged, except that it enables/ disables clock gates based on usage. - It exposes the reset lines managed by the controller using the Generic Reset Controller subsystem NOTE: If the driver and the corresponding devicetree node are present, the driver will disable "unused" clocks. This is problem until the clock relations are properly declared in the devicetree (in a later patch). Until then, the clk_ignore_unused kernel parameter can be used as a workaround. Signed-off-by: Jonathan Neusch=C3=A4fer Reviewed-by: Joel Stanley =2D-- I have considered converting this driver to a platform driver instead of using CLK_OF_DECLARE, because platform drivers are generally the way forward. However, the timer-npcm7xx driver used on the same platform requires is initialized with TIMER_OF_DECLARE and thus requires the clocks to be available earlier than a platform driver can provide them. v9: - Apply comments made by Stephen Boyd - Move to drivers/clk/nuvoton/ directory - Update SPDX license identifier from GPL-2.0 to GPL-2.0-only - Rename clk_np variable to np - Use of_clk_hw_register - Refer to clock parents by .fw_name v8: - https://lore.kernel.org/lkml/20230428190226.1304326-3-j.neuschaefer@gmx.= net/ - Use %pe format specifier throughout the driver, as suggested by Philipp = Zabel - Add Joel's R-b v7: - https://lore.kernel.org/lkml/20230422220240.322572-3-j.neuschaefer@gmx.n= et/ - Simplify error handling by not deallocating resources v6: - Enable RESET_SIMPLE based on ARCH_WPCM450, not ARCH_NPCM, as suggested b= y Tomer Maimon v5: - https://lore.kernel.org/lkml/20221104161850.2889894-6-j.neuschaefer@gmx.= net/ - Switch to using clk_parent_data v4: - Fix reset controller initialization v3: - Change reference clock name from "refclk" to "ref" - Remove unused variable in return path of wpcm450_clk_register_pll - Remove unused divisor tables v2: - no changes =2D-- drivers/clk/Makefile | 2 +- drivers/clk/nuvoton/Kconfig | 8 +- drivers/clk/nuvoton/Makefile | 1 + drivers/clk/nuvoton/clk-wpcm450.c | 372 ++++++++++++++++++++++++++++++ drivers/reset/Kconfig | 2 +- 5 files changed, 382 insertions(+), 3 deletions(-) create mode 100644 drivers/clk/nuvoton/clk-wpcm450.c diff --git a/drivers/clk/Makefile b/drivers/clk/Makefile index 18969cbd4bb1e..de51182ef630d 100644 =2D-- a/drivers/clk/Makefile +++ b/drivers/clk/Makefile @@ -106,7 +106,7 @@ endif obj-y +=3D mstar/ obj-y +=3D mvebu/ obj-$(CONFIG_ARCH_MXS) +=3D mxs/ -obj-$(CONFIG_ARCH_MA35) +=3D nuvoton/ +obj-y +=3D nuvoton/ obj-$(CONFIG_COMMON_CLK_NXP) +=3D nxp/ obj-$(CONFIG_COMMON_CLK_PISTACHIO) +=3D pistachio/ obj-$(CONFIG_COMMON_CLK_PXA) +=3D pxa/ diff --git a/drivers/clk/nuvoton/Kconfig b/drivers/clk/nuvoton/Kconfig index fe4b7f62f4670..22c5ab409d235 100644 =2D-- a/drivers/clk/nuvoton/Kconfig +++ b/drivers/clk/nuvoton/Kconfig @@ -3,7 +3,7 @@ config COMMON_CLK_NUVOTON bool "Nuvoton clock controller common support" - depends on ARCH_MA35 || COMPILE_TEST + depends on ARCH_MA35 || ARCH_NPCM || COMPILE_TEST default y help Say y here to enable common clock controller for Nuvoton platforms. @@ -16,4 +16,10 @@ config CLK_MA35D1 help Build the clock controller driver for MA35D1 SoC. +config CLK_WPCM450 + bool "Nuvoton WPCM450 clock/reset controller support" + default y + help + Build the clock and reset controller driver for the WPCM450 SoC. + endif diff --git a/drivers/clk/nuvoton/Makefile b/drivers/clk/nuvoton/Makefile index c3c59dd9f2aaa..b130f0d3889ca 100644 =2D-- a/drivers/clk/nuvoton/Makefile +++ b/drivers/clk/nuvoton/Makefile @@ -2,3 +2,4 @@ obj-$(CONFIG_CLK_MA35D1) +=3D clk-ma35d1.o obj-$(CONFIG_CLK_MA35D1) +=3D clk-ma35d1-divider.o obj-$(CONFIG_CLK_MA35D1) +=3D clk-ma35d1-pll.o +obj-$(CONFIG_CLK_WPCM450) +=3D clk-wpcm450.o diff --git a/drivers/clk/nuvoton/clk-wpcm450.c b/drivers/clk/nuvoton/clk-w= pcm450.c new file mode 100644 index 0000000000000..9100c4b8a5648 =2D-- /dev/null +++ b/drivers/clk/nuvoton/clk-wpcm450.c @@ -0,0 +1,372 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Nuvoton WPCM450 clock and reset controller driver. + * + * Copyright (C) 2022 Jonathan Neusch=C3=A4fer + */ + +#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include + +struct wpcm450_clk_pll { + struct clk_hw hw; + void __iomem *pllcon; + u8 flags; +}; + +#define to_wpcm450_clk_pll(_hw) container_of(_hw, struct wpcm450_clk_pll,= hw) + +#define PLLCON_FBDV GENMASK(24, 16) +#define PLLCON_PRST BIT(13) +#define PLLCON_PWDEN BIT(12) +#define PLLCON_OTDV GENMASK(10, 8) +#define PLLCON_INDV GENMASK(5, 0) + +static unsigned long wpcm450_clk_pll_recalc_rate(struct clk_hw *hw, + unsigned long parent_rate) +{ + struct wpcm450_clk_pll *pll =3D to_wpcm450_clk_pll(hw); + unsigned long fbdv, indv, otdv; + u64 rate; + u32 pllcon; + + if (parent_rate =3D=3D 0) + return 0; + + pllcon =3D readl_relaxed(pll->pllcon); + + indv =3D FIELD_GET(PLLCON_INDV, pllcon) + 1; + fbdv =3D FIELD_GET(PLLCON_FBDV, pllcon) + 1; + otdv =3D FIELD_GET(PLLCON_OTDV, pllcon) + 1; + + rate =3D (u64)parent_rate * fbdv; + do_div(rate, indv * otdv); + + return rate; +} + +static int wpcm450_clk_pll_is_enabled(struct clk_hw *hw) +{ + struct wpcm450_clk_pll *pll =3D to_wpcm450_clk_pll(hw); + u32 pllcon; + + pllcon =3D readl_relaxed(pll->pllcon); + + return !(pllcon & PLLCON_PRST); +} + +static void wpcm450_clk_pll_disable(struct clk_hw *hw) +{ + struct wpcm450_clk_pll *pll =3D to_wpcm450_clk_pll(hw); + u32 pllcon; + + pllcon =3D readl_relaxed(pll->pllcon); + pllcon |=3D PLLCON_PRST | PLLCON_PWDEN; + writel(pllcon, pll->pllcon); +} + +static const struct clk_ops wpcm450_clk_pll_ops =3D { + .recalc_rate =3D wpcm450_clk_pll_recalc_rate, + .is_enabled =3D wpcm450_clk_pll_is_enabled, + .disable =3D wpcm450_clk_pll_disable +}; + +static struct clk_hw * +wpcm450_clk_register_pll(struct device_node *np, void __iomem *pllcon, co= nst char *name, + const struct clk_parent_data *parent, unsigned long flags) +{ + struct wpcm450_clk_pll *pll; + struct clk_init_data init =3D {}; + int ret; + + pll =3D kzalloc(sizeof(*pll), GFP_KERNEL); + if (!pll) + return ERR_PTR(-ENOMEM); + + init.name =3D name; + init.ops =3D &wpcm450_clk_pll_ops; + init.parent_data =3D parent; + init.num_parents =3D 1; + init.flags =3D flags; + + pll->pllcon =3D pllcon; + pll->hw.init =3D &init; + + ret =3D of_clk_hw_register(np, &pll->hw); + if (ret) { + kfree(pll); + return ERR_PTR(ret); + } + + return &pll->hw; +} + +#define REG_CLKEN 0x00 +#define REG_CLKSEL 0x04 +#define REG_CLKDIV 0x08 +#define REG_PLLCON0 0x0c +#define REG_PLLCON1 0x10 +#define REG_PMCON 0x14 +#define REG_IRQWAKECON 0x18 +#define REG_IRQWAKEFLAG 0x1c +#define REG_IPSRST 0x20 + +struct wpcm450_pll_data { + const char *name; + struct clk_parent_data parent; + unsigned int reg; + unsigned long flags; +}; + +static const struct wpcm450_pll_data pll_data[] =3D { + { "pll0", { .fw_name =3D "ref" }, REG_PLLCON0, 0 }, + { "pll1", { .fw_name =3D "ref" }, REG_PLLCON1, 0 }, +}; + +struct wpcm450_clksel_data { + const char *name; + const struct clk_parent_data *parents; + unsigned int num_parents; + const u32 *table; + int shift; + int width; + int index; + unsigned long flags; +}; + +static const u32 parent_table[] =3D { 0, 1, 2 }; + +static const struct clk_parent_data default_parents[] =3D { + { .name =3D "pll0" }, + { .name =3D "pll1" }, + { .name =3D "ref" }, +}; + +static const struct clk_parent_data huart_parents[] =3D { + { .fw_name =3D "ref" }, + { .name =3D "refdiv2" }, +}; + +static const struct wpcm450_clksel_data clksel_data[] =3D { + { "cpusel", default_parents, ARRAY_SIZE(default_parents), + parent_table, 0, 2, -1, CLK_IS_CRITICAL }, + { "clkout", default_parents, ARRAY_SIZE(default_parents), + parent_table, 2, 2, -1, 0 }, + { "usbphy", default_parents, ARRAY_SIZE(default_parents), + parent_table, 6, 2, -1, 0 }, + { "uartsel", default_parents, ARRAY_SIZE(default_parents), + parent_table, 8, 2, WPCM450_CLK_USBPHY, 0 }, + { "huartsel", huart_parents, ARRAY_SIZE(huart_parents), + parent_table, 10, 1, -1, 0 }, +}; + +static const struct clk_div_table div_fixed2[] =3D { + { .val =3D 0, .div =3D 2 }, + { } +}; + +struct wpcm450_clkdiv_data { + const char *name; + struct clk_parent_data parent; + int div_flags; + const struct clk_div_table *table; + int shift; + int width; + unsigned long flags; +}; + +static struct wpcm450_clkdiv_data clkdiv_data_early[] =3D { + { "refdiv2", { .name =3D "ref" }, 0, div_fixed2, 0, 0 }, +}; + +static const struct wpcm450_clkdiv_data clkdiv_data[] =3D { + { "cpu", { .name =3D "cpusel" }, 0, div_fixed2, 0, 0, CLK_IS_CRITICAL }, + { "adcdiv", { .name =3D "ref" }, CLK_DIVIDER_POWER_OF_TWO, NULL, 28, 2, = 0 }, + { "apb", { .name =3D "ahb" }, CLK_DIVIDER_POWER_OF_TWO, NULL, 26, 2, 0 }= , + { "ahb", { .name =3D "cpu" }, CLK_DIVIDER_POWER_OF_TWO, NULL, 24, 2, 0 }= , + { "uart", { .name =3D "uartsel" }, 0, NULL, 16, 4, 0 }, + { "ahb3", { .name =3D "ahb" }, CLK_DIVIDER_POWER_OF_TWO, NULL, 8, 2, 0 }= , +}; + +struct wpcm450_clken_data { + const char *name; + struct clk_parent_data parent; + int bitnum; + unsigned long flags; +}; + +static const struct wpcm450_clken_data clken_data[] =3D { + { "fiu", { .name =3D "ahb3" }, WPCM450_CLK_FIU, 0 }, + { "xbus", { .name =3D "ahb3" }, WPCM450_CLK_XBUS, 0 }, + { "kcs", { .name =3D "apb" }, WPCM450_CLK_KCS, 0 }, + { "shm", { .name =3D "ahb3" }, WPCM450_CLK_SHM, 0 }, + { "usb1", { .name =3D "ahb" }, WPCM450_CLK_USB1, 0 }, + { "emc0", { .name =3D "ahb" }, WPCM450_CLK_EMC0, 0 }, + { "emc1", { .name =3D "ahb" }, WPCM450_CLK_EMC1, 0 }, + { "usb0", { .name =3D "ahb" }, WPCM450_CLK_USB0, 0 }, + { "peci", { .name =3D "apb" }, WPCM450_CLK_PECI, 0 }, + { "aes", { .name =3D "apb" }, WPCM450_CLK_AES, 0 }, + { "uart0", { .name =3D "uart" }, WPCM450_CLK_UART0, 0 }, + { "uart1", { .name =3D "uart" }, WPCM450_CLK_UART1, 0 }, + { "smb2", { .name =3D "apb" }, WPCM450_CLK_SMB2, 0 }, + { "smb3", { .name =3D "apb" }, WPCM450_CLK_SMB3, 0 }, + { "smb4", { .name =3D "apb" }, WPCM450_CLK_SMB4, 0 }, + { "smb5", { .name =3D "apb" }, WPCM450_CLK_SMB5, 0 }, + { "huart", { .name =3D "huartsel" }, WPCM450_CLK_HUART, 0 }, + { "pwm", { .name =3D "apb" }, WPCM450_CLK_PWM, 0 }, + { "timer0", { .name =3D "refdiv2" }, WPCM450_CLK_TIMER0, 0 }, + { "timer1", { .name =3D "refdiv2" }, WPCM450_CLK_TIMER1, 0 }, + { "timer2", { .name =3D "refdiv2" }, WPCM450_CLK_TIMER2, 0 }, + { "timer3", { .name =3D "refdiv2" }, WPCM450_CLK_TIMER3, 0 }, + { "timer4", { .name =3D "refdiv2" }, WPCM450_CLK_TIMER4, 0 }, + { "mft0", { .name =3D "apb" }, WPCM450_CLK_MFT0, 0 }, + { "mft1", { .name =3D "apb" }, WPCM450_CLK_MFT1, 0 }, + { "wdt", { .name =3D "refdiv2" }, WPCM450_CLK_WDT, 0 }, + { "adc", { .name =3D "adcdiv" }, WPCM450_CLK_ADC, 0 }, + { "sdio", { .name =3D "ahb" }, WPCM450_CLK_SDIO, 0 }, + { "sspi", { .name =3D "apb" }, WPCM450_CLK_SSPI, 0 }, + { "smb0", { .name =3D "apb" }, WPCM450_CLK_SMB0, 0 }, + { "smb1", { .name =3D "apb" }, WPCM450_CLK_SMB1, 0 }, +}; + +static DEFINE_SPINLOCK(wpcm450_clk_lock); + +/* + * NOTE: Error handling is very rudimentary here. If the clock driver ini= tial- + * ization fails, the system is probably in bigger trouble than what is c= aused + * by a few leaked resources. + */ + +static void __init wpcm450_clk_init(struct device_node *np) +{ + struct clk_hw_onecell_data *clk_data; + static struct clk_hw **hws; + static struct clk_hw *hw; + void __iomem *clk_base; + int i, ret; + struct reset_simple_data *reset; + + clk_base =3D of_iomap(np, 0); + if (!clk_base) { + pr_err("%pOFP: failed to map registers\n", np); + of_node_put(np); + return; + } + of_node_put(np); + + clk_data =3D kzalloc(struct_size(clk_data, hws, WPCM450_NUM_CLKS), GFP_K= ERNEL); + if (!clk_data) + return; + + clk_data->num =3D WPCM450_NUM_CLKS; + hws =3D clk_data->hws; + + for (i =3D 0; i < WPCM450_NUM_CLKS; i++) + hws[i] =3D ERR_PTR(-ENOENT); + + /* PLLs */ + for (i =3D 0; i < ARRAY_SIZE(pll_data); i++) { + const struct wpcm450_pll_data *data =3D &pll_data[i]; + + hw =3D wpcm450_clk_register_pll(np, clk_base + data->reg, data->name, + &data->parent, data->flags); + if (IS_ERR(hw)) { + pr_info("Failed to register PLL: %pe\n", hw); + return; + } + } + + /* Early divisors (REF/2) */ + for (i =3D 0; i < ARRAY_SIZE(clkdiv_data_early); i++) { + const struct wpcm450_clkdiv_data *data =3D &clkdiv_data_early[i]; + + hw =3D clk_hw_register_divider_table_parent_data(NULL, data->name, &dat= a->parent, + data->flags, clk_base + REG_CLKDIV, + data->shift, data->width, + data->div_flags, data->table, + &wpcm450_clk_lock); + if (IS_ERR(hw)) { + pr_err("Failed to register div table: %pe\n", hw); + return; + } + } + + /* Selects/muxes */ + for (i =3D 0; i < ARRAY_SIZE(clksel_data); i++) { + const struct wpcm450_clksel_data *data =3D &clksel_data[i]; + + hw =3D clk_hw_register_mux_parent_data(NULL, data->name, data->parents, + data->num_parents, data->flags, + clk_base + REG_CLKSEL, data->shift, + data->width, 0, + &wpcm450_clk_lock); + if (IS_ERR(hw)) { + pr_err("Failed to register mux: %pe\n", hw); + return; + } + if (data->index >=3D 0) + clk_data->hws[data->index] =3D hw; + } + + /* Divisors */ + for (i =3D 0; i < ARRAY_SIZE(clkdiv_data); i++) { + const struct wpcm450_clkdiv_data *data =3D &clkdiv_data[i]; + + hw =3D clk_hw_register_divider_table_parent_data(NULL, data->name, &dat= a->parent, + data->flags, clk_base + REG_CLKDIV, + data->shift, data->width, + data->div_flags, data->table, + &wpcm450_clk_lock); + if (IS_ERR(hw)) { + pr_err("Failed to register divider: %pe\n", hw); + return; + } + } + + /* Enables/gates */ + for (i =3D 0; i < ARRAY_SIZE(clken_data); i++) { + const struct wpcm450_clken_data *data =3D &clken_data[i]; + + hw =3D clk_hw_register_gate_parent_data(NULL, data->name, &data->parent= , data->flags, + clk_base + REG_CLKEN, data->bitnum, + data->flags, &wpcm450_clk_lock); + if (IS_ERR(hw)) { + pr_err("Failed to register gate: %pe\n", hw); + return; + } + clk_data->hws[data->bitnum] =3D hw; + } + + ret =3D of_clk_add_hw_provider(np, of_clk_hw_onecell_get, clk_data); + if (ret) + pr_err("Failed to add DT provider: %pe\n", ERR_PTR(ret)); + + /* Reset controller */ + reset =3D kzalloc(sizeof(*reset), GFP_KERNEL); + if (!reset) + return; + reset->rcdev.owner =3D THIS_MODULE; + reset->rcdev.nr_resets =3D WPCM450_NUM_RESETS; + reset->rcdev.ops =3D &reset_simple_ops; + reset->rcdev.of_node =3D np; + reset->membase =3D clk_base + REG_IPSRST; + ret =3D reset_controller_register(&reset->rcdev); + if (ret) + pr_err("Failed to register reset controller: %pe\n", ERR_PTR(ret)); + + of_node_put(np); +} + +CLK_OF_DECLARE(wpcm450_clk_init, "nuvoton,wpcm450-clk", wpcm450_clk_init)= ; diff --git a/drivers/reset/Kconfig b/drivers/reset/Kconfig index ccd59ddd76100..1975e2f2e9e84 100644 =2D-- a/drivers/reset/Kconfig +++ b/drivers/reset/Kconfig @@ -213,7 +213,7 @@ config RESET_SCMI config RESET_SIMPLE bool "Simple Reset Controller Driver" if COMPILE_TEST || EXPERT - default ARCH_ASPEED || ARCH_BCMBCA || ARCH_BITMAIN || ARCH_REALTEK || AR= CH_STM32 || (ARCH_INTEL_SOCFPGA && ARM64) || ARCH_SUNXI || ARC + default ARCH_ASPEED || ARCH_BCMBCA || ARCH_BITMAIN || ARCH_REALTEK || AR= CH_STM32 || (ARCH_INTEL_SOCFPGA && ARM64) || ARCH_SUNXI || ARC || ARCH_WPC= M450 depends on HAS_IOMEM help This enables a simple reset controller driver for reset lines that =2D- 2.40.1