1cfe238e4SDavid Virag // SPDX-License-Identifier: GPL-2.0-only 2cfe238e4SDavid Virag /* 3cfe238e4SDavid Virag * Copyright (C) 2021 Linaro Ltd. 4cfe238e4SDavid Virag * Copyright (C) 2021 Dávid Virág <virag.david003@gmail.com> 5cfe238e4SDavid Virag * Author: Sam Protsenko <semen.protsenko@linaro.org> 6cfe238e4SDavid Virag * Author: Dávid Virág <virag.david003@gmail.com> 7cfe238e4SDavid Virag * 8cfe238e4SDavid Virag * This file contains shared functions used by some arm64 Exynos SoCs, 9cfe238e4SDavid Virag * such as Exynos7885 or Exynos850 to register and init CMUs. 10cfe238e4SDavid Virag */ 11cfe238e4SDavid Virag #include <linux/clk.h> 12cfe238e4SDavid Virag #include <linux/of_address.h> 13cfe238e4SDavid Virag 14cfe238e4SDavid Virag #include "clk-exynos-arm64.h" 15cfe238e4SDavid Virag 16cfe238e4SDavid Virag /* Gate register bits */ 17cfe238e4SDavid Virag #define GATE_MANUAL BIT(20) 18cfe238e4SDavid Virag #define GATE_ENABLE_HWACG BIT(28) 19cfe238e4SDavid Virag 20cfe238e4SDavid Virag /* Gate register offsets range */ 21cfe238e4SDavid Virag #define GATE_OFF_START 0x2000 22cfe238e4SDavid Virag #define GATE_OFF_END 0x2fff 23cfe238e4SDavid Virag 24cfe238e4SDavid Virag /** 25cfe238e4SDavid Virag * exynos_arm64_init_clocks - Set clocks initial configuration 26cfe238e4SDavid Virag * @np: CMU device tree node with "reg" property (CMU addr) 27cfe238e4SDavid Virag * @reg_offs: Register offsets array for clocks to init 28cfe238e4SDavid Virag * @reg_offs_len: Number of register offsets in reg_offs array 29cfe238e4SDavid Virag * 30cfe238e4SDavid Virag * Set manual control mode for all gate clocks. 31cfe238e4SDavid Virag */ 32cfe238e4SDavid Virag static void __init exynos_arm64_init_clocks(struct device_node *np, 33cfe238e4SDavid Virag const unsigned long *reg_offs, size_t reg_offs_len) 34cfe238e4SDavid Virag { 35cfe238e4SDavid Virag void __iomem *reg_base; 36cfe238e4SDavid Virag size_t i; 37cfe238e4SDavid Virag 38cfe238e4SDavid Virag reg_base = of_iomap(np, 0); 39cfe238e4SDavid Virag if (!reg_base) 40cfe238e4SDavid Virag panic("%s: failed to map registers\n", __func__); 41cfe238e4SDavid Virag 42cfe238e4SDavid Virag for (i = 0; i < reg_offs_len; ++i) { 43cfe238e4SDavid Virag void __iomem *reg = reg_base + reg_offs[i]; 44cfe238e4SDavid Virag u32 val; 45cfe238e4SDavid Virag 46cfe238e4SDavid Virag /* Modify only gate clock registers */ 47cfe238e4SDavid Virag if (reg_offs[i] < GATE_OFF_START || reg_offs[i] > GATE_OFF_END) 48cfe238e4SDavid Virag continue; 49cfe238e4SDavid Virag 50cfe238e4SDavid Virag val = readl(reg); 51cfe238e4SDavid Virag val |= GATE_MANUAL; 52cfe238e4SDavid Virag val &= ~GATE_ENABLE_HWACG; 53cfe238e4SDavid Virag writel(val, reg); 54cfe238e4SDavid Virag } 55cfe238e4SDavid Virag 56cfe238e4SDavid Virag iounmap(reg_base); 57cfe238e4SDavid Virag } 58cfe238e4SDavid Virag 59cfe238e4SDavid Virag /** 60*454e8d29SSam Protsenko * exynos_arm64_enable_bus_clk - Enable parent clock of specified CMU 61*454e8d29SSam Protsenko * 62*454e8d29SSam Protsenko * @dev: Device object; may be NULL if this function is not being 63*454e8d29SSam Protsenko * called from platform driver probe function 64*454e8d29SSam Protsenko * @np: CMU device tree node 65*454e8d29SSam Protsenko * @cmu: CMU data 66*454e8d29SSam Protsenko * 67*454e8d29SSam Protsenko * Keep CMU parent clock running (needed for CMU registers access). 68*454e8d29SSam Protsenko * 69*454e8d29SSam Protsenko * Return: 0 on success or a negative error code on failure. 70*454e8d29SSam Protsenko */ 71*454e8d29SSam Protsenko static int __init exynos_arm64_enable_bus_clk(struct device *dev, 72*454e8d29SSam Protsenko struct device_node *np, const struct samsung_cmu_info *cmu) 73*454e8d29SSam Protsenko { 74*454e8d29SSam Protsenko struct clk *parent_clk; 75*454e8d29SSam Protsenko 76*454e8d29SSam Protsenko if (!cmu->clk_name) 77*454e8d29SSam Protsenko return 0; 78*454e8d29SSam Protsenko 79*454e8d29SSam Protsenko if (dev) 80*454e8d29SSam Protsenko parent_clk = clk_get(dev, cmu->clk_name); 81*454e8d29SSam Protsenko else 82*454e8d29SSam Protsenko parent_clk = of_clk_get_by_name(np, cmu->clk_name); 83*454e8d29SSam Protsenko 84*454e8d29SSam Protsenko if (IS_ERR(parent_clk)) 85*454e8d29SSam Protsenko return PTR_ERR(parent_clk); 86*454e8d29SSam Protsenko 87*454e8d29SSam Protsenko return clk_prepare_enable(parent_clk); 88*454e8d29SSam Protsenko } 89*454e8d29SSam Protsenko 90*454e8d29SSam Protsenko /** 91cfe238e4SDavid Virag * exynos_arm64_register_cmu - Register specified Exynos CMU domain 92cfe238e4SDavid Virag * @dev: Device object; may be NULL if this function is not being 93cfe238e4SDavid Virag * called from platform driver probe function 94cfe238e4SDavid Virag * @np: CMU device tree node 95cfe238e4SDavid Virag * @cmu: CMU data 96cfe238e4SDavid Virag * 97cfe238e4SDavid Virag * Register specified CMU domain, which includes next steps: 98cfe238e4SDavid Virag * 99cfe238e4SDavid Virag * 1. Enable parent clock of @cmu CMU 100cfe238e4SDavid Virag * 2. Set initial registers configuration for @cmu CMU clocks 101cfe238e4SDavid Virag * 3. Register @cmu CMU clocks using Samsung clock framework API 102cfe238e4SDavid Virag */ 103cfe238e4SDavid Virag void __init exynos_arm64_register_cmu(struct device *dev, 104cfe238e4SDavid Virag struct device_node *np, const struct samsung_cmu_info *cmu) 105cfe238e4SDavid Virag { 106*454e8d29SSam Protsenko int err; 107cfe238e4SDavid Virag 108*454e8d29SSam Protsenko /* 109*454e8d29SSam Protsenko * Try to boot even if the parent clock enablement fails, as it might be 110*454e8d29SSam Protsenko * already enabled by bootloader. 111*454e8d29SSam Protsenko */ 112*454e8d29SSam Protsenko err = exynos_arm64_enable_bus_clk(dev, np, cmu); 113*454e8d29SSam Protsenko if (err) 114*454e8d29SSam Protsenko pr_err("%s: could not enable bus clock %s; err = %d\n", 115*454e8d29SSam Protsenko __func__, cmu->clk_name, err); 116cfe238e4SDavid Virag 117cfe238e4SDavid Virag exynos_arm64_init_clocks(np, cmu->clk_regs, cmu->nr_clk_regs); 118cfe238e4SDavid Virag samsung_cmu_register_one(np, cmu); 119cfe238e4SDavid Virag } 120