From patchwork Mon Apr 20 15:54:03 2020 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 8bit X-Patchwork-Submitter: Sandipan Patra X-Patchwork-Id: 201739 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-9.9 required=3.0 tests=DKIMWL_WL_HIGH, DKIM_SIGNED, DKIM_VALID, DKIM_VALID_AU, HEADER_FROM_DIFFERENT_DOMAINS, INCLUDES_PATCH, MAILING_LIST_MULTI, SIGNED_OFF_BY, SPF_HELO_NONE, SPF_PASS, USER_AGENT_GIT autolearn=ham autolearn_force=no version=3.4.0 Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id E8052C3815B for ; Mon, 20 Apr 2020 15:53:44 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by mail.kernel.org (Postfix) with ESMTP id C26AE2082E for ; Mon, 20 Apr 2020 15:53:44 +0000 (UTC) Authentication-Results: mail.kernel.org; dkim=pass (2048-bit key) header.d=nvidia.com header.i=@nvidia.com header.b="oNeMaw4Z" Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1729160AbgDTPxo (ORCPT ); Mon, 20 Apr 2020 11:53:44 -0400 Received: from hqnvemgate26.nvidia.com ([216.228.121.65]:1696 "EHLO hqnvemgate26.nvidia.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1725875AbgDTPxn (ORCPT ); Mon, 20 Apr 2020 11:53:43 -0400 Received: from hqpgpgate101.nvidia.com (Not Verified[216.228.121.13]) by hqnvemgate26.nvidia.com (using TLS: TLSv1.2, DES-CBC3-SHA) id ; Mon, 20 Apr 2020 08:53:30 -0700 Received: from hqmail.nvidia.com ([172.20.161.6]) by hqpgpgate101.nvidia.com (PGP Universal service); Mon, 20 Apr 2020 08:53:43 -0700 X-PGP-Universal: processed; by hqpgpgate101.nvidia.com on Mon, 20 Apr 2020 08:53:43 -0700 Received: from HQMAIL109.nvidia.com (172.20.187.15) by HQMAIL107.nvidia.com (172.20.187.13) with Microsoft SMTP Server (TLS) id 15.0.1473.3; Mon, 20 Apr 2020 15:53:42 +0000 Received: from rnnvemgw01.nvidia.com (10.128.109.123) by HQMAIL109.nvidia.com (172.20.187.15) with Microsoft SMTP Server (TLS) id 15.0.1473.3 via Frontend Transport; Mon, 20 Apr 2020 15:53:42 +0000 Received: from sandipan-pc.nvidia.com (Not Verified[10.24.42.163]) by rnnvemgw01.nvidia.com with Trustwave SEG (v7, 5, 8, 10121) id ; Mon, 20 Apr 2020 08:53:42 -0700 From: Sandipan Patra To: , , , CC: , , , , , , Sandipan Patra Subject: [PATCH V2] pwm: tegra: dynamic clk freq configuration by PWM driver Date: Mon, 20 Apr 2020 21:24:03 +0530 Message-ID: <1587398043-18767-1-git-send-email-spatra@nvidia.com> X-Mailer: git-send-email 2.7.4 MIME-Version: 1.0 X-NVConfidentiality: public DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=nvidia.com; s=n1; t=1587398010; bh=LLKrRYVhJgU3tNektpkMgC8uBrNsN2ZKgfywrWWlaUM=; h=X-PGP-Universal:From:To:CC:Subject:Date:Message-ID:X-Mailer: MIME-Version:X-NVConfidentiality:Content-Type: Content-Transfer-Encoding; b=oNeMaw4ZTGDsQtkdC+rSFivTVQOmu2K+YfqUWS16vGAsw40OT0GJCDVoX+/eo8ugb QqJGhjYwoTkZ/TV8wCcgov00k3JpCG+StZy/wAwedBodJCpNR5XUqYBhfDghyxzsrw WODvJkpGPdkr1rS3d423kOPHKsmre47bF7nuoPARX0lSBqhNoEYMjmQlKr9NOkiF1K qKm2CBU+xh4QRAxCPsD0wG7Iiuy886I1CZvQeW2p7bZIKeQrHnC7cQZCrXIm59RLTA uFgoeoI/cwMd7hGvlZq+lGHY0VFivD3ERI74ohmZI7AePHJaQyYkXAQkPhRn8EMeWG syo9Zqsjtb8Ag== Sender: devicetree-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: devicetree@vger.kernel.org Added support for dynamic clock freq configuration in pwm kernel driver. Earlier the pwm driver used to cache boot time clock rate by pwm clock parent during probe. Hence dynamically changing pwm frequency was not possible for all the possible ranges. With this change, dynamic calculation is enabled and it is able to set the requested period from sysfs knob provided the value is supported by clock source. Changes mainly have 2 parts: - T186 and later chips [1] - T210 and prior chips [2] For [1] - Changes implemented to set pwm period dynamically and also checks added to allow only if requested period(ns) is below or equals to higher range. For [2] - Only checks if the requested period(ns) is below or equals to higher range defined by max clock limit. The limitation in T210 or prior chips are due to the reason of having only one pwm-controller supporting multiple channels. But later chips have multiple pwm controller instances each having single channel support. Signed-off-by: Sandipan Patra --- V2: 1. Min period_ns calculation is moved to probe. 2. Added descriptioins for PWM register bits and regarding behaviour of the controller when new configuration is applied or pwm is disabled. 3. Setting period with possible value when supplied period is below limit. 4. Corrected the earlier code comment: plus 1 instead of minus 1 during pwm calculation drivers/pwm/pwm-tegra.c | 110 +++++++++++++++++++++++++++++++++++++++++------- 1 file changed, 94 insertions(+), 16 deletions(-) diff --git a/drivers/pwm/pwm-tegra.c b/drivers/pwm/pwm-tegra.c index d26ed8f..7a36325 100644 --- a/drivers/pwm/pwm-tegra.c +++ b/drivers/pwm/pwm-tegra.c @@ -4,8 +4,39 @@ * * Tegra pulse-width-modulation controller driver * - * Copyright (c) 2010, NVIDIA Corporation. - * Based on arch/arm/plat-mxc/pwm.c by Sascha Hauer + * Copyright (c) 2010-2020, NVIDIA Corporation. + * + * Overview of Tegra Pulse Width Modulator Register: + * 1. 13-bit: Frequency division (SCALE) + * 2. 8-bit : Puls division (DUTY) + * 3. 1-bit : Enable bit + * + * The PWM clock frequency is divided by 256 before subdividing it based + * on the programmable frequency division value to generate the required + * frequency for PWM output. The maximum output frequency that can be + * achieved is (max rate of source clock) / 256. + * i.e. if source clock rate is 408 MHz, maximum output frequency cab be: + * 408 MHz/256 = 1.6 MHz. + * This 1.6 MHz frequency can further be divided using SCALE value in PWM. + * + * PWM pulse width: 8 bits are usable [23:16] for varying pulse width. + * To achieve 100% duty cycle, program Bit [24] of this register to + * 1’b1. In which case the other bits [23:16] are set to don't care. + * + * Limitations and known facts: + * - When PWM is disabled, the output is driven to 0. + * - It does not allow the current PWM period to complete and + * stops abruptly. + * + * - If the register is reconfigured while pwm is running, + * It does not let the currently running period to complete. + * + * - Pulse width of the pwm can never be out of bound. + * It's taken care at HW and SW + * - If the user input duty is below limit, then driver sets it to + * minimum possible value. + * - If anything else goes wrong for setting duty or period, + * -EINVAL is returned. */ #include @@ -41,6 +72,7 @@ struct tegra_pwm_chip { struct reset_control*rst; unsigned long clk_rate; + unsigned long min_period_ns; void __iomem *regs; @@ -67,8 +99,9 @@ static int tegra_pwm_config(struct pwm_chip *chip, struct pwm_device *pwm, int duty_ns, int period_ns) { struct tegra_pwm_chip *pc = to_tegra_pwm_chip(chip); - unsigned long long c = duty_ns, hz; - unsigned long rate; + unsigned long long p_width = duty_ns, period_hz; + unsigned long rate, required_clk_rate; + unsigned long pfm; /* Frequency divider */ u32 val = 0; int err; @@ -77,37 +110,77 @@ static int tegra_pwm_config(struct pwm_chip *chip, struct pwm_device *pwm, * per (1 << PWM_DUTY_WIDTH) cycles and make sure to round to the * nearest integer during division. */ - c *= (1 << PWM_DUTY_WIDTH); - c = DIV_ROUND_CLOSEST_ULL(c, period_ns); + p_width *= (1 << PWM_DUTY_WIDTH); + p_width = DIV_ROUND_CLOSEST_ULL(p_width, period_ns); - val = (u32)c << PWM_DUTY_SHIFT; + val = (u32)p_width << PWM_DUTY_SHIFT; + + /* + * Period in nano second has to be <= highest allowed period + * based on max clock rate of the pwm controller. + * + * higher limit = max clock limit >> PWM_DUTY_WIDTH + * lower limit = min clock limit >> PWM_DUTY_WIDTH >> PWM_SCALE_WIDTH + */ + if (period_ns < pc->min_period_ns) { + period_ns = pc->min_period_ns; + pr_warn("Period is adjusted to allowed value (%d ns)\n", + period_ns); + } /* * Compute the prescaler value for which (1 << PWM_DUTY_WIDTH) * cycles at the PWM clock rate will take period_ns nanoseconds. */ - rate = pc->clk_rate >> PWM_DUTY_WIDTH; + if (pc->soc->num_channels == 1) { + /* + * Rate is multiplied with 2^PWM_DUTY_WIDTH so that it matches + * with the hieghest applicable rate that the controller can + * provide. Any further lower value can be derived by setting + * PFM bits[0:12]. + * Higher mark is taken since BPMP has round-up mechanism + * implemented. + */ + required_clk_rate = + (NSEC_PER_SEC / period_ns) << PWM_DUTY_WIDTH; + + err = clk_set_rate(pc->clk, required_clk_rate); + if (err < 0) + return -EINVAL; + + rate = clk_get_rate(pc->clk) >> PWM_DUTY_WIDTH; + } else { + /* + * This is the case for SoCs who support multiple channels: + * + * clk_set_rate() can not be called again in config because + * T210 or any prior chip supports one pwm-controller and + * multiple channels. Hence in this case cached clock rate + * will be considered which was stored during probe. + */ + rate = pc->clk_rate >> PWM_DUTY_WIDTH; + } /* Consider precision in PWM_SCALE_WIDTH rate calculation */ - hz = DIV_ROUND_CLOSEST_ULL(100ULL * NSEC_PER_SEC, period_ns); - rate = DIV_ROUND_CLOSEST_ULL(100ULL * rate, hz); + period_hz = DIV_ROUND_CLOSEST_ULL(100ULL * NSEC_PER_SEC, period_ns); + pfm = DIV_ROUND_CLOSEST_ULL(100ULL * rate, period_hz); /* * Since the actual PWM divider is the register's frequency divider - * field minus 1, we need to decrement to get the correct value to + * field plus 1, we need to decrement to get the correct value to * write to the register. */ - if (rate > 0) - rate--; + if (pfm > 0) + pfm--; /* - * Make sure that the rate will fit in the register's frequency + * Make sure that pfm will fit in the register's frequency * divider field. */ - if (rate >> PWM_SCALE_WIDTH) + if (pfm >> PWM_SCALE_WIDTH) return -EINVAL; - val |= rate << PWM_SCALE_SHIFT; + val |= pfm << PWM_SCALE_SHIFT; /* * If the PWM channel is disabled, make sure to turn on the clock @@ -205,6 +278,10 @@ static int tegra_pwm_probe(struct platform_device *pdev) */ pwm->clk_rate = clk_get_rate(pwm->clk); + /* Set minimum limit of PWM period for the IP */ + pwm->min_period_ns = + (NSEC_PER_SEC / (pwm->soc->max_frequency >> PWM_DUTY_WIDTH)) + 1; + pwm->rst = devm_reset_control_get_exclusive(&pdev->dev, "pwm"); if (IS_ERR(pwm->rst)) { ret = PTR_ERR(pwm->rst); @@ -313,4 +390,5 @@ module_platform_driver(tegra_pwm_driver); MODULE_LICENSE("GPL"); MODULE_AUTHOR("NVIDIA Corporation"); +MODULE_AUTHOR("Sandipan Patra "); MODULE_ALIAS("platform:tegra-pwm");