2 * Copyright (C) 2013 Boris BREZILLON <b.brezillon@overkiz.com>
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.
11 #include <linux/clk-provider.h>
12 #include <linux/clkdev.h>
13 #include <linux/clk/at91_pmc.h>
15 #include <linux/of_address.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>
23 #include <asm/proc-fns.h>
27 void __iomem
*at91_pmc_base
;
28 EXPORT_SYMBOL_GPL(at91_pmc_base
);
30 void at91rm9200_idle(void)
33 * Disable the processor clock. The processor will be automatically
34 * re-enabled by an interrupt or by a reset.
36 at91_pmc_write(AT91_PMC_SCDR
, AT91_PMC_PCK
);
39 void at91sam9_idle(void)
41 at91_pmc_write(AT91_PMC_SCDR
, AT91_PMC_PCK
);
45 int of_at91_get_clk_range(struct device_node
*np
, const char *propname
,
46 struct clk_range
*range
)
51 ret
= of_property_read_u32_index(np
, propname
, 0, &min
);
55 ret
= of_property_read_u32_index(np
, propname
, 1, &max
);
66 EXPORT_SYMBOL_GPL(of_at91_get_clk_range
);
68 static void pmc_irq_mask(struct irq_data
*d
)
70 struct at91_pmc
*pmc
= irq_data_get_irq_chip_data(d
);
72 pmc_write(pmc
, AT91_PMC_IDR
, 1 << d
->hwirq
);
75 static void pmc_irq_unmask(struct irq_data
*d
)
77 struct at91_pmc
*pmc
= irq_data_get_irq_chip_data(d
);
79 pmc_write(pmc
, AT91_PMC_IER
, 1 << d
->hwirq
);
82 static int pmc_irq_set_type(struct irq_data
*d
, unsigned type
)
84 if (type
!= IRQ_TYPE_LEVEL_HIGH
) {
85 pr_warn("PMC: type not supported (support only IRQ_TYPE_LEVEL_HIGH type)\n");
92 static void pmc_irq_suspend(struct irq_data
*d
)
94 struct at91_pmc
*pmc
= irq_data_get_irq_chip_data(d
);
96 pmc
->imr
= pmc_read(pmc
, AT91_PMC_IMR
);
97 pmc_write(pmc
, AT91_PMC_IDR
, pmc
->imr
);
100 static void pmc_irq_resume(struct irq_data
*d
)
102 struct at91_pmc
*pmc
= irq_data_get_irq_chip_data(d
);
104 pmc_write(pmc
, AT91_PMC_IER
, pmc
->imr
);
107 static struct irq_chip pmc_irq
= {
109 .irq_disable
= pmc_irq_mask
,
110 .irq_mask
= pmc_irq_mask
,
111 .irq_unmask
= pmc_irq_unmask
,
112 .irq_set_type
= pmc_irq_set_type
,
113 .irq_suspend
= pmc_irq_suspend
,
114 .irq_resume
= pmc_irq_resume
,
117 static struct lock_class_key pmc_lock_class
;
119 static int pmc_irq_map(struct irq_domain
*h
, unsigned int virq
,
122 struct at91_pmc
*pmc
= h
->host_data
;
124 irq_set_lockdep_class(virq
, &pmc_lock_class
);
126 irq_set_chip_and_handler(virq
, &pmc_irq
,
128 set_irq_flags(virq
, IRQF_VALID
);
129 irq_set_chip_data(virq
, pmc
);
134 static int pmc_irq_domain_xlate(struct irq_domain
*d
,
135 struct device_node
*ctrlr
,
136 const u32
*intspec
, unsigned int intsize
,
137 irq_hw_number_t
*out_hwirq
,
138 unsigned int *out_type
)
140 struct at91_pmc
*pmc
= d
->host_data
;
141 const struct at91_pmc_caps
*caps
= pmc
->caps
;
143 if (WARN_ON(intsize
< 1))
146 *out_hwirq
= intspec
[0];
148 if (!(caps
->available_irqs
& (1 << *out_hwirq
)))
151 *out_type
= IRQ_TYPE_LEVEL_HIGH
;
156 static struct irq_domain_ops pmc_irq_ops
= {
158 .xlate
= pmc_irq_domain_xlate
,
161 static irqreturn_t
pmc_irq_handler(int irq
, void *data
)
163 struct at91_pmc
*pmc
= (struct at91_pmc
*)data
;
167 sr
= pmc_read(pmc
, AT91_PMC_SR
) & pmc_read(pmc
, AT91_PMC_IMR
);
171 for_each_set_bit(n
, &sr
, BITS_PER_LONG
)
172 generic_handle_irq(irq_find_mapping(pmc
->irqdomain
, n
));
177 static const struct at91_pmc_caps at91rm9200_caps
= {
178 .available_irqs
= AT91_PMC_MOSCS
| AT91_PMC_LOCKA
| AT91_PMC_LOCKB
|
179 AT91_PMC_MCKRDY
| AT91_PMC_PCK0RDY
|
180 AT91_PMC_PCK1RDY
| AT91_PMC_PCK2RDY
|
184 static const struct at91_pmc_caps at91sam9260_caps
= {
185 .available_irqs
= AT91_PMC_MOSCS
| AT91_PMC_LOCKA
| AT91_PMC_LOCKB
|
186 AT91_PMC_MCKRDY
| AT91_PMC_PCK0RDY
|
190 static const struct at91_pmc_caps at91sam9g45_caps
= {
191 .available_irqs
= AT91_PMC_MOSCS
| AT91_PMC_LOCKA
| AT91_PMC_MCKRDY
|
192 AT91_PMC_LOCKU
| AT91_PMC_PCK0RDY
|
196 static const struct at91_pmc_caps at91sam9n12_caps
= {
197 .available_irqs
= AT91_PMC_MOSCS
| AT91_PMC_LOCKA
| AT91_PMC_LOCKB
|
198 AT91_PMC_MCKRDY
| AT91_PMC_PCK0RDY
|
199 AT91_PMC_PCK1RDY
| AT91_PMC_MOSCSELS
|
200 AT91_PMC_MOSCRCS
| AT91_PMC_CFDEV
,
203 static const struct at91_pmc_caps at91sam9x5_caps
= {
204 .available_irqs
= AT91_PMC_MOSCS
| AT91_PMC_LOCKA
| AT91_PMC_MCKRDY
|
205 AT91_PMC_LOCKU
| AT91_PMC_PCK0RDY
|
206 AT91_PMC_PCK1RDY
| AT91_PMC_MOSCSELS
|
207 AT91_PMC_MOSCRCS
| AT91_PMC_CFDEV
,
210 static const struct at91_pmc_caps sama5d3_caps
= {
211 .available_irqs
= AT91_PMC_MOSCS
| AT91_PMC_LOCKA
| AT91_PMC_MCKRDY
|
212 AT91_PMC_LOCKU
| AT91_PMC_PCK0RDY
|
213 AT91_PMC_PCK1RDY
| AT91_PMC_PCK2RDY
|
214 AT91_PMC_MOSCSELS
| AT91_PMC_MOSCRCS
|
218 static struct at91_pmc
*__init
at91_pmc_init(struct device_node
*np
,
219 void __iomem
*regbase
, int virq
,
220 const struct at91_pmc_caps
*caps
)
222 struct at91_pmc
*pmc
;
224 if (!regbase
|| !virq
|| !caps
)
227 at91_pmc_base
= regbase
;
229 pmc
= kzalloc(sizeof(*pmc
), GFP_KERNEL
);
233 spin_lock_init(&pmc
->lock
);
234 pmc
->regbase
= regbase
;
238 pmc
->irqdomain
= irq_domain_add_linear(np
, 32, &pmc_irq_ops
, pmc
);
243 pmc_write(pmc
, AT91_PMC_IDR
, 0xffffffff);
244 if (request_irq(pmc
->virq
, pmc_irq_handler
,
245 IRQF_SHARED
| IRQF_COND_SUSPEND
, "pmc", pmc
))
246 goto out_remove_irqdomain
;
250 out_remove_irqdomain
:
251 irq_domain_remove(pmc
->irqdomain
);
258 static const struct of_device_id pmc_clk_ids
[] __initconst
= {
259 /* Slow oscillator */
261 .compatible
= "atmel,at91sam9260-clk-slow",
262 .data
= of_at91sam9260_clk_slow_setup
,
266 .compatible
= "atmel,at91rm9200-clk-main-osc",
267 .data
= of_at91rm9200_clk_main_osc_setup
,
270 .compatible
= "atmel,at91sam9x5-clk-main-rc-osc",
271 .data
= of_at91sam9x5_clk_main_rc_osc_setup
,
274 .compatible
= "atmel,at91rm9200-clk-main",
275 .data
= of_at91rm9200_clk_main_setup
,
278 .compatible
= "atmel,at91sam9x5-clk-main",
279 .data
= of_at91sam9x5_clk_main_setup
,
283 .compatible
= "atmel,at91rm9200-clk-pll",
284 .data
= of_at91rm9200_clk_pll_setup
,
287 .compatible
= "atmel,at91sam9g45-clk-pll",
288 .data
= of_at91sam9g45_clk_pll_setup
,
291 .compatible
= "atmel,at91sam9g20-clk-pllb",
292 .data
= of_at91sam9g20_clk_pllb_setup
,
295 .compatible
= "atmel,sama5d3-clk-pll",
296 .data
= of_sama5d3_clk_pll_setup
,
299 .compatible
= "atmel,at91sam9x5-clk-plldiv",
300 .data
= of_at91sam9x5_clk_plldiv_setup
,
304 .compatible
= "atmel,at91rm9200-clk-master",
305 .data
= of_at91rm9200_clk_master_setup
,
308 .compatible
= "atmel,at91sam9x5-clk-master",
309 .data
= of_at91sam9x5_clk_master_setup
,
313 .compatible
= "atmel,at91rm9200-clk-system",
314 .data
= of_at91rm9200_clk_sys_setup
,
316 /* Peripheral clocks */
318 .compatible
= "atmel,at91rm9200-clk-peripheral",
319 .data
= of_at91rm9200_clk_periph_setup
,
322 .compatible
= "atmel,at91sam9x5-clk-peripheral",
323 .data
= of_at91sam9x5_clk_periph_setup
,
325 /* Programmable clocks */
327 .compatible
= "atmel,at91rm9200-clk-programmable",
328 .data
= of_at91rm9200_clk_prog_setup
,
331 .compatible
= "atmel,at91sam9g45-clk-programmable",
332 .data
= of_at91sam9g45_clk_prog_setup
,
335 .compatible
= "atmel,at91sam9x5-clk-programmable",
336 .data
= of_at91sam9x5_clk_prog_setup
,
339 #if defined(CONFIG_HAVE_AT91_UTMI)
341 .compatible
= "atmel,at91sam9x5-clk-utmi",
342 .data
= of_at91sam9x5_clk_utmi_setup
,
346 #if defined(CONFIG_HAVE_AT91_USB_CLK)
348 .compatible
= "atmel,at91rm9200-clk-usb",
349 .data
= of_at91rm9200_clk_usb_setup
,
352 .compatible
= "atmel,at91sam9x5-clk-usb",
353 .data
= of_at91sam9x5_clk_usb_setup
,
356 .compatible
= "atmel,at91sam9n12-clk-usb",
357 .data
= of_at91sam9n12_clk_usb_setup
,
361 #if defined(CONFIG_HAVE_AT91_SMD)
363 .compatible
= "atmel,at91sam9x5-clk-smd",
364 .data
= of_at91sam9x5_clk_smd_setup
,
367 #if defined(CONFIG_HAVE_AT91_H32MX)
369 .compatible
= "atmel,sama5d4-clk-h32mx",
370 .data
= of_sama5d4_clk_h32mx_setup
,
376 static void __init
of_at91_pmc_setup(struct device_node
*np
,
377 const struct at91_pmc_caps
*caps
)
379 struct at91_pmc
*pmc
;
380 struct device_node
*childnp
;
381 void (*clk_setup
)(struct device_node
*, struct at91_pmc
*);
382 const struct of_device_id
*clk_id
;
383 void __iomem
*regbase
= of_iomap(np
, 0);
389 virq
= irq_of_parse_and_map(np
, 0);
393 pmc
= at91_pmc_init(np
, regbase
, virq
, caps
);
396 for_each_child_of_node(np
, childnp
) {
397 clk_id
= of_match_node(pmc_clk_ids
, childnp
);
400 clk_setup
= clk_id
->data
;
401 clk_setup(childnp
, pmc
);
405 static void __init
of_at91rm9200_pmc_setup(struct device_node
*np
)
407 of_at91_pmc_setup(np
, &at91rm9200_caps
);
409 CLK_OF_DECLARE(at91rm9200_clk_pmc
, "atmel,at91rm9200-pmc",
410 of_at91rm9200_pmc_setup
);
412 static void __init
of_at91sam9260_pmc_setup(struct device_node
*np
)
414 of_at91_pmc_setup(np
, &at91sam9260_caps
);
416 CLK_OF_DECLARE(at91sam9260_clk_pmc
, "atmel,at91sam9260-pmc",
417 of_at91sam9260_pmc_setup
);
419 static void __init
of_at91sam9g45_pmc_setup(struct device_node
*np
)
421 of_at91_pmc_setup(np
, &at91sam9g45_caps
);
423 CLK_OF_DECLARE(at91sam9g45_clk_pmc
, "atmel,at91sam9g45-pmc",
424 of_at91sam9g45_pmc_setup
);
426 static void __init
of_at91sam9n12_pmc_setup(struct device_node
*np
)
428 of_at91_pmc_setup(np
, &at91sam9n12_caps
);
430 CLK_OF_DECLARE(at91sam9n12_clk_pmc
, "atmel,at91sam9n12-pmc",
431 of_at91sam9n12_pmc_setup
);
433 static void __init
of_at91sam9x5_pmc_setup(struct device_node
*np
)
435 of_at91_pmc_setup(np
, &at91sam9x5_caps
);
437 CLK_OF_DECLARE(at91sam9x5_clk_pmc
, "atmel,at91sam9x5-pmc",
438 of_at91sam9x5_pmc_setup
);
440 static void __init
of_sama5d3_pmc_setup(struct device_node
*np
)
442 of_at91_pmc_setup(np
, &sama5d3_caps
);
444 CLK_OF_DECLARE(sama5d3_clk_pmc
, "atmel,sama5d3-pmc",
445 of_sama5d3_pmc_setup
);