clk-master.c 3.73 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14
/*
 *  Copyright (C) 2013 Boris BREZILLON <b.brezillon@overkiz.com>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 */

#include <linux/clk-provider.h>
#include <linux/clkdev.h>
#include <linux/clk/at91_pmc.h>
#include <linux/of.h>
15 16
#include <linux/mfd/syscon.h>
#include <linux/regmap.h>
17 18 19 20 21 22 23 24 25 26 27 28

#include "pmc.h"

#define MASTER_PRES_MASK	0x7
#define MASTER_PRES_MAX		MASTER_PRES_MASK
#define MASTER_DIV_SHIFT	8
#define MASTER_DIV_MASK		0x3

#define to_clk_master(hw) container_of(hw, struct clk_master, hw)

struct clk_master {
	struct clk_hw hw;
29
	struct regmap *regmap;
30 31
	const struct clk_master_layout *layout;
	const struct clk_master_characteristics *characteristics;
32
	u32 mckr;
33 34
};

35 36 37 38 39 40 41 42 43
static inline bool clk_master_ready(struct regmap *regmap)
{
	unsigned int status;

	regmap_read(regmap, AT91_PMC_SR, &status);

	return status & AT91_PMC_MCKRDY ? 1 : 0;
}

44 45 46 47
static int clk_master_prepare(struct clk_hw *hw)
{
	struct clk_master *master = to_clk_master(hw);

48 49
	while (!clk_master_ready(master->regmap))
		cpu_relax();
50 51 52 53 54 55 56 57

	return 0;
}

static int clk_master_is_prepared(struct clk_hw *hw)
{
	struct clk_master *master = to_clk_master(hw);

58
	return clk_master_ready(master->regmap);
59 60 61 62 63 64 65 66 67 68 69 70
}

static unsigned long clk_master_recalc_rate(struct clk_hw *hw,
					    unsigned long parent_rate)
{
	u8 pres;
	u8 div;
	unsigned long rate = parent_rate;
	struct clk_master *master = to_clk_master(hw);
	const struct clk_master_layout *layout = master->layout;
	const struct clk_master_characteristics *characteristics =
						master->characteristics;
71
	unsigned int mckr;
72

73
	regmap_read(master->regmap, master->layout->offset, &mckr);
74
	mckr &= layout->mask;
75

76 77
	pres = (mckr >> layout->pres_shift) & MASTER_PRES_MASK;
	div = (mckr >> MASTER_DIV_SHIFT) & MASTER_DIV_MASK;
78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96

	if (characteristics->have_div3_pres && pres == MASTER_PRES_MAX)
		rate /= 3;
	else
		rate >>= pres;

	rate /= characteristics->divisors[div];

	if (rate < characteristics->output.min)
		pr_warn("master clk is underclocked");
	else if (rate > characteristics->output.max)
		pr_warn("master clk is overclocked");

	return rate;
}

static u8 clk_master_get_parent(struct clk_hw *hw)
{
	struct clk_master *master = to_clk_master(hw);
97 98
	unsigned int mckr;

99
	regmap_read(master->regmap, master->layout->offset, &mckr);
100

101
	return mckr & AT91_PMC_CSS;
102 103 104 105 106 107 108 109 110
}

static const struct clk_ops master_ops = {
	.prepare = clk_master_prepare,
	.is_prepared = clk_master_is_prepared,
	.recalc_rate = clk_master_recalc_rate,
	.get_parent = clk_master_get_parent,
};

111
struct clk_hw * __init
112
at91_clk_register_master(struct regmap *regmap,
113 114 115 116 117 118 119
		const char *name, int num_parents,
		const char **parent_names,
		const struct clk_master_layout *layout,
		const struct clk_master_characteristics *characteristics)
{
	struct clk_master *master;
	struct clk_init_data init;
120 121
	struct clk_hw *hw;
	int ret;
122

123
	if (!name || !num_parents || !parent_names)
124 125 126 127 128 129 130 131 132 133 134 135 136 137 138
		return ERR_PTR(-EINVAL);

	master = kzalloc(sizeof(*master), GFP_KERNEL);
	if (!master)
		return ERR_PTR(-ENOMEM);

	init.name = name;
	init.ops = &master_ops;
	init.parent_names = parent_names;
	init.num_parents = num_parents;
	init.flags = 0;

	master->hw.init = &init;
	master->layout = layout;
	master->characteristics = characteristics;
139
	master->regmap = regmap;
140

141 142 143
	hw = &master->hw;
	ret = clk_hw_register(NULL, &master->hw);
	if (ret) {
144
		kfree(master);
145
		hw = ERR_PTR(ret);
146
	}
147

148
	return hw;
149 150
}

151
const struct clk_master_layout at91rm9200_master_layout = {
152 153
	.mask = 0x31F,
	.pres_shift = 2,
154
	.offset = AT91_PMC_MCKR,
155 156
};

157
const struct clk_master_layout at91sam9x5_master_layout = {
158 159
	.mask = 0x373,
	.pres_shift = 4,
160
	.offset = AT91_PMC_MCKR,
161
};