| 
									
										
										
										
											2013-12-02 15:07:02 +01:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  *  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; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-12-16 22:25:27 +01:00
										 |  |  | static const struct of_device_id pmc_clk_ids[] __initconst = { | 
					
						
							| 
									
										
										
										
											2014-05-07 18:02:15 +02:00
										 |  |  | 	/* Slow oscillator */ | 
					
						
							|  |  |  | 	{ | 
					
						
							|  |  |  | 		.compatible = "atmel,at91sam9260-clk-slow", | 
					
						
							|  |  |  | 		.data = of_at91sam9260_clk_slow_setup, | 
					
						
							|  |  |  | 	}, | 
					
						
							| 
									
										
										
										
											2013-10-11 10:44:49 +02:00
										 |  |  | 	/* Main clock */ | 
					
						
							| 
									
										
										
										
											2014-05-07 18:00:08 +02:00
										 |  |  | 	{ | 
					
						
							|  |  |  | 		.compatible = "atmel,at91rm9200-clk-main-osc", | 
					
						
							|  |  |  | 		.data = of_at91rm9200_clk_main_osc_setup, | 
					
						
							|  |  |  | 	}, | 
					
						
							|  |  |  | 	{ | 
					
						
							|  |  |  | 		.compatible = "atmel,at91sam9x5-clk-main-rc-osc", | 
					
						
							|  |  |  | 		.data = of_at91sam9x5_clk_main_rc_osc_setup, | 
					
						
							|  |  |  | 	}, | 
					
						
							| 
									
										
										
										
											2013-10-11 10:44:49 +02:00
										 |  |  | 	{ | 
					
						
							|  |  |  | 		.compatible = "atmel,at91rm9200-clk-main", | 
					
						
							|  |  |  | 		.data = of_at91rm9200_clk_main_setup, | 
					
						
							|  |  |  | 	}, | 
					
						
							| 
									
										
										
										
											2014-05-07 18:00:08 +02:00
										 |  |  | 	{ | 
					
						
							|  |  |  | 		.compatible = "atmel,at91sam9x5-clk-main", | 
					
						
							|  |  |  | 		.data = of_at91sam9x5_clk_main_setup, | 
					
						
							|  |  |  | 	}, | 
					
						
							| 
									
										
										
										
											2013-10-11 10:48:26 +02:00
										 |  |  | 	/* 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, | 
					
						
							|  |  |  | 	}, | 
					
						
							| 
									
										
										
										
											2013-10-11 10:51:23 +02:00
										 |  |  | 	/* Master clock */ | 
					
						
							|  |  |  | 	{ | 
					
						
							|  |  |  | 		.compatible = "atmel,at91rm9200-clk-master", | 
					
						
							|  |  |  | 		.data = of_at91rm9200_clk_master_setup, | 
					
						
							|  |  |  | 	}, | 
					
						
							|  |  |  | 	{ | 
					
						
							|  |  |  | 		.compatible = "atmel,at91sam9x5-clk-master", | 
					
						
							|  |  |  | 		.data = of_at91sam9x5_clk_master_setup, | 
					
						
							|  |  |  | 	}, | 
					
						
							| 
									
										
										
										
											2013-10-11 11:41:41 +02:00
										 |  |  | 	/* System clocks */ | 
					
						
							|  |  |  | 	{ | 
					
						
							|  |  |  | 		.compatible = "atmel,at91rm9200-clk-system", | 
					
						
							|  |  |  | 		.data = of_at91rm9200_clk_sys_setup, | 
					
						
							|  |  |  | 	}, | 
					
						
							| 
									
										
										
										
											2013-10-11 11:44:36 +02:00
										 |  |  | 	/* Peripheral clocks */ | 
					
						
							|  |  |  | 	{ | 
					
						
							|  |  |  | 		.compatible = "atmel,at91rm9200-clk-peripheral", | 
					
						
							|  |  |  | 		.data = of_at91rm9200_clk_periph_setup, | 
					
						
							|  |  |  | 	}, | 
					
						
							|  |  |  | 	{ | 
					
						
							|  |  |  | 		.compatible = "atmel,at91sam9x5-clk-peripheral", | 
					
						
							|  |  |  | 		.data = of_at91sam9x5_clk_periph_setup, | 
					
						
							|  |  |  | 	}, | 
					
						
							| 
									
										
										
										
											2013-10-11 11:57:04 +02:00
										 |  |  | 	/* 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, | 
					
						
							|  |  |  | 	}, | 
					
						
							| 
									
										
										
										
											2013-10-11 12:22:06 +02:00
										 |  |  | 	/* UTMI clock */ | 
					
						
							|  |  |  | #if defined(CONFIG_HAVE_AT91_UTMI)
 | 
					
						
							|  |  |  | 	{ | 
					
						
							|  |  |  | 		.compatible = "atmel,at91sam9x5-clk-utmi", | 
					
						
							|  |  |  | 		.data = of_at91sam9x5_clk_utmi_setup, | 
					
						
							|  |  |  | 	}, | 
					
						
							| 
									
										
										
										
											2013-10-17 18:55:41 +02:00
										 |  |  | #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, | 
					
						
							|  |  |  | 	}, | 
					
						
							| 
									
										
										
										
											2013-10-11 13:27:06 +02:00
										 |  |  | #endif
 | 
					
						
							|  |  |  | 	/* SMD clock */ | 
					
						
							|  |  |  | #if defined(CONFIG_HAVE_AT91_SMD)
 | 
					
						
							|  |  |  | 	{ | 
					
						
							|  |  |  | 		.compatible = "atmel,at91sam9x5-clk-smd", | 
					
						
							|  |  |  | 		.data = of_at91sam9x5_clk_smd_setup, | 
					
						
							|  |  |  | 	}, | 
					
						
							| 
									
										
										
										
											2014-09-15 18:15:53 +02:00
										 |  |  | #endif
 | 
					
						
							|  |  |  | #if defined(CONFIG_HAVE_AT91_H32MX)
 | 
					
						
							|  |  |  | 	{ | 
					
						
							|  |  |  | 		.compatible = "atmel,sama5d4-clk-h32mx", | 
					
						
							|  |  |  | 		.data = of_sama5d4_clk_h32mx_setup, | 
					
						
							|  |  |  | 	}, | 
					
						
							| 
									
										
										
										
											2013-10-11 11:57:04 +02:00
										 |  |  | #endif
 | 
					
						
							| 
									
										
										
										
											2013-12-02 15:07:02 +01:00
										 |  |  | 	{ /*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); |