[deliverable/linux.git] / drivers / clk / at91 / pmc.c

/*
 *  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>
#include <linux/of_address.h>
#include <linux/io.h>
#include <linux/interrupt.h>
#include <linux/irq.h>
#include <linux/irqchip/chained_irq.h>
#include <linux/irqdomain.h>
#include <linux/of_irq.h>

#include <asm/proc-fns.h>

#include "pmc.h"

void __iomem *at91_pmc_base;
EXPORT_SYMBOL_GPL(at91_pmc_base);

void at91sam9_idle(void)
{
	at91_pmc_write(AT91_PMC_SCDR, AT91_PMC_PCK);
	cpu_do_idle();
}

int of_at91_get_clk_range(struct device_node *np, const char *propname,
			  struct clk_range *range)
{
	u32 min, max;
	int ret;

	ret = of_property_read_u32_index(np, propname, 0, &min);
	if (ret)
		return ret;

	ret = of_property_read_u32_index(np, propname, 1, &max);
	if (ret)
		return ret;

	if (range) {
		range->min = min;
		range->max = max;
	}

	return 0;
}
EXPORT_SYMBOL_GPL(of_at91_get_clk_range);

static void pmc_irq_mask(struct irq_data *d)
{
	struct at91_pmc *pmc = irq_data_get_irq_chip_data(d);

	pmc_write(pmc, AT91_PMC_IDR, 1 << d->hwirq);
}

static void pmc_irq_unmask(struct irq_data *d)
{
	struct at91_pmc *pmc = irq_data_get_irq_chip_data(d);

	pmc_write(pmc, AT91_PMC_IER, 1 << d->hwirq);
}

static int pmc_irq_set_type(struct irq_data *d, unsigned type)
{
	if (type != IRQ_TYPE_LEVEL_HIGH) {
		pr_warn("PMC: type not supported (support only IRQ_TYPE_LEVEL_HIGH type)\n");
		return -EINVAL;
	}

	return 0;
}

static struct irq_chip pmc_irq = {
	.name = "PMC",
	.irq_disable = pmc_irq_mask,
	.irq_mask = pmc_irq_mask,
	.irq_unmask = pmc_irq_unmask,
	.irq_set_type = pmc_irq_set_type,
};

static struct lock_class_key pmc_lock_class;

static int pmc_irq_map(struct irq_domain *h, unsigned int virq,
		       irq_hw_number_t hw)
{
	struct at91_pmc	*pmc = h->host_data;

	irq_set_lockdep_class(virq, &pmc_lock_class);

	irq_set_chip_and_handler(virq, &pmc_irq,
				 handle_level_irq);
	set_irq_flags(virq, IRQF_VALID);
	irq_set_chip_data(virq, pmc);

	return 0;
}

static int pmc_irq_domain_xlate(struct irq_domain *d,
				struct device_node *ctrlr,
				const u32 *intspec, unsigned int intsize,
				irq_hw_number_t *out_hwirq,
				unsigned int *out_type)
{
	struct at91_pmc *pmc = d->host_data;
	const struct at91_pmc_caps *caps = pmc->caps;

	if (WARN_ON(intsize < 1))
		return -EINVAL;

	*out_hwirq = intspec[0];

	if (!(caps->available_irqs & (1 << *out_hwirq)))
		return -EINVAL;

	*out_type = IRQ_TYPE_LEVEL_HIGH;

	return 0;
}

static struct irq_domain_ops pmc_irq_ops = {
	.map	= pmc_irq_map,
	.xlate	= pmc_irq_domain_xlate,
};

static irqreturn_t pmc_irq_handler(int irq, void *data)
{
	struct at91_pmc *pmc = (struct at91_pmc *)data;
	unsigned long sr;
	int n;

	sr = pmc_read(pmc, AT91_PMC_SR) & pmc_read(pmc, AT91_PMC_IMR);
	if (!sr)
		return IRQ_NONE;

	for_each_set_bit(n, &sr, BITS_PER_LONG)
		generic_handle_irq(irq_find_mapping(pmc->irqdomain, n));

	return IRQ_HANDLED;
}

static const struct at91_pmc_caps at91rm9200_caps = {
	.available_irqs = AT91_PMC_MOSCS | AT91_PMC_LOCKA | AT91_PMC_LOCKB |
			  AT91_PMC_MCKRDY | AT91_PMC_PCK0RDY |
			  AT91_PMC_PCK1RDY | AT91_PMC_PCK2RDY |
			  AT91_PMC_PCK3RDY,
};

static const struct at91_pmc_caps at91sam9260_caps = {
	.available_irqs = AT91_PMC_MOSCS | AT91_PMC_LOCKA | AT91_PMC_LOCKB |
			  AT91_PMC_MCKRDY | AT91_PMC_PCK0RDY |
			  AT91_PMC_PCK1RDY,
};

static const struct at91_pmc_caps at91sam9g45_caps = {
	.available_irqs = AT91_PMC_MOSCS | AT91_PMC_LOCKA | AT91_PMC_MCKRDY |
			  AT91_PMC_LOCKU | AT91_PMC_PCK0RDY |
			  AT91_PMC_PCK1RDY,
};

static const struct at91_pmc_caps at91sam9n12_caps = {
	.available_irqs = AT91_PMC_MOSCS | AT91_PMC_LOCKA | AT91_PMC_LOCKB |
			  AT91_PMC_MCKRDY | AT91_PMC_PCK0RDY |
			  AT91_PMC_PCK1RDY | AT91_PMC_MOSCSELS |
			  AT91_PMC_MOSCRCS | AT91_PMC_CFDEV,
};

static const struct at91_pmc_caps at91sam9x5_caps = {
	.available_irqs = AT91_PMC_MOSCS | AT91_PMC_LOCKA | AT91_PMC_MCKRDY |
			  AT91_PMC_LOCKU | AT91_PMC_PCK0RDY |
			  AT91_PMC_PCK1RDY | AT91_PMC_MOSCSELS |
			  AT91_PMC_MOSCRCS | AT91_PMC_CFDEV,
};

static const struct at91_pmc_caps sama5d3_caps = {
	.available_irqs = AT91_PMC_MOSCS | AT91_PMC_LOCKA | AT91_PMC_MCKRDY |
			  AT91_PMC_LOCKU | AT91_PMC_PCK0RDY |
			  AT91_PMC_PCK1RDY | AT91_PMC_PCK2RDY |
			  AT91_PMC_MOSCSELS | AT91_PMC_MOSCRCS |
			  AT91_PMC_CFDEV,
};

static struct at91_pmc *__init at91_pmc_init(struct device_node *np,
					     void __iomem *regbase, int virq,
					     const struct at91_pmc_caps *caps)
{
	struct at91_pmc *pmc;

	if (!regbase || !virq ||  !caps)
		return NULL;

	at91_pmc_base = regbase;

	pmc = kzalloc(sizeof(*pmc), GFP_KERNEL);
	if (!pmc)
		return NULL;

	spin_lock_init(&pmc->lock);
	pmc->regbase = regbase;
	pmc->virq = virq;
	pmc->caps = caps;

	pmc->irqdomain = irq_domain_add_linear(np, 32, &pmc_irq_ops, pmc);

	if (!pmc->irqdomain)
		goto out_free_pmc;

	pmc_write(pmc, AT91_PMC_IDR, 0xffffffff);
	if (request_irq(pmc->virq, pmc_irq_handler, IRQF_SHARED, "pmc", pmc))
		goto out_remove_irqdomain;

	return pmc;

out_remove_irqdomain:
	irq_domain_remove(pmc->irqdomain);
out_free_pmc:
	kfree(pmc);

	return NULL;
}

static const struct of_device_id pmc_clk_ids[] __initdata = {
	/* Main clock */
	{
		.compatible = "atmel,at91rm9200-clk-main",
		.data = of_at91rm9200_clk_main_setup,
	},
	/* PLL clocks */
	{
		.compatible = "atmel,at91rm9200-clk-pll",
		.data = of_at91rm9200_clk_pll_setup,
	},
	{
		.compatible = "atmel,at91sam9g45-clk-pll",
		.data = of_at91sam9g45_clk_pll_setup,
	},
	{
		.compatible = "atmel,at91sam9g20-clk-pllb",
		.data = of_at91sam9g20_clk_pllb_setup,
	},
	{
		.compatible = "atmel,sama5d3-clk-pll",
		.data = of_sama5d3_clk_pll_setup,
	},
	{
		.compatible = "atmel,at91sam9x5-clk-plldiv",
		.data = of_at91sam9x5_clk_plldiv_setup,
	},
	/* Master clock */
	{
		.compatible = "atmel,at91rm9200-clk-master",
		.data = of_at91rm9200_clk_master_setup,
	},
	{
		.compatible = "atmel,at91sam9x5-clk-master",
		.data = of_at91sam9x5_clk_master_setup,
	},
	/* System clocks */
	{
		.compatible = "atmel,at91rm9200-clk-system",
		.data = of_at91rm9200_clk_sys_setup,
	},
	/* Peripheral clocks */
	{
		.compatible = "atmel,at91rm9200-clk-peripheral",
		.data = of_at91rm9200_clk_periph_setup,
	},
	{
		.compatible = "atmel,at91sam9x5-clk-peripheral",
		.data = of_at91sam9x5_clk_periph_setup,
	},
	/* Programmable clocks */
