drivers/clk/tegra/clk-divider.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (c) 2012, NVIDIA CORPORATION.  All rights reserved.
   4  */
   5
   6 #include <linux/kernel.h>
   7 #include <linux/io.h>
   8 #include <linux/err.h>
   9 #include <linux/slab.h>
  10 #include <linux/clk-provider.h>
  11
  12 #include "clk.h"
  13
  14 #define pll_out_override(p) (BIT((p->shift - 6)))
  15 #define div_mask(d) ((1 << (d->width)) - 1)
  16 #define get_mul(d) (1 << d->frac_width)
  17 #define get_max_div(d) div_mask(d)
  18
  19 #define PERIPH_CLK_UART_DIV_ENB BIT(24)
  20
  21 static int get_div(struct tegra_clk_frac_div *divider, unsigned long rate,
  22                    unsigned long parent_rate)
  23 {
  24         int div;
  25
  26         div = div_frac_get(rate, parent_rate, divider->width,
  27                            divider->frac_width, divider->flags);
  28
  29         if (div < 0)
  30                 return 0;
  31
  32         return div;
  33 }
  34
  35 static unsigned long clk_frac_div_recalc_rate(struct clk_hw *hw,
  36                                              unsigned long parent_rate)
  37 {
  38         struct tegra_clk_frac_div *divider = to_clk_frac_div(hw);
  39         u32 reg;
  40         int div, mul;
  41         u64 rate = parent_rate;
  42
  43         reg = readl_relaxed(divider->reg) >> divider->shift;
  44         div = reg & div_mask(divider);
  45
  46         mul = get_mul(divider);
  47         div += mul;
  48
  49         rate *= mul;
  50         rate += div - 1;
  51         do_div(rate, div);
  52
  53         return rate;
  54 }
  55
  56 static long clk_frac_div_round_rate(struct clk_hw *hw, unsigned long rate,
  57                                    unsigned long *prate)
  58 {
  59         struct tegra_clk_frac_div *divider = to_clk_frac_div(hw);
  60         int div, mul;
  61         unsigned long output_rate = *prate;
  62
  63         if (!rate)
  64                 return output_rate;
  65
  66         div = get_div(divider, rate, output_rate);
  67         if (div < 0)
  68                 return *prate;
  69
  70         mul = get_mul(divider);
  71
  72         return DIV_ROUND_UP(output_rate * mul, div + mul);
  73 }
  74
  75 static int clk_frac_div_set_rate(struct clk_hw *hw, unsigned long rate,
  76                                 unsigned long parent_rate)
  77 {
  78         struct tegra_clk_frac_div *divider = to_clk_frac_div(hw);
  79         int div;
  80         unsigned long flags = 0;
  81         u32 val;
  82
  83         div = get_div(divider, rate, parent_rate);
  84         if (div < 0)
  85                 return div;
  86
  87         if (divider->lock)
  88                 spin_lock_irqsave(divider->lock, flags);
  89
  90         val = readl_relaxed(divider->reg);
  91         val &= ~(div_mask(divider) << divider->shift);
  92         val |= div << divider->shift;
  93
  94         if (divider->flags & TEGRA_DIVIDER_UART) {
  95                 if (div)
  96                         val |= PERIPH_CLK_UART_DIV_ENB;
  97                 else
  98                         val &= ~PERIPH_CLK_UART_DIV_ENB;
  99         }
 100
 101         if (divider->flags & TEGRA_DIVIDER_FIXED)
 102                 val |= pll_out_override(divider);
 103
 104         writel_relaxed(val, divider->reg);
 105
 106         if (divider->lock)
 107                 spin_unlock_irqrestore(divider->lock, flags);
 108
 109         return 0;
 110 }
 111
 112 static void clk_divider_restore_context(struct clk_hw *hw)
 113 {
 114         struct clk_hw *parent = clk_hw_get_parent(hw);
 115         unsigned long parent_rate = clk_hw_get_rate(parent);
 116         unsigned long rate = clk_hw_get_rate(hw);
 117
 118         if (clk_frac_div_set_rate(hw, rate, parent_rate) < 0)
 119                 WARN_ON(1);
 120 }
 121
 122 const struct clk_ops tegra_clk_frac_div_ops = {
 123         .recalc_rate = clk_frac_div_recalc_rate,
 124         .set_rate = clk_frac_div_set_rate,
 125         .round_rate = clk_frac_div_round_rate,
 126         .restore_context = clk_divider_restore_context,
 127 };
 128
 129 struct clk *tegra_clk_register_divider(const char *name,
 130                 const char *parent_name, void __iomem *reg,
 131                 unsigned long flags, u8 clk_divider_flags, u8 shift, u8 width,
 132                 u8 frac_width, spinlock_t *lock)
 133 {
 134         struct tegra_clk_frac_div *divider;
 135         struct clk *clk;
 136         struct clk_init_data init;
 137
 138         divider = kzalloc(sizeof(*divider), GFP_KERNEL);
 139         if (!divider) {
 140                 pr_err("%s: could not allocate fractional divider clk\n",
 141                        __func__);
 142                 return ERR_PTR(-ENOMEM);
 143         }
 144
 145         init.name = name;
 146         init.ops = &tegra_clk_frac_div_ops;
 147         init.flags = flags;
 148         init.parent_names = parent_name ? &parent_name : NULL;
 149         init.num_parents = parent_name ? 1 : 0;
 150
 151         divider->reg = reg;
 152         divider->shift = shift;
 153         divider->width = width;
 154         divider->frac_width = frac_width;
 155         divider->lock = lock;
 156         divider->flags = clk_divider_flags;
 157
 158         /* Data in .init is copied by clk_register(), so stack variable OK */
 159         divider->hw.init = &init;
 160
 161         clk = clk_register(NULL, &divider->hw);
 162         if (IS_ERR(clk))
 163                 kfree(divider);
 164
 165         return clk;
 166 }
 167
 168 static const struct clk_div_table mc_div_table[] = {
 169         { .val = 0, .div = 2 },
 170         { .val = 1, .div = 1 },
 171         { .val = 0, .div = 0 },
 172 };
 173
 174 struct clk *tegra_clk_register_mc(const char *name, const char *parent_name,
 175                                   void __iomem *reg, spinlock_t *lock)
 176 {
 177         return clk_register_divider_table(NULL, name, parent_name,
 178                                           CLK_IS_CRITICAL,
 179                                           reg, 16, 1, CLK_DIVIDER_READ_ONLY,
 180                                           mc_div_table, lock);
 181 }