From patchwork Sat Apr 8 18:50:21 2017 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Icenowy Zheng X-Patchwork-Id: 9671173 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork.web.codeaurora.org (Postfix) with ESMTP id 04505601EB for ; Sat, 8 Apr 2017 18:52:25 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id EC95820952 for ; Sat, 8 Apr 2017 18:52:24 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id E08FA24603; Sat, 8 Apr 2017 18:52:24 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-1.9 required=2.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID autolearn=unavailable version=3.3.1 Received: from bombadil.infradead.org (bombadil.infradead.org [65.50.211.133]) (using TLSv1.2 with cipher AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.wl.linuxfoundation.org (Postfix) with ESMTPS id 752E820952 for ; Sat, 8 Apr 2017 18:52:24 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.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=CJ2mD9NxMsGT1qslcOxpfwLH9BkZ+23GsFtJ2yH+li0=; b=RtychZvzyAXxNv105kBVIQtWlF N2JypSnSmDYMhxz2IDlGXqzqqFeEL+LQ12tEm1HEzgRzDzY9fInpfEUGYcbDDXZr1IMC+cbKcYjUQ VrYNy46uUJ99sZ01R8mreT3pTOA/ygWxTM8yVnuwxtOxkisBP3J2oHRMsvcQOB5WgsBOTNLwrP1We 28wNgnsyEa8PQTmcG1g6//YswFobfM7HdmNpVRng0xUb1xim5d9H1PFmvITYI458m47t2LtowK02O fNlO3p9ZbpotXiJNeAbyBI+cx6xw5ZXhzjMd5umSl494c93SJ7CWQgMTPbz95r/JJ9CAQ9B8YTrpu SDPUylag==; Received: from localhost ([127.0.0.1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.87 #1 (Red Hat Linux)) id 1cwvT9-0000jF-4y; Sat, 08 Apr 2017 18:52:19 +0000 Received: from nov-007-i584.relay.mailchannels.net ([46.232.183.138]) by bombadil.infradead.org with esmtps (Exim 4.87 #1 (Red Hat Linux)) id 1cwvT5-0000SB-Da for linux-arm-kernel@lists.infradead.org; Sat, 08 Apr 2017 18:52:17 +0000 X-Sender-Id: lmn-tzduiowcrqmw|x-authsender|icenowy@aosc.io Received: from relay.mailchannels.net (localhost [127.0.0.1]) by relay.mailchannels.net (Postfix) with ESMTP id 87F988A216B; Sat, 8 Apr 2017 18:51:48 +0000 (UTC) Received: from hermes.aosc.io (unknown [100.96.129.119]) by relay.mailchannels.net (Postfix) with ESMTPA id B60BC8A2176; Sat, 8 Apr 2017 18:51:47 +0000 (UTC) X-Sender-Id: lmn-tzduiowcrqmw|x-authsender|icenowy@aosc.io Received: from hermes.aosc.io (hermes.aosc.io [100.96.129.1]) (using TLSv1.2 with cipher DHE-RSA-AES256-GCM-SHA384) by 0.0.0.0:2500 (trex/5.7.37); Sat, 08 Apr 2017 18:51:48 +0000 X-MC-Relay: Neutral X-MailChannels-SenderId: lmn-tzduiowcrqmw|x-authsender|icenowy@aosc.io X-MailChannels-Auth-Id: lmn-TZDUIOWCRQMW X-Oafish-Little: 56072551436c810e_1491677508367_1130502779 X-MC-Loop-Signature: 1491677508367:1361352031 X-MC-Ingress-Time: 1491677508366 Received: from localhost (localhost [127.0.0.1]) (Authenticated sender: icenowy@aosc.io) by hermes.aosc.io (Postfix) with ESMTPSA id BDE36451C9; Sat, 8 Apr 2017 18:51:25 +0000 (UTC) From: Icenowy Zheng To: Maxime Ripard , Chen-Yu Tsai , Quentin Schulz Subject: [PATCH 1/5] clk: sunxi-ng: prevent NKMP clocks from temporarily get higher freq Date: Sun, 9 Apr 2017 02:50:21 +0800 Message-Id: <20170408185025.53841-2-icenowy@aosc.io> In-Reply-To: <20170408185025.53841-1-icenowy@aosc.io> References: <20170408185025.53841-1-icenowy@aosc.io> X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20170408_115216_207055_B423991A X-CRM114-Status: GOOD ( 12.19 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.21 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: linux-pm@vger.kernel.org, linux-kernel@vger.kernel.org, linux-sunxi@googlegroups.com, linux-clk@vger.kernel.org, linux-arm-kernel@lists.infradead.org, Icenowy Zheng MIME-Version: 1.0 Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org X-Virus-Scanned: ClamAV using ClamSMTP It seems that on newer SoCs (already observed on A33, H3), when setting all NKMP factors at the same time, the multiplier get applied first, then the divider get applied. In some situations (e.g. the multiplier increased but the divider decreased), this will make the clock frequency temporarily higher than both the original frequency and the target frequency, which may lead to system hang due to PLL_CPU(X) clock usually being a NKMP clock. A comparsion between the old divider (M*P) and the new one is added, and if the divider get smaller when changing clock, the multiplier will be applied first, so that the clock won't go to a frequency higher than normal. The interval between applying the first group of factors and the second group is based on experiments results on an Orange Pi Zero board. Signed-off-by: Icenowy Zheng --- drivers/clk/sunxi-ng/ccu_nkmp.c | 76 +++++++++++++++++++++++++++++++++++------ 1 file changed, 65 insertions(+), 11 deletions(-) diff --git a/drivers/clk/sunxi-ng/ccu_nkmp.c b/drivers/clk/sunxi-ng/ccu_nkmp.c index e58c95787f94..5da77eb60335 100644 --- a/drivers/clk/sunxi-ng/ccu_nkmp.c +++ b/drivers/clk/sunxi-ng/ccu_nkmp.c @@ -9,6 +9,7 @@ */ #include +#include #include "ccu_gate.h" #include "ccu_nkmp.h" @@ -130,12 +131,49 @@ static long ccu_nkmp_round_rate(struct clk_hw *hw, unsigned long rate, return *parent_rate * _nkmp.n * _nkmp.k / (_nkmp.m * _nkmp.p); } +static void ccu_nkmp_extract_factors(const struct ccu_nkmp *nkmp, + struct _ccu_nkmp *_nkmp, u32 reg) +{ + _nkmp->n = ((reg >> nkmp->n.shift) & GENMASK(nkmp->n.width - 1, 0)) + + nkmp->n.offset; + _nkmp->k = ((reg >> nkmp->k.shift) & GENMASK(nkmp->k.width - 1, 0)) + + nkmp->k.offset; + _nkmp->m = ((reg >> nkmp->m.shift) & GENMASK(nkmp->m.width - 1, 0)) + + nkmp->m.offset; + _nkmp->p = 1 << + ((reg >> nkmp->p.shift) & GENMASK(nkmp->p.width - 1, 0)); +} + +static u32 ccu_nkmp_apply_multiplier(const struct ccu_nkmp *nkmp, + const struct _ccu_nkmp *_nkmp, u32 reg) +{ + reg &= ~GENMASK(nkmp->n.width + nkmp->n.shift - 1, nkmp->n.shift); + reg &= ~GENMASK(nkmp->k.width + nkmp->k.shift - 1, nkmp->k.shift); + + reg |= (_nkmp->n - nkmp->n.offset) << nkmp->n.shift; + reg |= (_nkmp->k - nkmp->k.offset) << nkmp->k.shift; + + return reg; +} + +static u32 ccu_nkmp_apply_divider(const struct ccu_nkmp *nkmp, + const struct _ccu_nkmp *_nkmp, u32 reg) +{ + reg &= ~GENMASK(nkmp->m.width + nkmp->m.shift - 1, nkmp->m.shift); + reg &= ~GENMASK(nkmp->p.width + nkmp->p.shift - 1, nkmp->p.shift); + + reg |= (_nkmp->m - nkmp->m.offset) << nkmp->m.shift; + reg |= ilog2(_nkmp->p) << nkmp->p.shift; + + return reg; +} + static int ccu_nkmp_set_rate(struct clk_hw *hw, unsigned long rate, unsigned long parent_rate) { struct ccu_nkmp *nkmp = hw_to_ccu_nkmp(hw); - struct _ccu_nkmp _nkmp; - unsigned long flags; + struct _ccu_nkmp _nkmp, _nkmp_old; + unsigned long flags, old_mp, mp; u32 reg; _nkmp.min_n = nkmp->n.min ?: 1; @@ -152,17 +190,33 @@ static int ccu_nkmp_set_rate(struct clk_hw *hw, unsigned long rate, spin_lock_irqsave(nkmp->common.lock, flags); reg = readl(nkmp->common.base + nkmp->common.reg); - reg &= ~GENMASK(nkmp->n.width + nkmp->n.shift - 1, nkmp->n.shift); - reg &= ~GENMASK(nkmp->k.width + nkmp->k.shift - 1, nkmp->k.shift); - reg &= ~GENMASK(nkmp->m.width + nkmp->m.shift - 1, nkmp->m.shift); - reg &= ~GENMASK(nkmp->p.width + nkmp->p.shift - 1, nkmp->p.shift); - reg |= (_nkmp.n - nkmp->n.offset) << nkmp->n.shift; - reg |= (_nkmp.k - nkmp->k.offset) << nkmp->k.shift; - reg |= (_nkmp.m - nkmp->m.offset) << nkmp->m.shift; - reg |= ilog2(_nkmp.p) << nkmp->p.shift; + ccu_nkmp_extract_factors(nkmp, &_nkmp_old, reg); + + old_mp = _nkmp_old.m * _nkmp_old.p; + mp = _nkmp.m * _nkmp.p; + + if (mp > old_mp) { + reg = ccu_nkmp_apply_divider(nkmp, &_nkmp, reg); + writel(reg, nkmp->common.base + nkmp->common.reg); + + /* + * This value is decided by experiment results on an + * Allwinner H2+ board (Orange Pi Zero). + */ + udelay(500); - writel(reg, nkmp->common.base + nkmp->common.reg); + reg = ccu_nkmp_apply_multiplier(nkmp, &_nkmp, reg); + writel(reg, nkmp->common.base + nkmp->common.reg); + } else { + reg = ccu_nkmp_apply_multiplier(nkmp, &_nkmp, reg); + writel(reg, nkmp->common.base + nkmp->common.reg); + + udelay(500); + + reg = ccu_nkmp_apply_divider(nkmp, &_nkmp, reg); + writel(reg, nkmp->common.base + nkmp->common.reg); + } spin_unlock_irqrestore(nkmp->common.lock, flags);