diff options
| -rw-r--r-- | arch/microblaze/include/asm/irq.h | 47 | ||||
| -rw-r--r-- | arch/microblaze/kernel/intc.c | 172 | ||||
| -rw-r--r-- | arch/microblaze/kernel/irq.c | 104 | ||||
| -rw-r--r-- | arch/microblaze/kernel/timer.c | 262 |
4 files changed, 585 insertions, 0 deletions
diff --git a/arch/microblaze/include/asm/irq.h b/arch/microblaze/include/asm/irq.h new file mode 100644 index 000000000000..db515deaa720 --- /dev/null +++ b/arch/microblaze/include/asm/irq.h | |||
| @@ -0,0 +1,47 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (C) 2006 Atmark Techno, Inc. | ||
| 3 | * | ||
| 4 | * This file is subject to the terms and conditions of the GNU General Public | ||
| 5 | * License. See the file "COPYING" in the main directory of this archive | ||
| 6 | * for more details. | ||
| 7 | */ | ||
| 8 | |||
| 9 | #ifndef _ASM_MICROBLAZE_IRQ_H | ||
| 10 | #define _ASM_MICROBLAZE_IRQ_H | ||
| 11 | |||
| 12 | #define NR_IRQS 32 | ||
| 13 | |||
| 14 | #include <linux/interrupt.h> | ||
| 15 | |||
| 16 | extern unsigned int nr_irq; | ||
| 17 | |||
| 18 | #define NO_IRQ (-1) | ||
| 19 | |||
| 20 | static inline int irq_canonicalize(int irq) | ||
| 21 | { | ||
| 22 | return irq; | ||
| 23 | } | ||
| 24 | |||
| 25 | struct pt_regs; | ||
| 26 | extern void do_IRQ(struct pt_regs *regs); | ||
| 27 | |||
| 28 | /* irq_of_parse_and_map - Parse and Map an interrupt into linux virq space | ||
| 29 | * @device: Device node of the device whose interrupt is to be mapped | ||
| 30 | * @index: Index of the interrupt to map | ||
| 31 | * | ||
| 32 | * This function is a wrapper that chains of_irq_map_one() and | ||
| 33 | * irq_create_of_mapping() to make things easier to callers | ||
| 34 | */ | ||
| 35 | struct device_node; | ||
| 36 | extern unsigned int irq_of_parse_and_map(struct device_node *dev, int index); | ||
| 37 | |||
| 38 | /** FIXME - not implement | ||
| 39 | * irq_dispose_mapping - Unmap an interrupt | ||
| 40 | * @virq: linux virq number of the interrupt to unmap | ||
| 41 | */ | ||
| 42 | static inline void irq_dispose_mapping(unsigned int virq) | ||
| 43 | { | ||
| 44 | return; | ||
| 45 | } | ||
| 46 | |||
| 47 | #endif /* _ASM_MICROBLAZE_IRQ_H */ | ||
diff --git a/arch/microblaze/kernel/intc.c b/arch/microblaze/kernel/intc.c new file mode 100644 index 000000000000..a69d3e3c2fd4 --- /dev/null +++ b/arch/microblaze/kernel/intc.c | |||
| @@ -0,0 +1,172 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (C) 2007-2009 Michal Simek <monstr@monstr.eu> | ||
| 3 | * Copyright (C) 2007-2009 PetaLogix | ||
| 4 | * Copyright (C) 2006 Atmark Techno, Inc. | ||
| 5 | * | ||
| 6 | * This file is subject to the terms and conditions of the GNU General Public | ||
| 7 | * License. See the file "COPYING" in the main directory of this archive | ||
| 8 | * for more details. | ||
| 9 | */ | ||
| 10 | |||
| 11 | #include <linux/init.h> | ||
| 12 | #include <linux/irq.h> | ||
| 13 | #include <asm/page.h> | ||
| 14 | #include <linux/io.h> | ||
| 15 | |||
| 16 | #include <asm/prom.h> | ||
| 17 | #include <asm/irq.h> | ||
| 18 | |||
| 19 | #ifdef CONFIG_SELFMOD_INTC | ||
| 20 | #include <asm/selfmod.h> | ||
| 21 | #define INTC_BASE BARRIER_BASE_ADDR | ||
| 22 | #else | ||
| 23 | static unsigned int intc_baseaddr; | ||
| 24 | #define INTC_BASE intc_baseaddr | ||
| 25 | #endif | ||
| 26 | |||
| 27 | unsigned int nr_irq; | ||
| 28 | |||
| 29 | /* No one else should require these constants, so define them locally here. */ | ||
| 30 | #define ISR 0x00 /* Interrupt Status Register */ | ||
| 31 | #define IPR 0x04 /* Interrupt Pending Register */ | ||
| 32 | #define IER 0x08 /* Interrupt Enable Register */ | ||
| 33 | #define IAR 0x0c /* Interrupt Acknowledge Register */ | ||
| 34 | #define SIE 0x10 /* Set Interrupt Enable bits */ | ||
| 35 | #define CIE 0x14 /* Clear Interrupt Enable bits */ | ||
| 36 | #define IVR 0x18 /* Interrupt Vector Register */ | ||
| 37 | #define MER 0x1c /* Master Enable Register */ | ||
| 38 | |||
| 39 | #define MER_ME (1<<0) | ||
| 40 | #define MER_HIE (1<<1) | ||
| 41 | |||
| 42 | static void intc_enable_or_unmask(unsigned int irq) | ||
| 43 | { | ||
| 44 | pr_debug("enable_or_unmask: %d\n", irq); | ||
| 45 | out_be32(INTC_BASE + SIE, 1 << irq); | ||
| 46 | } | ||
| 47 | |||
| 48 | static void intc_disable_or_mask(unsigned int irq) | ||
| 49 | { | ||
| 50 | pr_debug("disable: %d\n", irq); | ||
| 51 | out_be32(INTC_BASE + CIE, 1 << irq); | ||
| 52 | } | ||
| 53 | |||
| 54 | static void intc_ack(unsigned int irq) | ||
| 55 | { | ||
| 56 | pr_debug("ack: %d\n", irq); | ||
| 57 | out_be32(INTC_BASE + IAR, 1 << irq); | ||
| 58 | } | ||
| 59 | |||
| 60 | static void intc_mask_ack(unsigned int irq) | ||
| 61 | { | ||
| 62 | unsigned long mask = 1 << irq; | ||
| 63 | pr_debug("disable_and_ack: %d\n", irq); | ||
| 64 | out_be32(INTC_BASE + CIE, mask); | ||
| 65 | out_be32(INTC_BASE + IAR, mask); | ||
| 66 | } | ||
| 67 | |||
| 68 | static void intc_end(unsigned int irq) | ||
| 69 | { | ||
| 70 | unsigned long mask = 1 << irq; | ||
| 71 | pr_debug("end: %d\n", irq); | ||
| 72 | if (!(irq_desc[irq].status & (IRQ_DISABLED | IRQ_INPROGRESS))) { | ||
| 73 | out_be32(INTC_BASE + SIE, mask); | ||
| 74 | /* ack level sensitive intr */ | ||
| 75 | if (irq_desc[irq].status & IRQ_LEVEL) | ||
| 76 | out_be32(INTC_BASE + IAR, mask); | ||
| 77 | } | ||
| 78 | } | ||
| 79 | |||
| 80 | static struct irq_chip intc_dev = { | ||
| 81 | .name = "Xilinx INTC", | ||
| 82 | .unmask = intc_enable_or_unmask, | ||
| 83 | .mask = intc_disable_or_mask, | ||
| 84 | .ack = intc_ack, | ||
| 85 | .mask_ack = intc_mask_ack, | ||
| 86 | .end = intc_end, | ||
| 87 | }; | ||
| 88 | |||
| 89 | unsigned int get_irq(struct pt_regs *regs) | ||
| 90 | { | ||
| 91 | int irq; | ||
| 92 | |||
| 93 | /* | ||
| 94 | * NOTE: This function is the one that needs to be improved in | ||
| 95 | * order to handle multiple interrupt controllers. It currently | ||
| 96 | * is hardcoded to check for interrupts only on the first INTC. | ||
| 97 | */ | ||
| 98 | irq = in_be32(INTC_BASE + IVR); | ||
| 99 | pr_debug("get_irq: %d\n", irq); | ||
| 100 | |||
| 101 | return irq; | ||
| 102 | } | ||
| 103 | |||
| 104 | void __init init_IRQ(void) | ||
| 105 | { | ||
| 106 | u32 i, j, intr_type; | ||
| 107 | struct device_node *intc = NULL; | ||
| 108 | #ifdef CONFIG_SELFMOD_INTC | ||
| 109 | unsigned int intc_baseaddr = 0; | ||
| 110 | static int arr_func[] = { | ||
| 111 | (int)&get_irq, | ||
| 112 | (int)&intc_enable_or_unmask, | ||
| 113 | (int)&intc_disable_or_mask, | ||
| 114 | (int)&intc_mask_ack, | ||
| 115 | (int)&intc_ack, | ||
| 116 | (int)&intc_end, | ||
| 117 | 0 | ||
| 118 | }; | ||
| 119 | #endif | ||
| 120 | static char *intc_list[] = { | ||
| 121 | "xlnx,xps-intc-1.00.a", | ||
| 122 | "xlnx,opb-intc-1.00.c", | ||
| 123 | "xlnx,opb-intc-1.00.b", | ||
| 124 | "xlnx,opb-intc-1.00.a", | ||
| 125 | NULL | ||
| 126 | }; | ||
| 127 | |||
| 128 | for (j = 0; intc_list[j] != NULL; j++) { | ||
| 129 | intc = of_find_compatible_node(NULL, NULL, intc_list[j]); | ||
| 130 | if (intc) | ||
| 131 | break; | ||
| 132 | } | ||
| 133 | |||
| 134 | intc_baseaddr = *(int *) of_get_property(intc, "reg", NULL); | ||
| 135 | intc_baseaddr = (unsigned long) ioremap(intc_baseaddr, PAGE_SIZE); | ||
| 136 | nr_irq = *(int *) of_get_property(intc, "xlnx,num-intr-inputs", NULL); | ||
| 137 | |||
| 138 | intr_type = | ||
| 139 | *(int *) of_get_property(intc, "xlnx,kind-of-intr", NULL); | ||
| 140 | if (intr_type >= (1 << nr_irq)) | ||
| 141 | printk(KERN_INFO " ERROR: Mishmash in king-of-intr param\n"); | ||
| 142 | |||
| 143 | #ifdef CONFIG_SELFMOD_INTC | ||
| 144 | selfmod_function((int *) arr_func, intc_baseaddr); | ||
| 145 | #endif | ||
| 146 | printk(KERN_INFO "%s #0 at 0x%08x, num_irq=%d, edge=0x%x\n", | ||
| 147 | intc_list[j], intc_baseaddr, nr_irq, intr_type); | ||
| 148 | |||
| 149 | /* | ||
| 150 | * Disable all external interrupts until they are | ||
| 151 | * explicity requested. | ||
| 152 | */ | ||
| 153 | out_be32(intc_baseaddr + IER, 0); | ||
| 154 | |||
| 155 | /* Acknowledge any pending interrupts just in case. */ | ||
| 156 | out_be32(intc_baseaddr + IAR, 0xffffffff); | ||
| 157 | |||
| 158 | /* Turn on the Master Enable. */ | ||
| 159 | out_be32(intc_baseaddr + MER, MER_HIE | MER_ME); | ||
| 160 | |||
| 161 | for (i = 0; i < nr_irq; ++i) { | ||
| 162 | if (intr_type & (0x00000001 << i)) { | ||
| 163 | set_irq_chip_and_handler_name(i, &intc_dev, | ||
| 164 | handle_edge_irq, intc_dev.name); | ||
| 165 | irq_desc[i].status &= ~IRQ_LEVEL; | ||
| 166 | } else { | ||
| 167 | set_irq_chip_and_handler_name(i, &intc_dev, | ||
| 168 | handle_level_irq, intc_dev.name); | ||
| 169 | irq_desc[i].status |= IRQ_LEVEL; | ||
| 170 | } | ||
| 171 | } | ||
| 172 | } | ||
diff --git a/arch/microblaze/kernel/irq.c b/arch/microblaze/kernel/irq.c new file mode 100644 index 000000000000..f688ee93e3b9 --- /dev/null +++ b/arch/microblaze/kernel/irq.c | |||
| @@ -0,0 +1,104 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (C) 2007-2009 Michal Simek <monstr@monstr.eu> | ||
| 3 | * Copyright (C) 2007-2009 PetaLogix | ||
| 4 | * Copyright (C) 2006 Atmark Techno, Inc. | ||
| 5 | * | ||
| 6 | * This file is subject to the terms and conditions of the GNU General Public | ||
| 7 | * License. See the file "COPYING" in the main directory of this archive | ||
| 8 | * for more details. | ||
| 9 | */ | ||
| 10 | |||
| 11 | #include <linux/init.h> | ||
| 12 | #include <linux/kernel.h> | ||
| 13 | #include <linux/hardirq.h> | ||
| 14 | #include <linux/interrupt.h> | ||
| 15 | #include <linux/irqflags.h> | ||
| 16 | #include <linux/seq_file.h> | ||
| 17 | #include <linux/kernel_stat.h> | ||
| 18 | #include <linux/irq.h> | ||
| 19 | |||
| 20 | #include <asm/prom.h> | ||
| 21 | |||
| 22 | unsigned int irq_of_parse_and_map(struct device_node *dev, int index) | ||
| 23 | { | ||
| 24 | struct of_irq oirq; | ||
| 25 | |||
| 26 | if (of_irq_map_one(dev, index, &oirq)) | ||
| 27 | return NO_IRQ; | ||
| 28 | |||
| 29 | return oirq.specifier[0]; | ||
| 30 | } | ||
| 31 | EXPORT_SYMBOL_GPL(irq_of_parse_and_map); | ||
| 32 | |||
| 33 | /* | ||
| 34 | * 'what should we do if we get a hw irq event on an illegal vector'. | ||
| 35 | * each architecture has to answer this themselves. | ||
| 36 | */ | ||
| 37 | void ack_bad_irq(unsigned int irq) | ||
| 38 | { | ||
| 39 | printk(KERN_WARNING "unexpected IRQ trap at vector %02x\n", irq); | ||
| 40 | } | ||
| 41 | |||
| 42 | static u32 concurrent_irq; | ||
| 43 | |||
| 44 | void do_IRQ(struct pt_regs *regs) | ||
| 45 | { | ||
| 46 | unsigned int irq; | ||
| 47 | struct pt_regs *old_regs = set_irq_regs(regs); | ||
| 48 | |||
| 49 | irq_enter(); | ||
| 50 | irq = get_irq(regs); | ||
| 51 | next_irq: | ||
| 52 | BUG_ON(irq == -1U); | ||
| 53 | generic_handle_irq(irq); | ||
| 54 | |||
| 55 | irq = get_irq(regs); | ||
| 56 | if (irq != -1U) { | ||
| 57 | pr_debug("next irq: %d\n", irq); | ||
| 58 | ++concurrent_irq; | ||
| 59 | goto next_irq; | ||
| 60 | } | ||
| 61 | |||
| 62 | irq_exit(); | ||
| 63 | set_irq_regs(old_regs); | ||
| 64 | } | ||
| 65 | |||
| 66 | int show_interrupts(struct seq_file *p, void *v) | ||
| 67 | { | ||
| 68 | int i = *(loff_t *) v, j; | ||
| 69 | struct irqaction *action; | ||
| 70 | unsigned long flags; | ||
| 71 | |||
| 72 | if (i == 0) { | ||
| 73 | seq_printf(p, " "); | ||
| 74 | for_each_online_cpu(j) | ||
| 75 | seq_printf(p, "CPU%-8d", j); | ||
| 76 | seq_putc(p, '\n'); | ||
| 77 | } | ||
| 78 | |||
| 79 | if (i < nr_irq) { | ||
| 80 | spin_lock_irqsave(&irq_desc[i].lock, flags); | ||
| 81 | action = irq_desc[i].action; | ||
| 82 | if (!action) | ||
| 83 | goto skip; | ||
| 84 | seq_printf(p, "%3d: ", i); | ||
| 85 | #ifndef CONFIG_SMP | ||
| 86 | seq_printf(p, "%10u ", kstat_irqs(i)); | ||
| 87 | #else | ||
| 88 | for_each_online_cpu(j) | ||
| 89 | seq_printf(p, "%10u ", kstat_cpu(j).irqs[i]); | ||
| 90 | #endif | ||
| 91 | seq_printf(p, " %8s", irq_desc[i].status & | ||
| 92 | IRQ_LEVEL ? "level" : "edge"); | ||
| 93 | seq_printf(p, " %8s", irq_desc[i].chip->name); | ||
| 94 | seq_printf(p, " %s", action->name); | ||
| 95 | |||
| 96 | for (action = action->next; action; action = action->next) | ||
| 97 | seq_printf(p, ", %s", action->name); | ||
| 98 | |||
| 99 | seq_putc(p, '\n'); | ||
| 100 | skip: | ||
| 101 | spin_unlock_irqrestore(&irq_desc[i].lock, flags); | ||
| 102 | } | ||
| 103 | return 0; | ||
| 104 | } | ||
diff --git a/arch/microblaze/kernel/timer.c b/arch/microblaze/kernel/timer.c new file mode 100644 index 000000000000..05a497eefd78 --- /dev/null +++ b/arch/microblaze/kernel/timer.c | |||
| @@ -0,0 +1,262 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (C) 2007-2009 Michal Simek <monstr@monstr.eu> | ||
| 3 | * Copyright (C) 2007-2009 PetaLogix | ||
| 4 | * Copyright (C) 2006 Atmark Techno, Inc. | ||
| 5 | * | ||
| 6 | * This file is subject to the terms and conditions of the GNU General Public | ||
| 7 | * License. See the file "COPYING" in the main directory of this archive | ||
| 8 | * for more details. | ||
| 9 | */ | ||
| 10 | |||
| 11 | #include <linux/init.h> | ||
| 12 | #include <linux/kernel.h> | ||
| 13 | #include <linux/param.h> | ||
| 14 | #include <linux/interrupt.h> | ||
| 15 | #include <linux/profile.h> | ||
| 16 | #include <linux/irq.h> | ||
| 17 | #include <linux/delay.h> | ||
| 18 | #include <linux/sched.h> | ||
| 19 | #include <linux/spinlock.h> | ||
| 20 | #include <linux/err.h> | ||
| 21 | #include <linux/clk.h> | ||
| 22 | #include <linux/clocksource.h> | ||
| 23 | #include <linux/clockchips.h> | ||
| 24 | #include <linux/io.h> | ||
| 25 | #include <asm/cpuinfo.h> | ||
| 26 | #include <asm/setup.h> | ||
| 27 | #include <asm/prom.h> | ||
| 28 | #include <asm/irq.h> | ||
| 29 | #include <asm/system.h> | ||
| 30 | |||
| 31 | #ifdef CONFIG_SELFMOD_TIMER | ||
| 32 | #include <asm/selfmod.h> | ||
| 33 | #define TIMER_BASE BARRIER_BASE_ADDR | ||
| 34 | #else | ||
| 35 | static unsigned int timer_baseaddr; | ||
| 36 | #define TIMER_BASE timer_baseaddr | ||
| 37 | #endif | ||
| 38 | |||
| 39 | #define TCSR0 (0x00) | ||
| 40 | #define TLR0 (0x04) | ||
| 41 | #define TCR0 (0x08) | ||
| 42 | #define TCSR1 (0x10) | ||
| 43 | #define TLR1 (0x14) | ||
| 44 | #define TCR1 (0x18) | ||
| 45 | |||
| 46 | #define TCSR_MDT (1<<0) | ||
| 47 | #define TCSR_UDT (1<<1) | ||
| 48 | #define TCSR_GENT (1<<2) | ||
| 49 | #define TCSR_CAPT (1<<3) | ||
| 50 | #define TCSR_ARHT (1<<4) | ||
| 51 | #define TCSR_LOAD (1<<5) | ||
| 52 | #define TCSR_ENIT (1<<6) | ||
| 53 | #define TCSR_ENT (1<<7) | ||
| 54 | #define TCSR_TINT (1<<8) | ||
| 55 | #define TCSR_PWMA (1<<9) | ||
| 56 | #define TCSR_ENALL (1<<10) | ||
| 57 | |||
| 58 | static inline void microblaze_timer0_stop(void) | ||
| 59 | { | ||
| 60 | out_be32(TIMER_BASE + TCSR0, in_be32(TIMER_BASE + TCSR0) & ~TCSR_ENT); | ||
| 61 | } | ||
| 62 | |||
| 63 | static inline void microblaze_timer0_start_periodic(unsigned long load_val) | ||
| 64 | { | ||
| 65 | if (!load_val) | ||
| 66 | load_val = 1; | ||
| 67 | out_be32(TIMER_BASE + TLR0, load_val); /* loading value to timer reg */ | ||
| 68 | |||
| 69 | /* load the initial value */ | ||
| 70 | out_be32(TIMER_BASE + TCSR0, TCSR_LOAD); | ||
| 71 | |||
| 72 | /* see timer data sheet for detail | ||
| 73 | * !ENALL - don't enable 'em all | ||
| 74 | * !PWMA - disable pwm | ||
| 75 | * TINT - clear interrupt status | ||
| 76 | * ENT- enable timer itself | ||
| 77 | * EINT - enable interrupt | ||
| 78 | * !LOAD - clear the bit to let go | ||
| 79 | * ARHT - auto reload | ||
| 80 | * !CAPT - no external trigger | ||
| 81 | * !GENT - no external signal | ||
| 82 | * UDT - set the timer as down counter | ||
| 83 | * !MDT0 - generate mode | ||
| 84 | */ | ||
| 85 | out_be32(TIMER_BASE + TCSR0, | ||
| 86 | TCSR_TINT|TCSR_ENIT|TCSR_ENT|TCSR_ARHT|TCSR_UDT); | ||
| 87 | } | ||
| 88 | |||
| 89 | static inline void microblaze_timer0_start_oneshot(unsigned long load_val) | ||
| 90 | { | ||
| 91 | if (!load_val) | ||
| 92 | load_val = 1; | ||
| 93 | out_be32(TIMER_BASE + TLR0, load_val); /* loading value to timer reg */ | ||
| 94 | |||
| 95 | /* load the initial value */ | ||
| 96 | out_be32(TIMER_BASE + TCSR0, TCSR_LOAD); | ||
| 97 | |||
| 98 | out_be32(TIMER_BASE + TCSR0, | ||
| 99 | TCSR_TINT|TCSR_ENIT|TCSR_ENT|TCSR_ARHT|TCSR_UDT); | ||
| 100 | } | ||
| 101 | |||
| 102 | static int microblaze_timer_set_next_event(unsigned long delta, | ||
| 103 | struct clock_event_device *dev) | ||
| 104 | { | ||
| 105 | pr_debug("%s: next event, delta %x\n", __func__, (u32)delta); | ||
| 106 | microblaze_timer0_start_oneshot(delta); | ||
| 107 | return 0; | ||
| 108 | } | ||
| 109 | |||
| 110 | static void microblaze_timer_set_mode(enum clock_event_mode mode, | ||
| 111 | struct clock_event_device *evt) | ||
| 112 | { | ||
| 113 | switch (mode) { | ||
| 114 | case CLOCK_EVT_MODE_PERIODIC: | ||
| 115 | printk(KERN_INFO "%s: periodic\n", __func__); | ||
| 116 | microblaze_timer0_start_periodic(cpuinfo.freq_div_hz); | ||
| 117 | break; | ||
| 118 | case CLOCK_EVT_MODE_ONESHOT: | ||
| 119 | printk(KERN_INFO "%s: oneshot\n", __func__); | ||
| 120 | break; | ||
| 121 | case CLOCK_EVT_MODE_UNUSED: | ||
| 122 | printk(KERN_INFO "%s: unused\n", __func__); | ||
| 123 | break; | ||
| 124 | case CLOCK_EVT_MODE_SHUTDOWN: | ||
| 125 | printk(KERN_INFO "%s: shutdown\n", __func__); | ||
| 126 | microblaze_timer0_stop(); | ||
| 127 | break; | ||
| 128 | case CLOCK_EVT_MODE_RESUME: | ||
| 129 | printk(KERN_INFO "%s: resume\n", __func__); | ||
| 130 | break; | ||
| 131 | } | ||
| 132 | } | ||
| 133 | |||
| 134 | static struct clock_event_device clockevent_microblaze_timer = { | ||
| 135 | .name = "microblaze_clockevent", | ||
| 136 | .features = CLOCK_EVT_FEAT_ONESHOT | CLOCK_EVT_FEAT_PERIODIC, | ||
| 137 | .shift = 24, | ||
| 138 | .rating = 300, | ||
| 139 | .set_next_event = microblaze_timer_set_next_event, | ||
| 140 | .set_mode = microblaze_timer_set_mode, | ||
| 141 | }; | ||
| 142 | |||
| 143 | static inline void timer_ack(void) | ||
| 144 | { | ||
| 145 | out_be32(TIMER_BASE + TCSR0, in_be32(TIMER_BASE + TCSR0)); | ||
| 146 | } | ||
| 147 | |||
| 148 | static irqreturn_t timer_interrupt(int irq, void *dev_id) | ||
| 149 | { | ||
| 150 | struct clock_event_device *evt = &clockevent_microblaze_timer; | ||
| 151 | #ifdef CONFIG_HEART_BEAT | ||
| 152 | heartbeat(); | ||
| 153 | #endif | ||
| 154 | timer_ack(); | ||
| 155 | evt->event_handler(evt); | ||
| 156 | return IRQ_HANDLED; | ||
| 157 | } | ||
| 158 | |||
| 159 | static struct irqaction timer_irqaction = { | ||
| 160 | .handler = timer_interrupt, | ||
| 161 | .flags = IRQF_DISABLED | IRQF_TIMER, | ||
| 162 | .name = "timer", | ||
| 163 | .dev_id = &clockevent_microblaze_timer, | ||
| 164 | }; | ||
| 165 | |||
| 166 | static __init void microblaze_clockevent_init(void) | ||
| 167 | { | ||
| 168 | clockevent_microblaze_timer.mult = | ||
| 169 | div_sc(cpuinfo.cpu_clock_freq, NSEC_PER_SEC, | ||
| 170 | clockevent_microblaze_timer.shift); | ||
| 171 | clockevent_microblaze_timer.max_delta_ns = | ||
| 172 | clockevent_delta2ns((u32)~0, &clockevent_microblaze_timer); | ||
| 173 | clockevent_microblaze_timer.min_delta_ns = | ||
| 174 | clockevent_delta2ns(1, &clockevent_microblaze_timer); | ||
| 175 | clockevent_microblaze_timer.cpumask = cpumask_of(0); | ||
| 176 | clockevents_register_device(&clockevent_microblaze_timer); | ||
| 177 | } | ||
| 178 | |||
| 179 | static cycle_t microblaze_read(void) | ||
| 180 | { | ||
| 181 | /* reading actual value of timer 1 */ | ||
| 182 | return (cycle_t) (in_be32(TIMER_BASE + TCR1)); | ||
| 183 | } | ||
| 184 | |||
| 185 | static struct clocksource clocksource_microblaze = { | ||
| 186 | .name = "microblaze_clocksource", | ||
| 187 | .rating = 300, | ||
| 188 | .read = microblaze_read, | ||
| 189 | .mask = CLOCKSOURCE_MASK(32), | ||
| 190 | .shift = 24, /* I can shift it */ | ||
| 191 | .flags = CLOCK_SOURCE_IS_CONTINUOUS, | ||
| 192 | }; | ||
| 193 | |||
| 194 | static int __init microblaze_clocksource_init(void) | ||
| 195 | { | ||
| 196 | clocksource_microblaze.mult = | ||
| 197 | clocksource_hz2mult(cpuinfo.cpu_clock_freq, | ||
| 198 | clocksource_microblaze.shift); | ||
| 199 | if (clocksource_register(&clocksource_microblaze)) | ||
| 200 | panic("failed to register clocksource"); | ||
| 201 | |||
| 202 | /* stop timer1 */ | ||
| 203 | out_be32(TIMER_BASE + TCSR1, in_be32(TIMER_BASE + TCSR1) & ~TCSR_ENT); | ||
| 204 | /* start timer1 - up counting without interrupt */ | ||
| 205 | out_be32(TIMER_BASE + TCSR1, TCSR_TINT|TCSR_ENT|TCSR_ARHT); | ||
| 206 | return 0; | ||
| 207 | } | ||
| 208 | |||
| 209 | void __init time_init(void) | ||
| 210 | { | ||
| 211 | u32 irq, i = 0; | ||
| 212 | u32 timer_num = 1; | ||
| 213 | struct device_node *timer = NULL; | ||
| 214 | #ifdef CONFIG_SELFMOD_TIMER | ||
| 215 | unsigned int timer_baseaddr = 0; | ||
| 216 | int arr_func[] = { | ||
| 217 | (int)µblaze_read, | ||
| 218 | (int)&timer_interrupt, | ||
| 219 | (int)µblaze_clocksource_init, | ||
| 220 | (int)µblaze_timer_set_mode, | ||
| 221 | (int)µblaze_timer_set_next_event, | ||
| 222 | 0 | ||
| 223 | }; | ||
| 224 | #endif | ||
| 225 | char *timer_list[] = { | ||
| 226 | "xlnx,xps-timer-1.00.a", | ||
| 227 | "xlnx,opb-timer-1.00.b", | ||
| 228 | "xlnx,opb-timer-1.00.a", | ||
| 229 | NULL | ||
| 230 | }; | ||
| 231 | |||
| 232 | for (i = 0; timer_list[i] != NULL; i++) { | ||
| 233 | timer = of_find_compatible_node(NULL, NULL, timer_list[i]); | ||
| 234 | if (timer) | ||
| 235 | break; | ||
| 236 | } | ||
| 237 | |||
| 238 | timer_baseaddr = *(int *) of_get_property(timer, "reg", NULL); | ||
| 239 | timer_baseaddr = (unsigned long) ioremap(timer_baseaddr, PAGE_SIZE); | ||
| 240 | irq = *(int *) of_get_property(timer, "interrupts", NULL); | ||
| 241 | timer_num = | ||
| 242 | *(int *) of_get_property(timer, "xlnx,one-timer-only", NULL); | ||
| 243 | if (timer_num) { | ||
| 244 | printk(KERN_EMERG "Please enable two timers in HW\n"); | ||
| 245 | BUG(); | ||
| 246 | } | ||
| 247 | |||
| 248 | #ifdef CONFIG_SELFMOD_TIMER | ||
| 249 | selfmod_function((int *) arr_func, timer_baseaddr); | ||
| 250 | #endif | ||
| 251 | printk(KERN_INFO "%s #0 at 0x%08x, irq=%d\n", | ||
| 252 | timer_list[i], timer_baseaddr, irq); | ||
| 253 | |||
| 254 | cpuinfo.freq_div_hz = cpuinfo.cpu_clock_freq / HZ; | ||
| 255 | |||
| 256 | setup_irq(irq, &timer_irqaction); | ||
| 257 | #ifdef CONFIG_HEART_BEAT | ||
| 258 | setup_heartbeat(); | ||
| 259 | #endif | ||
| 260 | microblaze_clocksource_init(); | ||
| 261 | microblaze_clockevent_init(); | ||
| 262 | } | ||
