From patchwork Thu Sep 8 07:01:03 2016 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Andrea Merello X-Patchwork-Id: 9320481 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 975FB6077F for ; Thu, 8 Sep 2016 07:04:14 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 7EA57295E9 for ; Thu, 8 Sep 2016 07:04:14 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 727E9295EC; Thu, 8 Sep 2016 07:04:14 +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=-4.1 required=2.0 tests=BAYES_00, DKIM_ADSP_CUSTOM_MED, DKIM_SIGNED,FREEMAIL_FROM,RCVD_IN_DNSWL_MED,T_DKIM_INVALID autolearn=unavailable version=3.3.1 Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.9]) (using TLSv1.2 with cipher AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by mail.wl.linuxfoundation.org (Postfix) with ESMTPS id 06AA4295E9 for ; Thu, 8 Sep 2016 07:04:10 +0000 (UTC) Received: from localhost ([127.0.0.1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.85_2 #1 (Red Hat Linux)) id 1bhtL8-00009C-AY; Thu, 08 Sep 2016 07:01:38 +0000 Received: from mail-wm0-x242.google.com ([2a00:1450:400c:c09::242]) by bombadil.infradead.org with esmtps (Exim 4.85_2 #1 (Red Hat Linux)) id 1bhtL0-00007I-Vd for linux-arm-kernel@lists.infradead.org; Thu, 08 Sep 2016 07:01:34 +0000 Received: by mail-wm0-x242.google.com with SMTP id w12so6387217wmf.1 for ; Thu, 08 Sep 2016 00:01:10 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20120113; h=from:to:cc:subject:date:message-id; bh=n9OSLWLPBAKilR9JH2AtTWz7pycl7gVIZyDEuKTT20c=; b=RWZ/wewnQZtabiq927GUAkil2kevLPte1Jh34G+HPG/ZkWX/DAMlDlk6c7Jo9BVjZo 5B7kL1dniG24rNbijONsK9gJtaj6KynqHt2Zzo22dmoew6L7s19NVImr5itW0wiTlaKj kVT6jkXW1cklJqNqsSRIRLbGFKcQM0hQOASrx0XAEMyQe+aPNMpfESFc7WCesNire+Yr JP+Qc2MNXV6K8cuqOdfB3bgid191K7W8uTMSFzmFmrcppgxd2EjOO83jhaRqtI3ls+gn +eOafzY/1gIaroEDVVvPrygcxpK4YalIvaUQ+UVFL1vcZFGD7NUpqNUENdIAdFfE6JOL qR0g== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20130820; h=x-gm-message-state:from:to:cc:subject:date:message-id; bh=n9OSLWLPBAKilR9JH2AtTWz7pycl7gVIZyDEuKTT20c=; b=NrL20iUDIk00UlVu++KQJfmSOtuG9C+x0rEKnviP9+y7d5BBXk6QZZyydfclrgPAjL HEl789AhieSQOwpNAaz9fZ2HJc9GoW3Kw22Jfee3XLCOcnXpCvc9CdIN6T57CfHEvZu8 qX5D1deDiABwSGu5jUYbQgz1M/93eTdbHMgETSrSS2ANGrsZSwiUz60CZB73GErlT1y1 HWHN02vp5zIGJ8r5yvIOmdQbvMK+Ki3kA/p1ETmkMer6FSo9mdKTPAhSBJPCrH0EgfbQ 6d436sQkxjr/+fq8lgWb8mAA9Pk4gJUGizB2sMpxwBely7AhB+H9ebGr2mQMLqYqJp5D EKCA== X-Gm-Message-State: AE9vXwMqoU8uby9sP6/KcWx7h9l35c5PSJcs1uVwqI7fZzFhtzsFETZUVKmk9+XQf2dDTg== X-Received: by 10.194.80.104 with SMTP id q8mr51247925wjx.151.1473318068692; Thu, 08 Sep 2016 00:01:08 -0700 (PDT) Received: from NewMoon.iit.local ([90.147.180.254]) by smtp.googlemail.com with ESMTPSA id 1sm2052485wmm.0.2016.09.08.00.01.07 (version=TLS1_2 cipher=ECDHE-RSA-AES128-SHA bits=128/128); Thu, 08 Sep 2016 00:01:07 -0700 (PDT) From: Andrea Merello To: linux-clk@vger.kernel.org Subject: [PATCH] clk: stm32f4: don't assume 48MHz clock is derived from primary PLL Date: Thu, 8 Sep 2016 09:01:03 +0200 Message-Id: <1473318063-21782-1-git-send-email-andrea.merello@gmail.com> X-Mailer: git-send-email 2.7.4 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20160908_000131_324225_48194176 X-CRM114-Status: GOOD ( 14.29 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.20 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: Alexandre Torgue , Andrea Merello , Bruno Herrera , Michael Turquette , Stephen Boyd , Maxime Coquelin , linux-arm-kernel@lists.infradead.org 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 This driver just look at the PLLs configurations set by the bootloader, but it assumes the 48MHz clock is derived from the primary PLL; however using PLLSAI is another option for generating the 48MHz clock. This patch make the driver to check for this, and eventually adjust the clock tree accordingly Signed-off-by: Andrea Merello Cc: Michael Turquette Cc: Stephen Boyd Cc: Maxime Coquelin Cc: Alexandre Torgue Cc: Bruno Herrera --- drivers/clk/clk-stm32f4.c | 26 ++++++++++++++++++++++++-- 1 file changed, 24 insertions(+), 2 deletions(-) diff --git a/drivers/clk/clk-stm32f4.c b/drivers/clk/clk-stm32f4.c index 02d6810..7f1ba8f 100644 --- a/drivers/clk/clk-stm32f4.c +++ b/drivers/clk/clk-stm32f4.c @@ -24,6 +24,7 @@ #include #include +#define STM32F4_RCC_CR 0x00 #define STM32F4_RCC_PLLCFGR 0x04 #define STM32F4_RCC_CFGR 0x08 #define STM32F4_RCC_AHB1ENR 0x30 @@ -31,6 +32,8 @@ #define STM32F4_RCC_AHB3ENR 0x38 #define STM32F4_RCC_APB1ENR 0x40 #define STM32F4_RCC_APB2ENR 0x44 +#define STM32F4_RCC_PLLSAICFGR 0x88 +#define STM32F4_RCC_DCKCFGR 0x8C struct stm32f4_gate_data { u8 offset; @@ -238,16 +241,35 @@ static struct clk *clk_register_apb_mul(struct device *dev, const char *name, static void stm32f4_rcc_register_pll(const char *hse_clk, const char *hsi_clk) { unsigned long pllcfgr = readl(base + STM32F4_RCC_PLLCFGR); - + unsigned long pllsaicfgr = readl(base + STM32F4_RCC_PLLSAICFGR); + unsigned long dckcfgr = readl(base + STM32F4_RCC_DCKCFGR); + unsigned long rcccr = readl(base + STM32F4_RCC_CR); + bool saien = rcccr & BIT(28); unsigned long pllm = pllcfgr & 0x3f; unsigned long plln = (pllcfgr >> 6) & 0x1ff; unsigned long pllp = BIT(((pllcfgr >> 16) & 3) + 1); const char *pllsrc = pllcfgr & BIT(22) ? hse_clk : hsi_clk; unsigned long pllq = (pllcfgr >> 24) & 0xf; + bool src48_sai = dckcfgr & BIT(27); + unsigned long pllsain = (pllsaicfgr >> 6) & 0x1ff; + unsigned long pllsaip = BIT(((pllsaicfgr >> 16) & 3) + 1); clk_register_fixed_factor(NULL, "vco", pllsrc, 0, plln, pllm); clk_register_fixed_factor(NULL, "pll", "vco", 0, 1, pllp); - clk_register_fixed_factor(NULL, "pll48", "vco", 0, 1, pllq); + + if (src48_sai && !saien) { + pr_err("48MHz derived from SAI PLL, but SAI PLL disabled (blame the bootloader)\n"); + return; + } + + if (saien) + clk_register_fixed_factor(NULL, "sai", + pllsrc, 0, pllsain, pllm); + + if (src48_sai) + clk_register_fixed_factor(NULL, "pll48", "sai", 0, 1, pllsaip); + else + clk_register_fixed_factor(NULL, "pll48", "vco", 0, 1, pllq); } /*