From mboxrd@z Thu Jan 1 00:00:00 1970 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 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 smtp.lore.kernel.org (Postfix) with ESMTPS id ED98BC54F54 for ; Tue, 28 Jul 2026 14:29:45 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender:List-Subscribe:List-Help :List-Post:List-Archive:List-Unsubscribe:List-Id:Content-Type: Content-Transfer-Encoding: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=EbUFxyg/9wGF516+tiT+vErIqBuoZti8CASZzRJcavc=; b=3yg2Irq3WcAZ/rPSoUhPHsKRaN KKs6u7P3ykZtcVXl2M/JMrhvscOxxYgelcEpO0/QSYUZ4Q1EdyH2T23iWllxfyP1Y/IrHsR7u/jZC ylsRMKe21Igdm9an9UKpQkuFyrEKyRIK/iVy+Dfv1u2/8FJxgkgDyP/Q2OrfepzbEg6H8tQVLgwsW jecrQfwQ3Bu450ptyyKrz0tqTu5vPZTgaSqrRaVMCfdH7EzH+KjjCygZHP7tPoTZxiImGNx8iJn67 r99dD5KqiK/z35ySzOrh/ERUXC7YkJb5KQh65dxMZdAEEEqMPNYm095DvpV5t9PoBEQtIVyeaTmSK KLVmTHzw==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.99.1 #2 (Red Hat Linux)) id 1woioC-00000005U5S-2JW3; Tue, 28 Jul 2026 14:29:28 +0000 Received: from desiato.infradead.org ([2001:8b0:10b:1:d65d:64ff:fe57:4e05]) by bombadil.infradead.org with esmtps (Exim 4.99.1 #2 (Red Hat Linux)) id 1woiny-00000005TzS-2diD; Tue, 28 Jul 2026 14:29:14 +0000 DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=infradead.org; s=desiato.20200630; h=Content-Type:Content-Transfer-Encoding :MIME-Version:References:In-Reply-To:Message-ID:Date:Subject:CC:To:From: Sender:Reply-To:Content-ID:Content-Description; bh=EbUFxyg/9wGF516+tiT+vErIqBuoZti8CASZzRJcavc=; b=ku8dy9iVGg3+RFTRvAXEVpKul+ XCM+xkUj83udPSKOwy8h9gwRRIj4OdI+KrKvWqkBIeOiaRrKzUTCsS+dFZ7zi/chTQqz6svrTx3Kh L4sqUGHs4ifKYHEP15zydHm6d9+9MtTVVCh8pIfkoAJvL4wbA85P5u57MAPA4M6QzYfLM88qIPGlD ZufBeOXQZ4Qq3LyVuVVyXF86LUqCDxDXQjXULngu1iF8TIyjSPV27g5jQ7nQvvhnIhikrAbtN9LiG uMsPy1jbf/4jbfiMDmTrtQFsCbwM0UN2K5gminHqekABTUrLH5fRsiL/dZxxYFThmSYOOJazWeymd gpvnb/nw==; Received: from rtits2.realtek.com ([211.75.126.72] helo=rtits2.realtek.com.tw) by desiato.infradead.org with esmtps (Exim 4.99.2 #2 (Red Hat Linux)) id 1woinq-000000051Ao-2DWv; Tue, 28 Jul 2026 14:29:13 +0000 X-SpamFilter-By: ArmorX SpamTrap 5.80 with qID 66SES7Hm83929851, This message is accepted by code: ctloc85258 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=realtek.com; s=dkim; t=1785248888; bh=EbUFxyg/9wGF516+tiT+vErIqBuoZti8CASZzRJcavc=; h=From:To:CC:Subject:Date:Message-ID:In-Reply-To:References: MIME-Version:Content-Transfer-Encoding:Content-Type; b=HASSY2oF4nLzT0jzPK8+HRymTNUbiv/6VDfA5ywb0kuvczZQr578s7gjhHXMtbF7C AWpTniypM/1kkpLOCP14dwGkrT1SfxQ73t5gCN1CRG/r5WYt9ykod6xkeGR6aH50s5 YMlJLjj2TOwGE7fXIYawLUqagz7dmlGpHohbr8RvT3c58pZbmtnr5toiSnAvIT+KDd Iyi8BYgoo6OI5tAhuSUw6lDkYsuigd07sbtl2PV3C8FNb4AYgGK+H5K8+o11wh+2Kp dKqHHFrOzUFsQ0xmDJ1BA2GRmGAjOdxTp8eHYbrBJc0Gx1dl+uSTjc2BGMDh1u9Xlw 8GV54nepo52Eg== Received: from mail.realtek.com (rtkexhmbs03.realtek.com.tw[10.21.1.53]) by rtits2.realtek.com.tw (8.15.2/3.29/5.94) with ESMTPS id 66SES7Hm83929851 (version=TLSv1.2 cipher=ECDHE-RSA-AES256-GCM-SHA384 bits=256 verify=FAIL); Tue, 28 Jul 2026 22:28:07 +0800 Received: from RTKEXHMBS05.realtek.com.tw (10.21.1.55) by RTKEXHMBS03.realtek.com.tw (10.21.1.53) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.2.2562.17; Tue, 28 Jul 2026 22:28:08 +0800 Received: from RTKEXHMBS05.realtek.com.tw (10.21.1.55) by RTKEXHMBS05.realtek.com.tw (10.21.1.55) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.2.2562.17; Tue, 28 Jul 2026 22:28:07 +0800 Received: from cn1dhc-k02 (172.21.252.101) by RTKEXHMBS05.realtek.com.tw (10.21.1.55) with Microsoft SMTP Server id 15.2.2562.17 via Frontend Transport; Tue, 28 Jul 2026 22:28:07 +0800 From: Yu-Chun Lin To: , , , , , , , , CC: , , , , , , , , , Subject: [PATCH v11 08/11] clk: realtek: Add support for MMC-tuned PLL clocks Date: Tue, 28 Jul 2026 22:28:03 +0800 Message-ID: <20260728142806.1954638-9-eleanor.lin@realtek.com> X-Mailer: git-send-email 2.50.1 In-Reply-To: <20260728142806.1954638-1-eleanor.lin@realtek.com> References: <20260728142806.1954638-1-eleanor.lin@realtek.com> MIME-Version: 1.0 Content-Transfer-Encoding: 8bit Content-Type: text/plain X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.9.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20260728_152907_516014_816784F2 X-CRM114-Status: GOOD ( 18.14 ) 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 From: Cheng-Yu Lee Add clk_pll_mmc_ops for enable/disable, prepare, rate control, and status operations on MMC PLL clocks. Also add clk_pll_mmc_phase_ops to support phase get/set operations. Signed-off-by: Cheng-Yu Lee Co-developed-by: Jyan Chou Signed-off-by: Jyan Chou Co-developed-by: Yu-Chun Lin Signed-off-by: Yu-Chun Lin --- Changes in v11: - Remove PLL MMC MAINTAINER entry. - Add 'rtk_' prefix into struct names and function names. --- drivers/clk/realtek/Kconfig | 3 + drivers/clk/realtek/Makefile | 2 + drivers/clk/realtek/clk-pll-mmc.c | 434 ++++++++++++++++++++++++++++++ drivers/clk/realtek/clk-pll.h | 13 + 4 files changed, 452 insertions(+) create mode 100644 drivers/clk/realtek/clk-pll-mmc.c diff --git a/drivers/clk/realtek/Kconfig b/drivers/clk/realtek/Kconfig index ed97531e321d..2ff780581ae0 100644 --- a/drivers/clk/realtek/Kconfig +++ b/drivers/clk/realtek/Kconfig @@ -27,4 +27,7 @@ config RTK_CLK_COMMON multiple Realtek clock implementations, and include integration with reset controllers where required. +config RTK_CLK_PLL_MMC + bool + endif diff --git a/drivers/clk/realtek/Makefile b/drivers/clk/realtek/Makefile index 3b014240a211..97447e92bc35 100644 --- a/drivers/clk/realtek/Makefile +++ b/drivers/clk/realtek/Makefile @@ -6,3 +6,5 @@ clk-rtk-y += clk-pll.o clk-rtk-y += freq_table.o clk-rtk-y += clk-regmap-gate.o clk-rtk-y += clk-regmap-mux.o + +clk-rtk-$(CONFIG_RTK_CLK_PLL_MMC) += clk-pll-mmc.o diff --git a/drivers/clk/realtek/clk-pll-mmc.c b/drivers/clk/realtek/clk-pll-mmc.c new file mode 100644 index 000000000000..8da1933a5a07 --- /dev/null +++ b/drivers/clk/realtek/clk-pll-mmc.c @@ -0,0 +1,434 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Copyright (C) 2021-2026 Realtek Semiconductor Corporation + * Author: Cheng-Yu Lee + */ + +#include +#include +#include +#include +#include +#include +#include "clk-pll.h" + +#define RTK_PLL_MMC_VAL_MIN 1 +#define RTK_PLL_MMC_VAL_MAX 255 + +#define RTK_PLL_EMMC1_OFFSET 0x0 +#define RTK_PLL_EMMC2_OFFSET 0x4 +#define RTK_PLL_EMMC3_OFFSET 0x8 +#define RTK_PLL_EMMC4_OFFSET 0xc +#define RTK_PLL_SSC_DIG_EMMC1_OFFSET 0x0 +#define RTK_PLL_SSC_DIG_EMMC3_OFFSET 0xc +#define RTK_PLL_SSC_DIG_EMMC4_OFFSET 0x10 + +#define RTK_PLL_MMC_SSC_DIV_N_VAL 0x1b + +#define RTK_PLL_PHRT0_MASK BIT(0) +#define RTK_PLL_PHSEL_MASK GENMASK(4, 0) +#define RTK_PLL_SSCPLL_RS_MASK GENMASK(12, 10) +#define RTK_PLL_SSCPLL_ICP_MASK GENMASK(9, 5) +#define RTK_PLL_SSC_DIV_EXT_F_MASK GENMASK(25, 13) +#define RTK_PLL_PI_IBSELH_MASK GENMASK(28, 27) +#define RTK_PLL_SSC_DIV_N_MASK GENMASK(23, 16) +#define RTK_PLL_NCODE_SSC_EMMC_MASK GENMASK(20, 13) +#define RTK_PLL_FCODE_SSC_EMMC_MASK GENMASK(12, 0) +#define RTK_PLL_GRAN_EST_EM_MC_MASK GENMASK(20, 0) +#define RTK_PLL_EN_SSC_EMMC_MASK BIT(0) +#define RTK_PLL_FLAG_INITAL_EMMC_MASK BIT(8) + +#define RTK_PLL_PHRT0_SHIFT 1 +#define RTK_PLL_SSCPLL_RS_SHIFT 10 +#define RTK_PLL_SSCPLL_ICP_SHIFT 5 +#define RTK_PLL_SSC_DIV_EXT_F_SHIFT 13 +#define RTK_PLL_PI_IBSELH_SHIFT 27 +#define RTK_PLL_SSC_DIV_N_SHIFT 16 +#define RTK_PLL_NCODE_SSC_EMMC_SHIFT 13 +#define RTK_PLL_FLAG_INITAL_EMMC_SHIFT 8 + +#define CYCLE_DEGREES 360 +#define PHASE_STEPS 32 +#define PHASE_SCALE_FACTOR 1125 + +static inline struct rtk_clk_regmap_pll_mmc *to_clk_pll_mmc(struct clk_hw *hw) +{ + struct rtk_clk_regmap *clkr = to_rtk_clk_regmap(hw); + + return container_of(clkr, struct rtk_clk_regmap_pll_mmc, clkr); +} + +static inline int get_phrt0(struct rtk_clk_regmap_pll_mmc *clkm, u32 *val) +{ + u32 reg; + int ret; + + ret = regmap_read(clkm->clkr.regmap, clkm->pll_ofs + RTK_PLL_EMMC1_OFFSET, ®); + if (ret) + return ret; + + *val = (reg >> RTK_PLL_PHRT0_SHIFT) & RTK_PLL_PHRT0_MASK; + + return 0; +} + +static inline int set_phrt0(struct rtk_clk_regmap_pll_mmc *clkm, u32 val) +{ + return regmap_update_bits(clkm->clkr.regmap, clkm->pll_ofs + RTK_PLL_EMMC1_OFFSET, + RTK_PLL_PHRT0_MASK << RTK_PLL_PHRT0_SHIFT, + val << RTK_PLL_PHRT0_SHIFT); +} + +static inline int get_phsel(struct rtk_clk_regmap_pll_mmc *clkm, int id, u32 *val) +{ + u32 sft = id ? 8 : 3; + u32 raw_val; + int ret; + + ret = regmap_read(clkm->clkr.regmap, clkm->pll_ofs + RTK_PLL_EMMC1_OFFSET, &raw_val); + if (ret) + return ret; + + *val = (raw_val >> sft) & RTK_PLL_PHSEL_MASK; + + return 0; +} + +static inline int set_phsel(struct rtk_clk_regmap_pll_mmc *clkm, int id, u32 val) +{ + u32 sft = id ? 8 : 3; + + return regmap_update_bits(clkm->clkr.regmap, clkm->pll_ofs + RTK_PLL_EMMC1_OFFSET, + RTK_PLL_PHSEL_MASK << sft, val << sft); +} + +static inline int set_sscpll_rs(struct rtk_clk_regmap_pll_mmc *clkm, u32 val) +{ + return regmap_update_bits(clkm->clkr.regmap, clkm->pll_ofs + RTK_PLL_EMMC2_OFFSET, + RTK_PLL_SSCPLL_RS_MASK, val << RTK_PLL_SSCPLL_RS_SHIFT); +} + +static inline int set_sscpll_icp(struct rtk_clk_regmap_pll_mmc *clkm, u32 val) +{ + return regmap_update_bits(clkm->clkr.regmap, clkm->pll_ofs + RTK_PLL_EMMC2_OFFSET, + RTK_PLL_SSCPLL_ICP_MASK, val << RTK_PLL_SSCPLL_ICP_SHIFT); +} + +static inline int get_ssc_div_ext_f(struct rtk_clk_regmap_pll_mmc *clkm, u32 *val) +{ + u32 raw_val; + int ret; + + ret = regmap_read(clkm->clkr.regmap, clkm->pll_ofs + RTK_PLL_EMMC2_OFFSET, &raw_val); + if (ret) + return ret; + + *val = (raw_val & RTK_PLL_SSC_DIV_EXT_F_MASK) >> RTK_PLL_SSC_DIV_EXT_F_SHIFT; + + return 0; +} + +static inline int set_ssc_div_ext_f(struct rtk_clk_regmap_pll_mmc *clkm, u32 val) +{ + return regmap_update_bits(clkm->clkr.regmap, clkm->pll_ofs + RTK_PLL_EMMC2_OFFSET, + RTK_PLL_SSC_DIV_EXT_F_MASK, + val << RTK_PLL_SSC_DIV_EXT_F_SHIFT); +} + +static inline int set_pi_ibselh(struct rtk_clk_regmap_pll_mmc *clkm, u32 val) +{ + return regmap_update_bits(clkm->clkr.regmap, clkm->pll_ofs + RTK_PLL_EMMC2_OFFSET, + RTK_PLL_PI_IBSELH_MASK, val << RTK_PLL_PI_IBSELH_SHIFT); +} + +static inline int set_ssc_div_n(struct rtk_clk_regmap_pll_mmc *clkm, u32 val) +{ + return regmap_update_bits(clkm->clkr.regmap, clkm->pll_ofs + RTK_PLL_EMMC3_OFFSET, + RTK_PLL_SSC_DIV_N_MASK, val << RTK_PLL_SSC_DIV_N_SHIFT); +} + +static inline int get_ssc_div_n(struct rtk_clk_regmap_pll_mmc *clkm, u32 *val) +{ + int ret; + u32 raw_val; + + ret = regmap_read(clkm->clkr.regmap, clkm->pll_ofs + RTK_PLL_EMMC3_OFFSET, &raw_val); + if (ret) + return ret; + + *val = (raw_val & RTK_PLL_SSC_DIV_N_MASK) >> RTK_PLL_SSC_DIV_N_SHIFT; + + return 0; +} + +static inline int set_pow_ctl(struct rtk_clk_regmap_pll_mmc *clkm, u32 val) +{ + return regmap_write(clkm->clkr.regmap, clkm->pll_ofs + RTK_PLL_EMMC4_OFFSET, val); +} + +static inline int get_pow_ctl(struct rtk_clk_regmap_pll_mmc *clkm, u32 *val) +{ + int ret; + u32 raw_val; + + ret = regmap_read(clkm->clkr.regmap, clkm->pll_ofs + RTK_PLL_EMMC4_OFFSET, &raw_val); + if (ret) + return ret; + + *val = raw_val; + + return 0; +} + +static int rtk_clk_regmap_pll_mmc_phase_set_phase(struct clk_hw *hw, int degrees) +{ + struct clk_hw *hwp = clk_hw_get_parent(hw); + struct rtk_clk_regmap_pll_mmc *clkm; + int phase_id; + int ret; + u32 val; + + if (!hwp) + return -ENOENT; + + clkm = to_clk_pll_mmc(hwp); + phase_id = (hw == &clkm->phase0_hw) ? 0 : 1; + val = DIV_ROUND_CLOSEST(degrees * 100, PHASE_SCALE_FACTOR); + ret = set_phsel(clkm, phase_id, val); + if (ret) + return ret; + + usleep_range(10, 20); + + return 0; +} + +static int rtk_clk_regmap_pll_mmc_phase_get_phase(struct clk_hw *hw) +{ + struct clk_hw *hwp; + struct rtk_clk_regmap_pll_mmc *clkm; + int phase_id; + int ret; + u32 val; + + hwp = clk_hw_get_parent(hw); + if (!hwp) + return -ENOENT; + + clkm = to_clk_pll_mmc(hwp); + phase_id = (hw == &clkm->phase0_hw) ? 0 : 1; + ret = get_phsel(clkm, phase_id, &val); + if (ret) + return ret; + + val = DIV_ROUND_CLOSEST(val * CYCLE_DEGREES, PHASE_STEPS); + + return val; +} + +const struct clk_ops rtk_clk_pll_mmc_phase_ops = { + .set_phase = rtk_clk_regmap_pll_mmc_phase_set_phase, + .get_phase = rtk_clk_regmap_pll_mmc_phase_get_phase, +}; +EXPORT_SYMBOL_NS_GPL(rtk_clk_pll_mmc_phase_ops, "REALTEK_CLK"); + +static int rtk_clk_regmap_pll_mmc_prepare(struct clk_hw *hw) +{ + struct rtk_clk_regmap_pll_mmc *clkm = to_clk_pll_mmc(hw); + + return set_pow_ctl(clkm, 7); +} + +static void rtk_clk_regmap_pll_mmc_unprepare(struct clk_hw *hw) +{ + struct rtk_clk_regmap_pll_mmc *clkm = to_clk_pll_mmc(hw); + + set_pow_ctl(clkm, 0); +} + +static int rtk_clk_regmap_pll_mmc_is_prepared(struct clk_hw *hw) +{ + struct rtk_clk_regmap_pll_mmc *clkm = to_clk_pll_mmc(hw); + u32 val; + int ret; + + ret = get_pow_ctl(clkm, &val); + if (ret) + return 1; + + return val != 0x0; +} + +static int rtk_clk_regmap_pll_mmc_enable(struct clk_hw *hw) +{ + struct rtk_clk_regmap_pll_mmc *clkm = to_clk_pll_mmc(hw); + int ret; + + ret = set_phrt0(clkm, 1); + if (ret) + return ret; + + udelay(10); + + return 0; +} + +static void rtk_clk_regmap_pll_mmc_disable(struct clk_hw *hw) +{ + struct rtk_clk_regmap_pll_mmc *clkm = to_clk_pll_mmc(hw); + + set_phrt0(clkm, 0); + udelay(10); +} + +static int rtk_clk_regmap_pll_mmc_is_enabled(struct clk_hw *hw) +{ + struct rtk_clk_regmap_pll_mmc *clkm = to_clk_pll_mmc(hw); + u32 val; + int ret; + + ret = get_phrt0(clkm, &val); + if (ret) + return 1; + + return val == 0x1; +} + +static unsigned long rtk_clk_regmap_pll_mmc_recalc_rate(struct clk_hw *hw, + unsigned long parent_rate) +{ + struct rtk_clk_regmap_pll_mmc *clkm = to_clk_pll_mmc(hw); + u32 val, ext_f; + u64 rate, base; + int ret; + + ret = get_ssc_div_n(clkm, &val); + if (ret) + return 0; + + ret = get_ssc_div_ext_f(clkm, &ext_f); + if (ret) + return 0; + + base = parent_rate / 4; + rate = base * (val + 2); + rate += div_u64(base * ext_f, 8192); + + return rate; +} + +static int rtk_clk_regmap_pll_mmc_determine_rate(struct clk_hw *hw, struct clk_rate_request *req) +{ + u32 val; + + if (!req->best_parent_rate) + return -EINVAL; + + val = DIV_ROUND_CLOSEST_ULL((u64)req->rate * 4, req->best_parent_rate); + val = clamp_t(u32, val, RTK_PLL_MMC_VAL_MIN, RTK_PLL_MMC_VAL_MAX); + req->rate = req->best_parent_rate * val / 4; + + return 0; +} + +static int rtk_clk_regmap_pll_mmc_set_rate(struct clk_hw *hw, unsigned long rate, + unsigned long parent_rate) +{ + struct rtk_clk_regmap_pll_mmc *clkm = to_clk_pll_mmc(hw); + u32 val = RTK_PLL_MMC_SSC_DIV_N_VAL; + int ret; + + /* + * The 'rate' and 'parent_rate' are intentionally unused here. + * + * Despite receiving various rate requests (e.g., 26MHz, 52MHz, 200MHz), + * this function consistently configures the hardware for 27MHz (0x1b). + * This is because these settings reflect the input reference clock + * frequency to the SSCPLL, not the final PLL output frequency. + * + * The actual frequency division to achieve the requested eMMC rate + * is handled internally by the downstream eMMC host controller. + */ + + ret = regmap_update_bits(clkm->clkr.regmap, + clkm->ssc_dig_ofs + RTK_PLL_SSC_DIG_EMMC1_OFFSET, + RTK_PLL_FLAG_INITAL_EMMC_MASK, + 0x0 << RTK_PLL_FLAG_INITAL_EMMC_SHIFT); + if (ret) + return ret; + + ret = set_ssc_div_n(clkm, val); + if (ret) + return ret; + + ret = set_ssc_div_ext_f(clkm, 1517); + if (ret) + return ret; + + ret = set_pi_ibselh(clkm, 2); + if (ret) + return ret; + + ret = set_sscpll_rs(clkm, 3); + if (ret) + return ret; + + ret = set_sscpll_icp(clkm, 1); + if (ret) + return ret; + + ret = regmap_update_bits(clkm->clkr.regmap, + clkm->ssc_dig_ofs + RTK_PLL_SSC_DIG_EMMC3_OFFSET, + RTK_PLL_NCODE_SSC_EMMC_MASK, + 27 << RTK_PLL_NCODE_SSC_EMMC_SHIFT); + if (ret) + return ret; + + ret = regmap_update_bits(clkm->clkr.regmap, + clkm->ssc_dig_ofs + RTK_PLL_SSC_DIG_EMMC3_OFFSET, + RTK_PLL_FCODE_SSC_EMMC_MASK, 321); + if (ret) + return ret; + + ret = regmap_update_bits(clkm->clkr.regmap, + clkm->ssc_dig_ofs + RTK_PLL_SSC_DIG_EMMC4_OFFSET, + RTK_PLL_GRAN_EST_EM_MC_MASK, 5985); + if (ret) + return ret; + + ret = regmap_update_bits(clkm->clkr.regmap, + clkm->ssc_dig_ofs + RTK_PLL_SSC_DIG_EMMC1_OFFSET, + RTK_PLL_EN_SSC_EMMC_MASK, 0x1); + if (ret) + return ret; + + ret = regmap_update_bits(clkm->clkr.regmap, + clkm->ssc_dig_ofs + RTK_PLL_SSC_DIG_EMMC1_OFFSET, + RTK_PLL_EN_SSC_EMMC_MASK, 0x0); + if (ret) + return ret; + + ret = regmap_update_bits(clkm->clkr.regmap, + clkm->ssc_dig_ofs + RTK_PLL_SSC_DIG_EMMC1_OFFSET, + RTK_PLL_FLAG_INITAL_EMMC_MASK, + 0x1 << RTK_PLL_FLAG_INITAL_EMMC_SHIFT); + if (ret) + return ret; + + usleep_range(10, 20); + + return 0; +} + +const struct clk_ops rtk_clk_pll_mmc_ops = { + .prepare = rtk_clk_regmap_pll_mmc_prepare, + .unprepare = rtk_clk_regmap_pll_mmc_unprepare, + .is_prepared = rtk_clk_regmap_pll_mmc_is_prepared, + .enable = rtk_clk_regmap_pll_mmc_enable, + .disable = rtk_clk_regmap_pll_mmc_disable, + .is_enabled = rtk_clk_regmap_pll_mmc_is_enabled, + .recalc_rate = rtk_clk_regmap_pll_mmc_recalc_rate, + .determine_rate = rtk_clk_regmap_pll_mmc_determine_rate, + .set_rate = rtk_clk_regmap_pll_mmc_set_rate, +}; +EXPORT_SYMBOL_NS_GPL(rtk_clk_pll_mmc_ops, "REALTEK_CLK"); diff --git a/drivers/clk/realtek/clk-pll.h b/drivers/clk/realtek/clk-pll.h index 023b49bbcbee..d21793387eee 100644 --- a/drivers/clk/realtek/clk-pll.h +++ b/drivers/clk/realtek/clk-pll.h @@ -44,4 +44,17 @@ struct rtk_clk_regmap_pll { extern const struct clk_ops rtk_clk_pll_ops; extern const struct clk_ops rtk_clk_pll_ro_ops; +struct rtk_clk_regmap_pll_mmc { + struct rtk_clk_regmap clkr; + unsigned int pll_ofs; + unsigned int ssc_dig_ofs; + struct clk_hw phase0_hw; + struct clk_hw phase1_hw; +}; + +#define __rtk_clk_regmap_pll_mmc_hw(_ptr) __rtk_clk_regmap_hw(&(_ptr)->clkr) + +extern const struct clk_ops rtk_clk_pll_mmc_ops; +extern const struct clk_ops rtk_clk_pll_mmc_phase_ops; + #endif /* __CLK_REALTEK_CLK_PLL_H */ -- 2.43.0