#if defined(CONFIG_AT91_PROGRAMMABLE_CLOCKS)
	{
		.compatible = "atmel,at91rm9200-clk-programmable",
		.data = of_at91rm9200_clk_prog_setup,
	},
	{
		.compatible = "atmel,at91sam9g45-clk-programmable",
		.data = of_at91sam9g45_clk_prog_setup,
	},
	{
		.compatible = "atmel,at91sam9x5-clk-programmable",
		.data = of_at91sam9x5_clk_prog_setup,
	},
#endif
	/* UTMI clock */
#if defined(CONFIG_HAVE_AT91_UTMI)
	{
		.compatible = "atmel,at91sam9x5-clk-utmi",
		.data = of_at91sam9x5_clk_utmi_setup,
	},
#endif
	/* USB clock */
#if defined(CONFIG_HAVE_AT91_USB_CLK)
	{
		.compatible = "atmel,at91rm9200-clk-usb",
		.data = of_at91rm9200_clk_usb_setup,
	},
	{
		.compatible = "atmel,at91sam9x5-clk-usb",
		.data = of_at91sam9x5_clk_usb_setup,
	},
	{
		.compatible = "atmel,at91sam9n12-clk-usb",
		.data = of_at91sam9n12_clk_usb_setup,
	},
#endif
	{ /*sentinel*/ }
};

