From patchwork Wed Oct 28 14:08:46 2020 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Lukasz Luba X-Patchwork-Id: 11862791 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=-12.8 required=3.0 tests=BAYES_00,DKIMWL_WL_HIGH, DKIM_SIGNED,DKIM_VALID,HEADER_FROM_DIFFERENT_DOMAINS,INCLUDES_PATCH, MAILING_LIST_MULTI,SIGNED_OFF_BY,SPF_HELO_NONE,SPF_PASS,URIBL_BLOCKED, 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 72A31C55178 for ; Wed, 28 Oct 2020 14:11:16 +0000 (UTC) Received: from merlin.infradead.org (merlin.infradead.org [205.233.59.134]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.kernel.org (Postfix) with ESMTPS id 03CD824726 for ; Wed, 28 Oct 2020 14:11:15 +0000 (UTC) Authentication-Results: mail.kernel.org; dkim=pass (2048-bit key) header.d=lists.infradead.org header.i=@lists.infradead.org header.b="EqGahuS1" DMARC-Filter: OpenDMARC Filter v1.3.2 mail.kernel.org 03CD824726 Authentication-Results: mail.kernel.org; dmarc=fail (p=none dis=none) header.from=arm.com Authentication-Results: mail.kernel.org; spf=none smtp.mailfrom=linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=merlin.20170209; h=Sender:Content-Transfer-Encoding: Content-Type:MIME-Version:Cc:List-Subscribe:List-Help:List-Post:List-Archive: List-Unsubscribe:List-Id:References:In-Reply-To:Message-Id:Date:Subject:To: From:Reply-To:Content-ID:Content-Description:Resent-Date:Resent-From: Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Owner; bh=ADmfQbru/r+mmQn8fC8D6U2i+c4m5r/cRqK618FyDVo=; b=EqGahuS1DxehiqC6+7pz9FUYry uE36pdYsfWfpUIiYzf+YkPn9nrL9KZ5Z3f/Q5PN29bwcg2AvVuGm6nz0wcv1nHt1s8+mUS4iMEs/4 doPJzzs2hwVtRkwd8bA5zp8muwnbYTL2sfO573L8kO1kJFPlAOrjF3/ggGc/anR51PfwmLhO7+RZ1 vG7Ctzm/D/0J4S+8KepT+USpFjnczZe5dhqN4oBEZLgiqNPK/EjfZ4smFOLga3aEgb9CbyfQIEiA4 HG1RedHf/avOtAqtoLKBxGTfy63SSaHsLBNjRZkCXTrSpMZtr9XjiSV0Ge4VifqPTOmlcqYLYLSbP e66FftjA==; Received: from localhost ([::1] helo=merlin.infradead.org) by merlin.infradead.org with esmtp (Exim 4.92.3 #3 (Red Hat Linux)) id 1kXm8z-00088C-KM; Wed, 28 Oct 2020 14:09:41 +0000 Received: from foss.arm.com ([217.140.110.172]) by merlin.infradead.org with esmtp (Exim 4.92.3 #3 (Red Hat Linux)) id 1kXm8l-000841-OH for linux-arm-kernel@lists.infradead.org; Wed, 28 Oct 2020 14:09:29 +0000 Received: from usa-sjc-imap-foss1.foss.arm.com (unknown [10.121.207.14]) by usa-sjc-mx-foss1.foss.arm.com (Postfix) with ESMTP id 4C08E19F0; Wed, 28 Oct 2020 07:09:26 -0700 (PDT) Received: from e123648.arm.com (unknown [10.57.12.129]) by usa-sjc-imap-foss1.foss.arm.com (Postfix) with ESMTPA id 7C95E3F66E; Wed, 28 Oct 2020 07:09:23 -0700 (PDT) From: Lukasz Luba To: linux-kernel@vger.kernel.org, linux-pm@vger.kernel.org, devicetree@vger.kernel.org, linux-arm-kernel@lists.infradead.org, vireshk@kernel.org, robh+dt@kernel.org Subject: [PATCH 3/4] OPP: Add dev_pm_opp_set_sustainable_opp_freq() Date: Wed, 28 Oct 2020 14:08:46 +0000 Message-Id: <20201028140847.1018-4-lukasz.luba@arm.com> X-Mailer: git-send-email 2.17.1 In-Reply-To: <20201028140847.1018-1-lukasz.luba@arm.com> References: <20201028140847.1018-1-lukasz.luba@arm.com> X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20201028_100927_937035_223B6795 X-CRM114-Status: GOOD ( 18.31 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.29 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: nm@ti.com, rafael@kernel.org, sboyd@kernel.org, daniel.lezcano@linaro.org, sudeep.holla@arm.com, Dietmar.Eggemann@arm.com, lukasz.luba@arm.com MIME-Version: 1.0 Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org Add a new function allowing to set sustainable OPP from the drivers code. This is helpful when the device drivers populate the OPP table by themself. Signed-off-by: Lukasz Luba --- drivers/opp/core.c | 49 ++++++++++++++++++++++++++++++++++++++++++ include/linux/pm_opp.h | 8 +++++++ 2 files changed, 57 insertions(+) diff --git a/drivers/opp/core.c b/drivers/opp/core.c index bb1e68b96d0e..753443f17327 100644 --- a/drivers/opp/core.c +++ b/drivers/opp/core.c @@ -325,6 +325,55 @@ unsigned long dev_pm_opp_get_sustainable_opp_freq(struct device *dev) } EXPORT_SYMBOL_GPL(dev_pm_opp_get_sustainable_opp_freq); +/** + * dev_pm_opp_set_sustainable_opp_freq() - Find and set the OPP sustainable + * based on given frequency + * @dev: device for which we do this operation + * @freq: frequency which OPP is going to be marked + * + * Mark the OPP of a given frequency @freq as sustainable_opp. If there is + * already sustainable OPP, choose the highest frequency one and set. + * + * Return: This function return 0 when the new OPP is marked as sustainable + * or error return value, which can be: + * EINVAL: for bad pointer or no match found for frequency search + * EEXIST: if existing sustainable OPP has higher rate + */ +int dev_pm_opp_set_sustainable_opp_freq(struct device *dev, unsigned long freq) +{ + struct opp_table *opp_table; + struct dev_pm_opp *opp; + int ret = 0; + + opp = dev_pm_opp_find_freq_exact(dev, freq, true); + if (IS_ERR_OR_NULL(opp)) + return -EINVAL; + + opp_table = _find_opp_table(dev); + if (IS_ERR(opp_table)) + return -EINVAL; + + if (opp_table->sustainable_opp) { + /* Pick the OPP with higher rate as sustainable OPP */ + if (opp->rate > opp_table->sustainable_opp->rate) { + opp_table->sustainable_opp->sustainable = false; + opp->sustainable = true; + opp_table->sustainable_opp = opp; + } else { + ret = -EEXIST; + } + } else { + opp->sustainable = true; + opp_table->sustainable_opp = opp; + } + + dev_pm_opp_put(opp); + dev_pm_opp_put_opp_table(opp_table); + + return ret; +} +EXPORT_SYMBOL_GPL(dev_pm_opp_set_sustainable_opp_freq); + int _get_opp_count(struct opp_table *opp_table) { struct dev_pm_opp *opp; diff --git a/include/linux/pm_opp.h b/include/linux/pm_opp.h index 363d5a2c1ef3..e634a6b00e65 100644 --- a/include/linux/pm_opp.h +++ b/include/linux/pm_opp.h @@ -107,6 +107,8 @@ unsigned long dev_pm_opp_get_max_volt_latency(struct device *dev); unsigned long dev_pm_opp_get_max_transition_latency(struct device *dev); unsigned long dev_pm_opp_get_suspend_opp_freq(struct device *dev); unsigned long dev_pm_opp_get_sustainable_opp_freq(struct device *dev); +int dev_pm_opp_set_sustainable_opp_freq(struct device *dev, + unsigned long freq); struct dev_pm_opp *dev_pm_opp_find_freq_exact(struct device *dev, unsigned long freq, @@ -221,6 +223,12 @@ static inline unsigned long dev_pm_opp_get_sustainable_opp_freq(struct device *d return 0; } +static inline int dev_pm_opp_set_sustainable_freq(struct device *dev, + unsigned long freq) +{ + return -EOPNOTSUPP; +} + static inline struct dev_pm_opp *dev_pm_opp_find_freq_exact(struct device *dev, unsigned long freq, bool available) {