2 * linux/arch/arm/mach-clps711x/core.c
4 * Core support for the CLPS711x-based machines.
6 * Copyright (C) 2001,2011 Deep Blue Solutions Ltd
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
23 #include <linux/init.h>
24 #include <linux/sizes.h>
25 #include <linux/interrupt.h>
26 #include <linux/irq.h>
27 #include <linux/clk.h>
28 #include <linux/clkdev.h>
29 #include <linux/clockchips.h>
30 #include <linux/clocksource.h>
31 #include <linux/clk-provider.h>
33 #include <asm/exception.h>
34 #include <asm/mach/irq.h>
35 #include <asm/mach/map.h>
36 #include <asm/mach/time.h>
37 #include <asm/sched_clock.h>
38 #include <asm/system_misc.h>
40 #include <mach/hardware.h>
42 static struct clk
*clk_pll
, *clk_bus
, *clk_uart
, *clk_timerl
, *clk_timerh
,
46 * This maps the generic CLPS711x registers
48 static struct map_desc clps711x_io_desc
[] __initdata
= {
50 .virtual = (unsigned long)CLPS711X_VIRT_BASE
,
51 .pfn
= __phys_to_pfn(CLPS711X_PHYS_BASE
),
57 void __init
clps711x_map_io(void)
59 iotable_init(clps711x_io_desc
, ARRAY_SIZE(clps711x_io_desc
));
62 static void int1_mask(struct irq_data
*d
)
66 intmr1
= clps_readl(INTMR1
);
67 intmr1
&= ~(1 << d
->irq
);
68 clps_writel(intmr1
, INTMR1
);
71 static void int1_eoi(struct irq_data
*d
)
74 case IRQ_CSINT
: clps_writel(0, COEOI
); break;
75 case IRQ_TC1OI
: clps_writel(0, TC1EOI
); break;
76 case IRQ_TC2OI
: clps_writel(0, TC2EOI
); break;
77 case IRQ_RTCMI
: clps_writel(0, RTCEOI
); break;
78 case IRQ_TINT
: clps_writel(0, TEOI
); break;
79 case IRQ_UMSINT
: clps_writel(0, UMSEOI
); break;
83 static void int1_unmask(struct irq_data
*d
)
87 intmr1
= clps_readl(INTMR1
);
88 intmr1
|= 1 << d
->irq
;
89 clps_writel(intmr1
, INTMR1
);
92 static struct irq_chip int1_chip
= {
93 .name
= "Interrupt Vector 1",
95 .irq_mask
= int1_mask
,
96 .irq_unmask
= int1_unmask
,
99 static void int2_mask(struct irq_data
*d
)
103 intmr2
= clps_readl(INTMR2
);
104 intmr2
&= ~(1 << (d
->irq
- 16));
105 clps_writel(intmr2
, INTMR2
);
108 static void int2_eoi(struct irq_data
*d
)
111 case IRQ_KBDINT
: clps_writel(0, KBDEOI
); break;
115 static void int2_unmask(struct irq_data
*d
)
119 intmr2
= clps_readl(INTMR2
);
120 intmr2
|= 1 << (d
->irq
- 16);
121 clps_writel(intmr2
, INTMR2
);
124 static struct irq_chip int2_chip
= {
125 .name
= "Interrupt Vector 2",
127 .irq_mask
= int2_mask
,
128 .irq_unmask
= int2_unmask
,
131 static void int3_mask(struct irq_data
*d
)
135 intmr3
= clps_readl(INTMR3
);
136 intmr3
&= ~(1 << (d
->irq
- 32));
137 clps_writel(intmr3
, INTMR3
);
140 static void int3_unmask(struct irq_data
*d
)
144 intmr3
= clps_readl(INTMR3
);
145 intmr3
|= 1 << (d
->irq
- 32);
146 clps_writel(intmr3
, INTMR3
);
149 static struct irq_chip int3_chip
= {
150 .name
= "Interrupt Vector 3",
151 .irq_mask
= int3_mask
,
152 .irq_unmask
= int3_unmask
,
157 struct irq_chip
*chip
;
158 irq_flow_handler_t handle
;
159 } clps711x_irqdescs
[] __initdata
= {
160 { IRQ_CSINT
, &int1_chip
, handle_fasteoi_irq
, },
161 { IRQ_EINT1
, &int1_chip
, handle_level_irq
, },
162 { IRQ_EINT2
, &int1_chip
, handle_level_irq
, },
163 { IRQ_EINT3
, &int1_chip
, handle_level_irq
, },
164 { IRQ_TC1OI
, &int1_chip
, handle_fasteoi_irq
, },
165 { IRQ_TC2OI
, &int1_chip
, handle_fasteoi_irq
, },
166 { IRQ_RTCMI
, &int1_chip
, handle_fasteoi_irq
, },
167 { IRQ_TINT
, &int1_chip
, handle_fasteoi_irq
, },
168 { IRQ_UTXINT1
, &int1_chip
, handle_level_irq
, },
169 { IRQ_URXINT1
, &int1_chip
, handle_level_irq
, },
170 { IRQ_UMSINT
, &int1_chip
, handle_fasteoi_irq
, },
171 { IRQ_SSEOTI
, &int1_chip
, handle_level_irq
, },
172 { IRQ_KBDINT
, &int2_chip
, handle_fasteoi_irq
, },
173 { IRQ_SS2RX
, &int2_chip
, handle_level_irq
, },
174 { IRQ_SS2TX
, &int2_chip
, handle_level_irq
, },
175 { IRQ_UTXINT2
, &int2_chip
, handle_level_irq
, },
176 { IRQ_URXINT2
, &int2_chip
, handle_level_irq
, },
179 void __init
clps711x_init_irq(void)
183 /* Disable interrupts */
184 clps_writel(0, INTMR1
);
185 clps_writel(0, INTMR2
);
186 clps_writel(0, INTMR3
);
188 /* Clear down any pending interrupts */
189 clps_writel(0, BLEOI
);
190 clps_writel(0, MCEOI
);
191 clps_writel(0, COEOI
);
192 clps_writel(0, TC1EOI
);
193 clps_writel(0, TC2EOI
);
194 clps_writel(0, RTCEOI
);
195 clps_writel(0, TEOI
);
196 clps_writel(0, UMSEOI
);
197 clps_writel(0, KBDEOI
);
198 clps_writel(0, SRXEOF
);
199 clps_writel(0xffffffff, DAISR
);
201 for (i
= 0; i
< ARRAY_SIZE(clps711x_irqdescs
); i
++) {
202 irq_set_chip_and_handler(clps711x_irqdescs
[i
].nr
,
203 clps711x_irqdescs
[i
].chip
,
204 clps711x_irqdescs
[i
].handle
);
205 set_irq_flags(clps711x_irqdescs
[i
].nr
,
206 IRQF_VALID
| IRQF_PROBE
);
209 if (IS_ENABLED(CONFIG_FIQ
)) {
211 irq_set_chip_and_handler(IRQ_DAIINT
, &int3_chip
,
213 set_irq_flags(IRQ_DAIINT
,
214 IRQF_VALID
| IRQF_PROBE
| IRQF_NOAUTOEN
);
218 static inline u32
fls16(u32 x
)
240 asmlinkage
void __exception_irq_entry
clps711x_handle_irq(struct pt_regs
*regs
)
244 void __iomem
*base
= CLPS711X_VIRT_BASE
;
246 irqstat
= readw_relaxed(base
+ INTSR1
) &
247 readw_relaxed(base
+ INTMR1
);
249 handle_IRQ(fls16(irqstat
), regs
);
251 irqstat
= readw_relaxed(base
+ INTSR2
) &
252 readw_relaxed(base
+ INTMR2
);
254 handle_IRQ(fls16(irqstat
) + 16, regs
);
262 static u32 notrace
clps711x_sched_clock_read(void)
264 return ~readw_relaxed(CLPS711X_VIRT_BASE
+ TC1D
);
267 static void clps711x_clockevent_set_mode(enum clock_event_mode mode
,
268 struct clock_event_device
*evt
)
270 disable_irq(IRQ_TC2OI
);
273 case CLOCK_EVT_MODE_PERIODIC
:
274 enable_irq(IRQ_TC2OI
);
276 case CLOCK_EVT_MODE_ONESHOT
:
278 case CLOCK_EVT_MODE_SHUTDOWN
:
279 case CLOCK_EVT_MODE_UNUSED
:
280 case CLOCK_EVT_MODE_RESUME
:
281 /* Left event sources disabled, no more interrupts appear */
286 static struct clock_event_device clockevent_clps711x
= {
287 .name
= "clps711x-clockevent",
289 .features
= CLOCK_EVT_FEAT_PERIODIC
,
290 .set_mode
= clps711x_clockevent_set_mode
,
293 static irqreturn_t
clps711x_timer_interrupt(int irq
, void *dev_id
)
295 clockevent_clps711x
.event_handler(&clockevent_clps711x
);
300 static struct irqaction clps711x_timer_irq
= {
301 .name
= "clps711x-timer",
302 .flags
= IRQF_TIMER
| IRQF_IRQPOLL
,
303 .handler
= clps711x_timer_interrupt
,
306 static void add_fixed_clk(struct clk
*clk
, const char *name
, int rate
)
308 clk
= clk_register_fixed_rate(NULL
, name
, NULL
, CLK_IS_ROOT
, rate
);
309 clk_register_clkdev(clk
, name
, NULL
);
312 void __init
clps711x_timer_init(void)
314 int osc
, ext
, pll
, cpu
, bus
, timl
, timh
, uart
, spi
;
320 tmp
= clps_readl(PLLR
) >> 24;
322 pll
= (osc
* tmp
) / 2;
324 pll
= 73728000; /* Default value */
326 tmp
= clps_readl(SYSFLG2
);
327 if (tmp
& SYSFLG2_CKMODE
) {
343 if (tmp
& SYSFLG2_CKMODE
) {
344 tmp
= clps_readl(SYSCON2
);
345 if (tmp
& SYSCON2_OSTB
)
350 timh
= DIV_ROUND_CLOSEST(cpu
, 144);
352 timl
= DIV_ROUND_CLOSEST(timh
, 256);
354 /* All clocks are fixed */
355 add_fixed_clk(clk_pll
, "pll", pll
);
356 add_fixed_clk(clk_bus
, "bus", bus
);
357 add_fixed_clk(clk_uart
, "uart", uart
);
358 add_fixed_clk(clk_timerl
, "timer_lf", timl
);
359 add_fixed_clk(clk_timerh
, "timer_hf", timh
);
360 add_fixed_clk(clk_tint
, "tint", 64);
361 add_fixed_clk(clk_spi
, "spi", spi
);
363 pr_info("CPU frequency set at %i Hz.\n", cpu
);
365 /* Start Timer1 in free running mode (Low frequency) */
366 tmp
= clps_readl(SYSCON1
) & ~(SYSCON1_TC1S
| SYSCON1_TC1M
);
367 clps_writel(tmp
, SYSCON1
);
369 setup_sched_clock(clps711x_sched_clock_read
, 16, timl
);
371 clocksource_mmio_init(CLPS711X_VIRT_BASE
+ TC1D
,
372 "clps711x_clocksource", timl
, 300, 16,
373 clocksource_mmio_readw_down
);
375 /* Set Timer2 prescaler */
376 clps_writew(DIV_ROUND_CLOSEST(timh
, HZ
), TC2D
);
378 /* Start Timer2 in prescale mode (High frequency)*/
379 tmp
= clps_readl(SYSCON1
) | SYSCON1_TC2M
| SYSCON1_TC2S
;
380 clps_writel(tmp
, SYSCON1
);
382 clockevents_config_and_register(&clockevent_clps711x
, timh
, 0, 0);
384 setup_irq(IRQ_TC2OI
, &clps711x_timer_irq
);
387 void clps711x_restart(char mode
, const char *cmd
)
392 static void clps711x_idle(void)
394 clps_writel(1, HALT
);
399 void __init
clps711x_init_early(void)
401 arm_pm_idle
= clps711x_idle
;