From patchwork Sat Oct 16 10:50:22 2021 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Martin Blumenstingl X-Patchwork-Id: 12563581 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id 94657C433F5 for ; Sat, 16 Oct 2021 10:52:19 +0000 (UTC) Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.133]) (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 5424E6108E for ; Sat, 16 Oct 2021 10:52:19 +0000 (UTC) DMARC-Filter: OpenDMARC Filter v1.4.1 mail.kernel.org 5424E6108E Authentication-Results: mail.kernel.org; dmarc=fail (p=quarantine dis=none) header.from=googlemail.com Authentication-Results: mail.kernel.org; spf=none smtp.mailfrom=lists.infradead.org DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender: Content-Transfer-Encoding:Content-Type:List-Subscribe:List-Help:List-Post: List-Archive:List-Unsubscribe:List-Id:MIME-Version:References:In-Reply-To: Message-Id:Date:Subject:Cc:To:From:Reply-To:Content-ID:Content-Description: Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID: List-Owner; bh=MuQa7XRSOr1UYFpXRlJspM7IOWkQjVVx0FAwHW29GE4=; b=iBlXZn4uA44Z2+ GaeRc96Kp/3gczIeUImjMSjnqPLFdm2hT9bc01NUl1cUyd4gNiY2N9UKvgxStWRT2akQDns2R4KH/ QyPalBqlwaSRN74cf59Y5B75A/DOsY0QkCrbyVKLw8bbc1ZRw4QM+dpxvNTKJ+7jNtLj2dk71B+BB yhwZzepfGlkDNdpEK7ZWuDrhy31Rg9QPE+OlUTzIzHBxCLd93/KS0rIB4NlTjdDSglInhlrCeY5Cl RpOHhrWdqMKzz5yAb5RF0ANkiY2umHjGZ5SUDX+W0wIq7ZX8KbJ8k/1p81aC3UZbQ8u0IAleG286C niBDtyWQna+PvnSQCsQw==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.94.2 #2 (Red Hat Linux)) id 1mbhHS-00ANrK-MV; Sat, 16 Oct 2021 10:51:10 +0000 Received: from mail-wr1-x436.google.com ([2a00:1450:4864:20::436]) by bombadil.infradead.org with esmtps (Exim 4.94.2 #2 (Red Hat Linux)) id 1mbhHA-00ANkp-EC for linux-arm-kernel@lists.infradead.org; Sat, 16 Oct 2021 10:50:54 +0000 Received: by mail-wr1-x436.google.com with SMTP id r7so30952013wrc.10 for ; Sat, 16 Oct 2021 03:50:46 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=googlemail.com; s=20210112; h=from:to:cc:subject:date:message-id:in-reply-to:references :mime-version:content-transfer-encoding; bh=nsJVxt8L+XZV9YE+JVUgOE99LWlH5mcvJoxYldOfzTc=; b=DETKPaoU4uf8+2aEz5dAo0MShBv5MIUtC4NMOqVbN1F/0mvDLKRg+uO7ClahDHFSBh dJsOlIlBfR9zpq8PgHG7w/Yd8aCFx7YpBT8tQ1jORcQcpKtpK0oB6PBaLOzSD3J763kw ZzoTZBGpoYyA3GlpehN7gb7Es9VzwOCuDth175xVFOjG9MeoEvt6NzbKjnKK3TsCVtx6 rXWWhT/QUYLPD4oZxYkzXxfEF9kGOfXALOp9/drHsEXP8Vp8gxsqT+ANsg8YiGZMVFJN E67MR2iFzMj/Ww+GzJwgddZzbwqhWcLIK6b28BU/qHyYBDc816vbiDEhfsu1cnp2v2Ds fghw== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20210112; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references:mime-version:content-transfer-encoding; bh=nsJVxt8L+XZV9YE+JVUgOE99LWlH5mcvJoxYldOfzTc=; b=LCBPiX90Pe/h49zuveCj8zkeLCdikYhauYbEe3Q56iLXXAnRl3Wn0QtvHDemnvT4xt kvLoKU6WxttUUYtGszvq0mSHSsHqurMQTYs/n0LK8WSTFsOPfZ4hu+okGUCf6fwY4Ilu 6I7iIiRcUcC8UoZED/BznmCmnXJnQVxEJisJ6hUiDsyyGnhfiVOL/mMF7QEOTeQoNSWf 5Rh1XtidZEGvmjawgK36NhHQcY1pUaHVQvYOpgSHxPE1YNl7ZdhYFl/UotmKaL5o9JLk B+Xhdwc1nq+OngFWOvlyjKaHeBBxymihGxnHMkQzFfkkrJAdrU2swEmgblfhqTTvpKoU alzg== X-Gm-Message-State: AOAM532bIPSTq2VFNTYTyNMN5qCS2IRvoLSvds8TXiGTE54S6cn6LU0b KSNa2UjRFz4k1ksd53P2DdI= X-Google-Smtp-Source: ABdhPJzcKsZd4XMEP+DPgJDTQ91kEtQh09xeWNI+Boff2jfUZVEUYC8Qe+djRzkjgWHaHY2Nr5vKdQ== X-Received: by 2002:a05:6000:1884:: with SMTP id a4mr21325970wri.356.1634381445303; Sat, 16 Oct 2021 03:50:45 -0700 (PDT) Received: from localhost.localdomain (dynamic-2a01-0c22-7b82-9800-f22f-74ff-fe21-0725.c22.pool.telefonica.de. [2a01:c22:7b82:9800:f22f:74ff:fe21:725]) by smtp.googlemail.com with ESMTPSA id d8sm7415796wrv.80.2021.10.16.03.50.44 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Sat, 16 Oct 2021 03:50:44 -0700 (PDT) From: Martin Blumenstingl To: linux-clk@vger.kernel.org, sboyd@kernel.org Cc: linux-arm-kernel@lists.infradead.org, knaerzche@gmail.com, mturquette@baylibre.com, Martin Blumenstingl Subject: [PATCH clk-fixes v1 2/2] clk: composite: Use rate_ops.determine_rate when also a mux is available Date: Sat, 16 Oct 2021 12:50:22 +0200 Message-Id: <20211016105022.303413-3-martin.blumenstingl@googlemail.com> X-Mailer: git-send-email 2.33.1 In-Reply-To: <20211016105022.303413-1-martin.blumenstingl@googlemail.com> References: <20211016105022.303413-1-martin.blumenstingl@googlemail.com> MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20211016_035052_526849_4962226E X-CRM114-Status: GOOD ( 18.39 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.34 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org Update clk_composite_determine_rate() to use rate_ops.determine_rate when available in combination with a mux. So far clk_divider_ops provide both, .round_rate and .determine_rate. Removing the former would make clk-composite fail silently for example on Rockchip platforms (which heavily use composite clocks). Add support for using rate_ops.determine_rate when either rate_ops.round_rate is not available or both (.round_rate and .determine_rate) are provided. Suggested-by: Alex Bee Signed-off-by: Martin Blumenstingl --- drivers/clk/clk-composite.c | 68 ++++++++++++++++++++++++++----------- 1 file changed, 48 insertions(+), 20 deletions(-) diff --git a/drivers/clk/clk-composite.c b/drivers/clk/clk-composite.c index ba8d4d8cf8dd..c04ae0e7e4b4 100644 --- a/drivers/clk/clk-composite.c +++ b/drivers/clk/clk-composite.c @@ -42,6 +42,29 @@ static unsigned long clk_composite_recalc_rate(struct clk_hw *hw, return rate_ops->recalc_rate(rate_hw, parent_rate); } +static int clk_composite_determine_rate_for_parent(struct clk_hw *rate_hw, + struct clk_rate_request *req, + struct clk_hw *parent_hw, + const struct clk_ops *rate_ops) +{ + long rate; + + req->best_parent_hw = parent_hw; + req->best_parent_rate = clk_hw_get_rate(parent_hw); + + if (rate_ops->determine_rate) + return rate_ops->determine_rate(rate_hw, req); + + rate = rate_ops->round_rate(rate_hw, req->rate, + &req->best_parent_rate); + if (rate < 0) + return rate; + + req->rate = rate; + + return 0; +} + static int clk_composite_determine_rate(struct clk_hw *hw, struct clk_rate_request *req) { @@ -51,51 +74,56 @@ static int clk_composite_determine_rate(struct clk_hw *hw, struct clk_hw *rate_hw = composite->rate_hw; struct clk_hw *mux_hw = composite->mux_hw; struct clk_hw *parent; - unsigned long parent_rate; - long tmp_rate, best_rate = 0; unsigned long rate_diff; unsigned long best_rate_diff = ULONG_MAX; - long rate; - int i; + unsigned long best_rate = 0; + int i, ret; - if (rate_hw && rate_ops && rate_ops->round_rate && + if (rate_hw && rate_ops && + (rate_ops->determine_rate || rate_ops->round_rate) && mux_hw && mux_ops && mux_ops->set_parent) { req->best_parent_hw = NULL; if (clk_hw_get_flags(hw) & CLK_SET_RATE_NO_REPARENT) { + struct clk_rate_request tmp_req = *req; + parent = clk_hw_get_parent(mux_hw); - req->best_parent_hw = parent; - req->best_parent_rate = clk_hw_get_rate(parent); - rate = rate_ops->round_rate(rate_hw, req->rate, - &req->best_parent_rate); - if (rate < 0) - return rate; + ret = clk_composite_determine_rate_for_parent(rate_hw, + &tmp_req, + parent, + rate_ops); + if (ret) + return ret; + + req->rate = tmp_req.rate; + req->best_parent_rate = tmp_req.best_parent_rate; - req->rate = rate; return 0; } for (i = 0; i < clk_hw_get_num_parents(mux_hw); i++) { + struct clk_rate_request tmp_req = *req; + parent = clk_hw_get_parent_by_index(mux_hw, i); if (!parent) continue; - parent_rate = clk_hw_get_rate(parent); - - tmp_rate = rate_ops->round_rate(rate_hw, req->rate, - &parent_rate); - if (tmp_rate < 0) + ret = clk_composite_determine_rate_for_parent(rate_hw, + &tmp_req, + parent, + rate_ops); + if (ret) continue; - rate_diff = abs(req->rate - tmp_rate); + rate_diff = abs(req->rate - tmp_req.rate); if (!rate_diff || !req->best_parent_hw || best_rate_diff > rate_diff) { req->best_parent_hw = parent; - req->best_parent_rate = parent_rate; + req->best_parent_rate = tmp_req.best_parent_rate; best_rate_diff = rate_diff; - best_rate = tmp_rate; + best_rate = tmp_req.rate; } if (!rate_diff)