static void __init of_at91_pmc_setup(struct device_node *np,
				     const struct at91_pmc_caps *caps)
{
	struct at91_pmc *pmc;
	struct device_node *childnp;
	void (*clk_setup)(struct device_node *, struct at91_pmc *);
	const struct of_device_id *clk_id;
	void __iomem *regbase = of_iomap(np, 0);
	int virq;

	if (!regbase)
		return;

	virq = irq_of_parse_and_map(np, 0);
	if (!virq)
		return;

	pmc = at91_pmc_init(np, regbase, virq, caps);
	if (!pmc)
		return;
	for_each_child_of_node(np, childnp) {
		clk_id = of_match_node(pmc_clk_ids, childnp);
		if (!clk_id)
			continue;
		clk_setup = clk_id->data;
		clk_setup(childnp, pmc);
	}
}

static void __init of_at91rm9200_pmc_setup(struct device_node *np)
{
	of_at91_pmc_setup(np, &at91rm9200_caps);
}
CLK_OF_DECLARE(at91rm9200_clk_pmc, "atmel,at91rm9200-pmc",
	       of_at91rm9200_pmc_setup);

static void __init of_at91sam9260_pmc_setup(struct device_node *np)
{
	of_at91_pmc_setup(np, &at91sam9260_caps);
}
CLK_OF_DECLARE(at91sam9260_clk_pmc, "atmel,at91sam9260-pmc",
	       of_at91sam9260_pmc_setup);

static void __init of_at91sam9g45_pmc_setup(struct device_node *np)
{
	of_at91_pmc_setup(np, &at91sam9g45_caps);
}
CLK_OF_DECLARE(at91sam9g45_clk_pmc, "atmel,at91sam9g45-pmc",
	       of_at91sam9g45_pmc_setup);

