Received: by 2002:a25:8b91:0:0:0:0:0 with SMTP id j17csp1321931ybl; Wed, 18 Dec 2019 16:42:04 -0800 (PST) X-Google-Smtp-Source: APXvYqxXWmIYrdrtkkZQISWHY8i27ujM9iEq48/HESXj/owYBfCY7azih9K8fNMo83Im+pbrdjD7 X-Received: by 2002:a9d:75da:: with SMTP id c26mr5711771otl.40.1576716124050; Wed, 18 Dec 2019 16:42:04 -0800 (PST) ARC-Seal: i=1; a=rsa-sha256; t=1576716124; cv=none; d=google.com; s=arc-20160816; b=ZWWYlD7jB4w1frD5rHbu2LRBYmTkrPWDjpU5o0u3bLK6VjBRc+fMdcD7yrAws8X1Cy td9AMXNRFX1KAfgDnHCs6QVSt9+SMl2EHRdJ+IesFFCymot79/sxPxxq1Q5Zarxh6GFA 521BjaxHRVceExdJZl6RXxs0ejVgVLSiKLY5B+qucSUeE/1Nm7787tdIONomc9IwWBIt XVQByG0NCMru+OeIGSNsVEapd8tldWeCVlc/z4u5wmTHPmsHXcxuHiWx5G5teMrIEopG c63uDUuuJBJG5ajyGOcx6LQoFVgYNZV1veHkDYuTNs+Xsqg44kjdfpCbB17vC3k9tCcT Wh2A== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:sender:dkim-signature:content-language :content-transfer-encoding:in-reply-to:mime-version:user-agent:date :message-id:from:references:cc:to:subject; bh=FOmuU/3uHYuRnI+/RGSno7P4BhpLQ674aEV/2xhwncE=; b=0VGS+LuWmlBsJGKPddJEJjtTbJUCoiEbccJ+1DR3H4eJXtNnFh9R2qxpPXz4KJkzj/ v0CYdwONa4zsPkxIGZ/HJRVXLXNyFarR2mMHXw2bYly14auqud2M1ibI92zP6Ivh7VNf ZIFs2O4qAZOPZ6VPMkE+UctBXvorPfx85J1WX2J3dWUvE0wOg0aUlGqqVV1usNL6wxTP q3HBOYl7SWGLwE2ddPRsLMJtEunx8f5X3yrph8f/dficQ7LYX6F2JBWytoplw9bdG7Dq 0Vmc5d7BK1SVUlcGPUURiKdzQxHWCfp9TQ+NIksgBvotziebUrhtEbFNtfne7UJOoTzK HtSw== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@nvidia.com header.s=n1 header.b=jytmpAem; spf=pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=nvidia.com Return-Path: Received: from vger.kernel.org (vger.kernel.org. [209.132.180.67]) by mx.google.com with ESMTP id e64si2244655oif.210.2019.12.18.16.41.51; Wed, 18 Dec 2019 16:42:04 -0800 (PST) Received-SPF: pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) client-ip=209.132.180.67; Authentication-Results: mx.google.com; dkim=pass header.i=@nvidia.com header.s=n1 header.b=jytmpAem; spf=pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=nvidia.com Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1726736AbfLSAlJ (ORCPT + 99 others); Wed, 18 Dec 2019 19:41:09 -0500 Received: from hqnvemgate26.nvidia.com ([216.228.121.65]:5037 "EHLO hqnvemgate26.nvidia.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1726536AbfLSAlI (ORCPT ); Wed, 18 Dec 2019 19:41:08 -0500 Received: from hqpgpgate101.nvidia.com (Not Verified[216.228.121.13]) by hqnvemgate26.nvidia.com (using TLS: TLSv1.2, DES-CBC3-SHA) id ; Wed, 18 Dec 2019 16:40:57 -0800 Received: from hqmail.nvidia.com ([172.20.161.6]) by hqpgpgate101.nvidia.com (PGP Universal service); Wed, 18 Dec 2019 16:41:07 -0800 X-PGP-Universal: processed; by hqpgpgate101.nvidia.com on Wed, 18 Dec 2019 16:41:07 -0800 Received: from [10.2.164.84] (172.20.13.39) by HQMAIL107.nvidia.com (172.20.187.13) with Microsoft SMTP Server (TLS) id 15.0.1473.3; Thu, 19 Dec 2019 00:41:05 +0000 Subject: Re: [PATCH v4 06/19] soc: tegra: Add Tegra PMC clock registrations into PMC driver To: Dmitry Osipenko , , , , , , , CC: , , , , , , , , , , References: <1576613046-17159-1-git-send-email-skomatineni@nvidia.com> <1576613046-17159-7-git-send-email-skomatineni@nvidia.com> <87b2b266-e4a9-9a7a-2336-6ec57d7c4d1d@gmail.com> <55a56c3d-3fac-cc77-46ae-acf5de77d262@gmail.com> From: Sowjanya Komatineni Message-ID: Date: Wed, 18 Dec 2019 16:41:04 -0800 User-Agent: Mozilla/5.0 (X11; Linux x86_64; rv:60.0) Gecko/20100101 Thunderbird/60.7.2 MIME-Version: 1.0 In-Reply-To: X-Originating-IP: [172.20.13.39] X-ClientProxiedBy: HQMAIL107.nvidia.com (172.20.187.13) To HQMAIL107.nvidia.com (172.20.187.13) Content-Type: text/plain; charset="utf-8"; format=flowed Content-Transfer-Encoding: quoted-printable Content-Language: en-US DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=nvidia.com; s=n1; t=1576716057; bh=FOmuU/3uHYuRnI+/RGSno7P4BhpLQ674aEV/2xhwncE=; h=X-PGP-Universal:Subject:To:CC:References:From:Message-ID:Date: User-Agent:MIME-Version:In-Reply-To:X-Originating-IP: X-ClientProxiedBy:Content-Type:Content-Transfer-Encoding: Content-Language; b=jytmpAem3/m9oewetwsDpI+M/UWc7vMrsg0ya1r20hq5gAlvyg49ury2pjidJ8onB i1uImLCe4t3qxHF3V/V7psSkVfg7YNrvfhSvudIOLkw5ftVWzf7aaUbNyR8a5j+uF5 mHCnSE0KcImsCmXAGr4beMhMtyApfjPUqQGe/uxFtduN+R3dBeVkkLz1CPnEdp276g ZmtOtDe2u4ejLNeAc8prRVrHsRWYq4wzInGD4S7E2yyMBkokPztk2p2Y2+nqLO7GSw D6y+3f9b1x3CgdLpvG5kq3bO9SZLBgGB8xP3KL6johFQAOAqu9XajCtN2dmzT/X5cx Dao94jHZHiUEQ== Sender: linux-kernel-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org On 12/18/19 1:44 PM, Dmitry Osipenko wrote: > 18.12.2019 11:35, Dmitry Osipenko =D0=BF=D0=B8=D1=88=D0=B5=D1=82: >> 18.12.2019 11:30, Dmitry Osipenko =D0=BF=D0=B8=D1=88=D0=B5=D1=82: >>> 17.12.2019 23:03, Sowjanya Komatineni =D0=BF=D0=B8=D1=88=D0=B5=D1=82: >>>> Tegra PMC has clk_out_1, clk_out_2, and clk_out_3 clocks and currently >>>> these PMC clocks are registered by Tegra clock driver with each clock = as >>>> separate mux and gate clocks using clk_register_mux and clk_register_g= ate >>>> by passing PMC base address and register offsets and PMC programming f= or >>>> these clocks happens through direct PMC access by the clock driver. >>>> >>>> With this, when PMC is in secure mode any direct PMC access from the >>>> non-secure world does not go through and these clocks will not be >>>> functional. >>>> >>>> This patch adds these PMC clocks registration to pmc driver with PMC a= s >>>> a clock provider and registers each clock as single clock. >>>> >>>> clk_ops callback implementations for these clocks uses tegra_pmc_readl= and >>>> tegra_pmc_writel which supports PMC programming in both secure mode an= d >>>> non-secure mode. >>>> >>>> Signed-off-by: Sowjanya Komatineni >>>> --- >>>> drivers/soc/tegra/pmc.c | 248 ++++++++++++++++++++++++++++++++++++++= ++++++++++ >>>> 1 file changed, 248 insertions(+) >>>> >>>> diff --git a/drivers/soc/tegra/pmc.c b/drivers/soc/tegra/pmc.c >>>> index ea0e11a09c12..6d65194a6e71 100644 >>>> --- a/drivers/soc/tegra/pmc.c >>>> +++ b/drivers/soc/tegra/pmc.c >>>> @@ -13,6 +13,9 @@ >>>> =20 >>>> #include >>>> #include >>>> +#include >>>> +#include >>>> +#include >>>> #include >>>> #include >>>> #include >>>> @@ -48,6 +51,7 @@ >>>> #include >>>> #include >>>> #include >>>> +#include >>>> =20 >>>> #define PMC_CNTRL 0x0 >>>> #define PMC_CNTRL_INTR_POLARITY BIT(17) /* inverts INTR polarity */ >>>> @@ -100,6 +104,7 @@ >>>> #define PMC_WAKE2_STATUS 0x168 >>>> #define PMC_SW_WAKE2_STATUS 0x16c >>>> =20 >>>> +#define PMC_CLK_OUT_CNTRL 0x1a8 >>>> #define PMC_SENSOR_CTRL 0x1b0 >>>> #define PMC_SENSOR_CTRL_SCRATCH_WRITE BIT(2) >>>> #define PMC_SENSOR_CTRL_ENABLE_RST BIT(1) >>>> @@ -155,6 +160,64 @@ >>>> #define TEGRA_SMC_PMC_READ 0xaa >>>> #define TEGRA_SMC_PMC_WRITE 0xbb >>>> =20 >>>> +struct pmc_clk { >>>> + struct clk_hw hw; >>>> + unsigned long offs; >>>> + u32 mux_mask; >>>> + u32 mux_shift; >>>> + u32 gate_shift; >>>> +}; >>>> + >>>> +#define to_pmc_clk(_hw) container_of(_hw, struct pmc_clk, hw) >>>> + >>>> +struct pmc_clk_init_data { >>>> + char *name; >>>> + const char *const *parents; >>>> + int num_parents; >>>> + int clk_id; >>>> + u8 mux_shift; >>>> + u8 gate_shift; >>>> +}; >>>> + >>>> +static const char * const clk_out1_parents[] =3D { "osc", "osc_div2", >>>> + "osc_div4", "extern1", >>>> +}; >>>> + >>>> +static const char * const clk_out2_parents[] =3D { "osc", "osc_div2", >>>> + "osc_div4", "extern2", >>>> +}; >>>> + >>>> +static const char * const clk_out3_parents[] =3D { "osc", "osc_div2", >>>> + "osc_div4", "extern3", >>>> +}; >>>> + >>>> +static const struct pmc_clk_init_data tegra_pmc_clks_data[] =3D { >>>> + { >>>> + .name =3D "clk_out_1", >>>> + .parents =3D clk_out1_parents, >>>> + .num_parents =3D ARRAY_SIZE(clk_out1_parents), >>>> + .clk_id =3D TEGRA_PMC_CLK_OUT_1, >>>> + .mux_shift =3D 6, >>>> + .gate_shift =3D 2, >>> I'd replace these with a single .shift, given that mux_shift =3D >>> gate_shift + 4 for all clocks. >>> >>>> + }, >>>> + { >>>> + .name =3D "clk_out_2", >>>> + .parents =3D clk_out2_parents, >>>> + .num_parents =3D ARRAY_SIZE(clk_out2_parents), >>>> + .clk_id =3D TEGRA_PMC_CLK_OUT_2, >>>> + .mux_shift =3D 14, >>>> + .gate_shift =3D 10, >>>> + }, >>>> + { >>>> + .name =3D "clk_out_3", >>>> + .parents =3D clk_out3_parents, >>>> + .num_parents =3D ARRAY_SIZE(clk_out3_parents), >>>> + .clk_id =3D TEGRA_PMC_CLK_OUT_3, >>>> + .mux_shift =3D 22, >>>> + .gate_shift =3D 18, >>>> + }, >>>> +}; >>>> + >>>> struct tegra_powergate { >>>> struct generic_pm_domain genpd; >>>> struct tegra_pmc *pmc; >>>> @@ -254,6 +317,9 @@ struct tegra_pmc_soc { >>>> */ >>>> const struct tegra_wake_event *wake_events; >>>> unsigned int num_wake_events; >>>> + >>>> + const struct pmc_clk_init_data *pmc_clks_data; >>>> + unsigned int num_pmc_clks; >>>> }; >>>> =20 >>>> static const char * const tegra186_reset_sources[] =3D { >>>> @@ -2163,6 +2229,173 @@ static int tegra_pmc_clk_notify_cb(struct noti= fier_block *nb, >>>> return NOTIFY_OK; >>>> } >>>> =20 >>>> +static void pmc_clk_fence_udelay(u32 offset) >>>> +{ >>>> + tegra_pmc_readl(pmc, offset); >>>> + /* pmc clk propagation delay 2 us */ >>>> + udelay(2); >>>> +} >>>> + >>>> +static u8 pmc_clk_mux_get_parent(struct clk_hw *hw) >>>> +{ >>>> + struct pmc_clk *clk =3D to_pmc_clk(hw); >>>> + u32 val; >>>> + >>>> + val =3D tegra_pmc_readl(pmc, clk->offs) >> clk->mux_shift; >>>> + val &=3D clk->mux_mask; >>>> + >>>> + return val; >>>> +} >>>> + >>>> +static int pmc_clk_mux_set_parent(struct clk_hw *hw, u8 index) >>>> +{ >>>> + struct pmc_clk *clk =3D to_pmc_clk(hw); >>>> + u32 val; >>>> + >>>> + val =3D tegra_pmc_readl(pmc, clk->offs); >>>> + val &=3D ~(clk->mux_mask << clk->mux_shift); >>>> + val |=3D index << clk->mux_shift; >>>> + tegra_pmc_writel(pmc, val, clk->offs); >>>> + pmc_clk_fence_udelay(clk->offs); >>>> + >>>> + return 0; >>>> +} >>>> + >>>> +static int pmc_clk_is_enabled(struct clk_hw *hw) >>>> +{ >>>> + struct pmc_clk *clk =3D to_pmc_clk(hw); >>>> + >>>> + return tegra_pmc_readl(pmc, clk->offs) & BIT(clk->gate_shift) ? 1 : = 0; >>>> +} >>>> + >>>> +static void pmc_clk_set_state(unsigned long offs, u32 shift, int stat= e) >>>> +{ >>>> + u32 val; >>>> + >>>> + val =3D tegra_pmc_readl(pmc, offs); >>>> + val =3D state ? (val | BIT(shift)) : (val & ~BIT(shift)); >>>> + tegra_pmc_writel(pmc, val, offs); >>>> + pmc_clk_fence_udelay(offs); >>>> +} >>>> + >>>> +static int pmc_clk_enable(struct clk_hw *hw) >>>> +{ >>>> + struct pmc_clk *clk =3D to_pmc_clk(hw); >>>> + >>>> + pmc_clk_set_state(clk->offs, clk->gate_shift, 1); >>>> + >>>> + return 0; >>>> +} >>>> + >>>> +static void pmc_clk_disable(struct clk_hw *hw) >>>> +{ >>>> + struct pmc_clk *clk =3D to_pmc_clk(hw); >>>> + >>>> + pmc_clk_set_state(clk->offs, clk->gate_shift, 0); >>>> +} >>>> + >>>> +static const struct clk_ops pmc_clk_ops =3D { >>>> + .get_parent =3D pmc_clk_mux_get_parent, >>>> + .set_parent =3D pmc_clk_mux_set_parent, >>>> + .determine_rate =3D __clk_mux_determine_rate, >>>> + .is_enabled =3D pmc_clk_is_enabled, >>>> + .enable =3D pmc_clk_enable, >>>> + .disable =3D pmc_clk_disable, >>>> +}; >>>> + >>>> +static struct clk * >>>> +tegra_pmc_clk_out_register(const struct pmc_clk_init_data *data, >>>> + unsigned long offset) >>>> +{ >>>> + struct clk_init_data init; >>>> + struct pmc_clk *pmc_clk; >>>> + >>>> + pmc_clk =3D kzalloc(sizeof(*pmc_clk), GFP_KERNEL); >>>> + if (!pmc_clk) >>>> + return ERR_PTR(-ENOMEM); >>>> + >>>> + init.name =3D data->name; >>>> + init.ops =3D &pmc_clk_ops; >>>> + init.parent_names =3D data->parents; >>>> + init.num_parents =3D data->num_parents; >>>> + init.flags =3D CLK_SET_RATE_NO_REPARENT | CLK_SET_RATE_PARENT | >>>> + CLK_SET_PARENT_GATE; >>>> + >>>> + pmc_clk->hw.init =3D &init; >>>> + pmc_clk->offs =3D offset; >>>> + pmc_clk->mux_mask =3D 3; >>> If mux_mask is a constant value, perhaps will be better to replace the >>> variable with a literal? >>> >>> #define PMC_CLK_OUT_MUX_MASK GENMASK(1, 0) >> Maybe even: >> >> #define PMC_CLK_OUT_MUX_MASK(c) GENMASK(c->shift + 1, c->shift) MUX Mask is used only here for PMC clock out and is same for all clk_out=20 mux so will use #define PMC_CLK_OUT_MUX_MASK GENMASK(1, 0) > I want to point out that may be a separated gate/mux shifts is a fine > variant, you should try and see whether another variants produce more > concise result. > > [snip]