static void __init of_at91sam9n12_pmc_setup(struct device_node *np)
{
	of_at91_pmc_setup(np, &at91sam9n12_caps);
}
CLK_OF_DECLARE(at91sam9n12_clk_pmc, "atmel,at91sam9n12-pmc",
	       of_at91sam9n12_pmc_setup);

static void __init of_at91sam9x5_pmc_setup(struct device_node *np)
{
	of_at91_pmc_setup(np, &at91sam9x5_caps);
}
CLK_OF_DECLARE(at91sam9x5_clk_pmc, "atmel,at91sam9x5-pmc",
	       of_at91sam9x5_pmc_setup);

static void __init of_sama5d3_pmc_setup(struct device_node *np)
{
	of_at91_pmc_setup(np, &sama5d3_caps);
}
CLK_OF_DECLARE(sama5d3_clk_pmc, "atmel,sama5d3-pmc",
	       of_sama5d3_pmc_setup);
Commit	Line	Data
0ad6125b BB	1	/*
	2	* Copyright (C) 2013 Boris BREZILLON <b.brezillon@overkiz.com>
	3	*
	4	* This program is free software; you can redistribute it and/or modify
	5	* it under the terms of the GNU General Public License as published by
	6	* the Free Software Foundation; either version 2 of the License, or
	7	* (at your option) any later version.
	8	*
	9	*/
	10
	11	#include <linux/clk-provider.h>
	12	#include <linux/clkdev.h>
	13	#include <linux/clk/at91_pmc.h>
	14	#include <linux/of.h>
	15	#include <linux/of_address.h>
	16	#include <linux/io.h>
	17	#include <linux/interrupt.h>
	18	#include <linux/irq.h>
	19	#include <linux/irqchip/chained_irq.h>
	20	#include <linux/irqdomain.h>
	21	#include <linux/of_irq.h>
	22
	23	#include <asm/proc-fns.h>
	24
	25	#include "pmc.h"
	26
	27	void __iomem *at91_pmc_base;
	28	EXPORT_SYMBOL_GPL(at91_pmc_base);
	29
	30	void at91sam9_idle(void)
	31	{
	32	at91_pmc_write(AT91_PMC_SCDR, AT91_PMC_PCK);
	33	cpu_do_idle();
	34	}
	35
	36	int of_at91_get_clk_range(struct device_node np, const char propname,
	37	struct clk_range *range)
	38	{
	39	u32 min, max;
	40	int ret;
	41
	42	ret = of_property_read_u32_index(np, propname, 0, &min);
	43	if (ret)
	44	return ret;
	45
	46	ret = of_property_read_u32_index(np, propname, 1, &max);
	47	if (ret)
	48	return ret;
	49
	50	if (range) {
	51	range->min = min;
	52	range->max = max;
	53	}
	54
	55	return 0;
	56	}
	57	EXPORT_SYMBOL_GPL(of_at91_get_clk_range);
	58
	59	static void pmc_irq_mask(struct irq_data *d)
	60	{
	61	struct at91_pmc *pmc = irq_data_get_irq_chip_data(d);
	62
	63	pmc_write(pmc, AT91_PMC_IDR, 1 << d->hwirq);
	64	}
65
66	static void pmc_irq_unmask(struct irq_data *d)
67	{
68	struct at91_pmc *pmc = irq_data_get_irq_chip_data(d);
69
70	pmc_write(pmc, AT91_PMC_IER, 1 << d->hwirq);
71	}
72
73	static int pmc_irq_set_type(struct irq_data *d, unsigned type)
74	{
75	if (type != IRQ_TYPE_LEVEL_HIGH) {
76	pr_warn("PMC: type not supported (support only IRQ_TYPE_LEVEL_HIGH type)\n");
77	return -EINVAL;
78	}
79
80	return 0;
81	}
82
83	static struct irq_chip pmc_irq = {
84	.name = "PMC",
85	.irq_disable = pmc_irq_mask,
86	.irq_mask = pmc_irq_mask,
87	.irq_unmask = pmc_irq_unmask,
88	.irq_set_type = pmc_irq_set_type,
89	};
90
91	static struct lock_class_key pmc_lock_class;
92
93	static int pmc_irq_map(struct irq_domain *h, unsigned int virq,
94	irq_hw_number_t hw)
95	{
96	struct at91_pmc *pmc = h->host_data;
97
98	irq_set_lockdep_class(virq, &pmc_lock_class);
99
100	irq_set_chip_and_handler(virq, &pmc_irq,
101	handle_level_irq);
102	set_irq_flags(virq, IRQF_VALID);
103	irq_set_chip_data(virq, pmc);
104
105	return 0;
106	}
107
108	static int pmc_irq_domain_xlate(struct irq_domain *d,
109	struct device_node *ctrlr,
110	const u32 *intspec, unsigned int intsize,
111	irq_hw_number_t *out_hwirq,
112	unsigned int *out_type)
113	{
114	struct at91_pmc *pmc = d->host_data;
115	const struct at91_pmc_caps *caps = pmc->caps;
116
117	if (WARN_ON(intsize < 1))
118	return -EINVAL;
119
120	*out_hwirq = intspec[0];
121
122	if (!(caps->available_irqs & (1 << *out_hwirq)))
123	return -EINVAL;
124
125	*out_type = IRQ_TYPE_LEVEL_HIGH;
126
127	return 0;
128	}
129
130	static struct irq_domain_ops pmc_irq_ops = {
131	.map = pmc_irq_map,
132	.xlate = pmc_irq_domain_xlate,
133	};
134
135	static irqreturn_t pmc_irq_handler(int irq, void *data)
136	{
137	struct at91_pmc pmc = (struct at91_pmc )data;
138	unsigned long sr;
139	int n;
140
141	sr = pmc_read(pmc, AT91_PMC_SR) & pmc_read(pmc, AT91_PMC_IMR);
142	if (!sr)
143	return IRQ_NONE;
144
145	for_each_set_bit(n, &sr, BITS_PER_LONG)
146	generic_handle_irq(irq_find_mapping(pmc->irqdomain, n));
147
148	return IRQ_HANDLED;
149	}
150
151	static const struct at91_pmc_caps at91rm9200_caps = {
152	.available_irqs = AT91_PMC_MOSCS \| AT91_PMC_LOCKA \| AT91_PMC_LOCKB \|
153	AT91_PMC_MCKRDY \| AT91_PMC_PCK0RDY \|
154	AT91_PMC_PCK1RDY \| AT91_PMC_PCK2RDY \|
155	AT91_PMC_PCK3RDY,
156	};
157
158	static const struct at91_pmc_caps at91sam9260_caps = {
159	.available_irqs = AT91_PMC_MOSCS \| AT91_PMC_LOCKA \| AT91_PMC_LOCKB \|
160	AT91_PMC_MCKRDY \| AT91_PMC_PCK0RDY \|
161	AT91_PMC_PCK1RDY,
162	};
163
164	static const struct at91_pmc_caps at91sam9g45_caps = {
165	.available_irqs = AT91_PMC_MOSCS \| AT91_PMC_LOCKA \| AT91_PMC_MCKRDY \|
166	AT91_PMC_LOCKU \| AT91_PMC_PCK0RDY \|
167	AT91_PMC_PCK1RDY,
168	};
169
170	static const struct at91_pmc_caps at91sam9n12_caps = {
171	.available_irqs = AT91_PMC_MOSCS \| AT91_PMC_LOCKA \| AT91_PMC_LOCKB \|
172	AT91_PMC_MCKRDY \| AT91_PMC_PCK0RDY \|
173	AT91_PMC_PCK1RDY \| AT91_PMC_MOSCSELS \|
174	AT91_PMC_MOSCRCS \| AT91_PMC_CFDEV,
175	};
176
177	static const struct at91_pmc_caps at91sam9x5_caps = {
178	.available_irqs = AT91_PMC_MOSCS \| AT91_PMC_LOCKA \| AT91_PMC_MCKRDY \|
179	AT91_PMC_LOCKU \| AT91_PMC_PCK0RDY \|
180	AT91_PMC_PCK1RDY \| AT91_PMC_MOSCSELS \|
181	AT91_PMC_MOSCRCS \| AT91_PMC_CFDEV,
182	};
183
184	static const struct at91_pmc_caps sama5d3_caps = {
185	.available_irqs = AT91_PMC_MOSCS \| AT91_PMC_LOCKA \| AT91_PMC_MCKRDY \|
186	AT91_PMC_LOCKU \| AT91_PMC_PCK0RDY \|
187	AT91_PMC_PCK1RDY \| AT91_PMC_PCK2RDY \|
188	AT91_PMC_MOSCSELS \| AT91_PMC_MOSCRCS \|
189	AT91_PMC_CFDEV,
190	};
191
192	static struct at91_pmc __init at91_pmc_init(struct device_node np,
193	void __iomem *regbase, int virq,
194	const struct at91_pmc_caps *caps)
195	{
196	struct at91_pmc *pmc;
197
198	if (!regbase \|\| !virq \|\| !caps)
199	return NULL;
200
201	at91_pmc_base = regbase;
202
203	pmc = kzalloc(sizeof(*pmc), GFP_KERNEL);
204	if (!pmc)
205	return NULL;
206
207	spin_lock_init(&pmc->lock);
208	pmc->regbase = regbase;
209	pmc->virq = virq;
210	pmc->caps = caps;
211
212	pmc->irqdomain = irq_domain_add_linear(np, 32, &pmc_irq_ops, pmc);
213
214	if (!pmc->irqdomain)
215	goto out_free_pmc;
216
217	pmc_write(pmc, AT91_PMC_IDR, 0xffffffff);
218	if (request_irq(pmc->virq, pmc_irq_handler, IRQF_SHARED, "pmc", pmc))
219	goto out_remove_irqdomain;
220
221	return pmc;
222
223	out_remove_irqdomain:
224	irq_domain_remove(pmc->irqdomain);
225	out_free_pmc:
226	kfree(pmc);
227
228	return NULL;
229	}
230
231	static const struct of_device_id pmc_clk_ids[] __initdata = {
38d34c31 BB	232	/* Main clock */
	233	{
	234	.compatible = "atmel,at91rm9200-clk-main",
	235	.data = of_at91rm9200_clk_main_setup,
	236	},
1a748d2b BB	237	/* PLL clocks */
	238	{
	239	.compatible = "atmel,at91rm9200-clk-pll",
	240	.data = of_at91rm9200_clk_pll_setup,
	241	},
	242	{
	243	.compatible = "atmel,at91sam9g45-clk-pll",
	244	.data = of_at91sam9g45_clk_pll_setup,
	245	},
	246	{
	247	.compatible = "atmel,at91sam9g20-clk-pllb",
	248	.data = of_at91sam9g20_clk_pllb_setup,
	249	},
	250	{
	251	.compatible = "atmel,sama5d3-clk-pll",
	252	.data = of_sama5d3_clk_pll_setup,
	253	},
	254	{
	255	.compatible = "atmel,at91sam9x5-clk-plldiv",
	256	.data = of_at91sam9x5_clk_plldiv_setup,
	257	},
e442d234 BB	258	/* Master clock */
	259	{
	260	.compatible = "atmel,at91rm9200-clk-master",
	261	.data = of_at91rm9200_clk_master_setup,
	262	},
	263	{
	264	.compatible = "atmel,at91sam9x5-clk-master",
	265	.data = of_at91sam9x5_clk_master_setup,
	266	},
5fba62ea BB	267	/* System clocks */
	268	{
	269	.compatible = "atmel,at91rm9200-clk-system",
	270	.data = of_at91rm9200_clk_sys_setup,
	271	},
6114067e BB	272	/* Peripheral clocks */
	273	{
	274	.compatible = "atmel,at91rm9200-clk-peripheral",
	275	.data = of_at91rm9200_clk_periph_setup,
	276	},
	277	{
	278	.compatible = "atmel,at91sam9x5-clk-peripheral",
	279	.data = of_at91sam9x5_clk_periph_setup,
	280	},
1f22f8bb BB	281	/* Programmable clocks */
	282	#if defined(CONFIG_AT91_PROGRAMMABLE_CLOCKS)
	283	{
	284	.compatible = "atmel,at91rm9200-clk-programmable",
	285	.data = of_at91rm9200_clk_prog_setup,
	286	},
	287	{
	288	.compatible = "atmel,at91sam9g45-clk-programmable",
	289	.data = of_at91sam9g45_clk_prog_setup,
	290	},
	291	{
	292	.compatible = "atmel,at91sam9x5-clk-programmable",
	293	.data = of_at91sam9x5_clk_prog_setup,
	294	},
f090fb37 BB	295	#endif
	296	/* UTMI clock */
	297	#if defined(CONFIG_HAVE_AT91_UTMI)
	298	{
	299	.compatible = "atmel,at91sam9x5-clk-utmi",
	300	.data = of_at91sam9x5_clk_utmi_setup,
	301	},
c84a61d8 BB	302	#endif
	303	/* USB clock */
	304	#if defined(CONFIG_HAVE_AT91_USB_CLK)
	305	{
	306	.compatible = "atmel,at91rm9200-clk-usb",
	307	.data = of_at91rm9200_clk_usb_setup,
	308	},
	309	{
	310	.compatible = "atmel,at91sam9x5-clk-usb",
	311	.data = of_at91sam9x5_clk_usb_setup,
	312	},
	313	{
	314	.compatible = "atmel,at91sam9n12-clk-usb",
	315	.data = of_at91sam9n12_clk_usb_setup,
	316	},
1f22f8bb	317	#endif
0ad6125b BB	318	{ /sentinel/ }
	319	};
	320
	321	static void __init of_at91_pmc_setup(struct device_node *np,
	322	const struct at91_pmc_caps *caps)
	323	{
	324	struct at91_pmc *pmc;
	325	struct device_node *childnp;
	326	void (clk_setup)(struct device_node , struct at91_pmc *);
	327	const struct of_device_id *clk_id;
	328	void __iomem *regbase = of_iomap(np, 0);
	329	int virq;
	330
	331	if (!regbase)
	332	return;
	333
	334	virq = irq_of_parse_and_map(np, 0);
	335	if (!virq)
	336	return;
	337
	338	pmc = at91_pmc_init(np, regbase, virq, caps);
	339	if (!pmc)
	340	return;
	341	for_each_child_of_node(np, childnp) {
	342	clk_id = of_match_node(pmc_clk_ids, childnp);
	343	if (!clk_id)
	344	continue;
	345	clk_setup = clk_id->data;
	346	clk_setup(childnp, pmc);
	347	}
	348	}
	349
	350	static void __init of_at91rm9200_pmc_setup(struct device_node *np)
	351	{
	352	of_at91_pmc_setup(np, &at91rm9200_caps);
	353	}
	354	CLK_OF_DECLARE(at91rm9200_clk_pmc, "atmel,at91rm9200-pmc",
	355	of_at91rm9200_pmc_setup);
	356
	357	static void __init of_at91sam9260_pmc_setup(struct device_node *np)
	358	{
	359	of_at91_pmc_setup(np, &at91sam9260_caps);
	360	}
	361	CLK_OF_DECLARE(at91sam9260_clk_pmc, "atmel,at91sam9260-pmc",
	362	of_at91sam9260_pmc_setup);
	363
	364	static void __init of_at91sam9g45_pmc_setup(struct device_node *np)
	365	{
	366	of_at91_pmc_setup(np, &at91sam9g45_caps);
	367	}
	368	CLK_OF_DECLARE(at91sam9g45_clk_pmc, "atmel,at91sam9g45-pmc",
	369	of_at91sam9g45_pmc_setup);
	370
	371	static void __init of_at91sam9n12_pmc_setup(struct device_node *np)
	372	{
	373	of_at91_pmc_setup(np, &at91sam9n12_caps);
	374	}
	375	CLK_OF_DECLARE(at91sam9n12_clk_pmc, "atmel,at91sam9n12-pmc",
	376	of_at91sam9n12_pmc_setup);
	377
	378	static void __init of_at91sam9x5_pmc_setup(struct device_node *np)
	379	{
	380	of_at91_pmc_setup(np, &at91sam9x5_caps);
	381	}
382	CLK_OF_DECLARE(at91sam9x5_clk_pmc, "atmel,at91sam9x5-pmc",
383	of_at91sam9x5_pmc_setup);
384
385	static void __init of_sama5d3_pmc_setup(struct device_node *np)
386	{
387	of_at91_pmc_setup(np, &sama5d3_caps);
388	}
389	CLK_OF_DECLARE(sama5d3_clk_pmc, "atmel,sama5d3-pmc",
390	of_sama5d3_pmc_setup);