1 --- a/arch/mips/Kconfig
2 +++ b/arch/mips/Kconfig
3 @@ -139,6 +139,9 @@ config MACH_DECSTATION
5 otherwise choose R3000.
11 bool "Jazz family of machines"
13 @@ -693,6 +696,7 @@ source "arch/mips/txx9/Kconfig"
14 source "arch/mips/vr41xx/Kconfig"
15 source "arch/mips/cavium-octeon/Kconfig"
16 source "arch/mips/loongson/Kconfig"
17 +source "arch/mips/lantiq/Kconfig"
21 --- a/arch/mips/Makefile
22 +++ b/arch/mips/Makefile
23 @@ -317,6 +317,17 @@ cflags-$(CONFIG_MIPS_COBALT) += -I$(srct
24 load-$(CONFIG_MIPS_COBALT) += 0xffffffff80080000
29 +load-$(CONFIG_LANTIQ) += 0xffffffff80002000
30 +core-$(CONFIG_LANTIQ) += arch/mips/lantiq/
31 +cflags-$(CONFIG_LANTIQ) += -I$(srctree)/arch/mips/include/asm/mach-lantiq
32 +core-$(CONFIG_SOC_LANTIQ_FALCON) += arch/mips/lantiq/falcon/
33 +cflags-$(CONFIG_SOC_LANTIQ_FALCON) += -I$(srctree)/arch/mips/include/asm/mach-lantiq/falcon
34 +core-$(CONFIG_SOC_LANTIQ_XWAY) += arch/mips/lantiq/xway/
35 +cflags-$(CONFIG_SOC_LANTIQ_XWAY) += -I$(srctree)/arch/mips/include/asm/mach-lantiq/xway
40 core-$(CONFIG_MACH_DECSTATION) += arch/mips/dec/
42 +++ b/arch/mips/lantiq/Kconfig
48 + select DMA_NONCOHERENT
52 + select SYS_HAS_CPU_MIPS32_R1
53 + select SYS_HAS_CPU_MIPS32_R2
54 + select SYS_SUPPORTS_BIG_ENDIAN
55 + select SYS_SUPPORTS_32BIT_KERNEL
56 + select SYS_SUPPORTS_MULTITHREADING
57 + select SYS_HAS_EARLY_PRINTK
59 + select ARCH_REQUIRE_GPIOLIB
60 + select SWAP_IO_SPACE
65 + default SOC_LANTIQ_XWAY
67 +#config SOC_LANTIQ_FALCON
71 +config SOC_LANTIQ_XWAY
76 +#source "arch/mips/lantiq/falcon/Kconfig"
77 +source "arch/mips/lantiq/xway/Kconfig"
81 +++ b/arch/mips/lantiq/Makefile
83 +obj-y := irq.o setup.o clk.o prom.o
84 +obj-$(CONFIG_EARLY_PRINTK) += early_printk.o
86 +++ b/arch/mips/lantiq/irq.c
89 + * This program is free software; you can redistribute it and/or modify it
90 + * under the terms of the GNU General Public License version 2 as published
91 + * by the Free Software Foundation.
93 + * Copyright (C) 2010 John Crispin <blogic@openwrt.org>
96 +#include <linux/module.h>
97 +#include <linux/interrupt.h>
99 +#include <asm/bootinfo.h>
100 +#include <asm/irq_cpu.h>
105 +#define LQ_ICU_BASE_ADDR (KSEG1 | 0x1F880200)
107 +#define LQ_ICU_IM0_ISR ((u32 *)(LQ_ICU_BASE_ADDR + 0x0000))
108 +#define LQ_ICU_IM0_IER ((u32 *)(LQ_ICU_BASE_ADDR + 0x0008))
109 +#define LQ_ICU_IM0_IOSR ((u32 *)(LQ_ICU_BASE_ADDR + 0x0010))
110 +#define LQ_ICU_IM0_IRSR ((u32 *)(LQ_ICU_BASE_ADDR + 0x0018))
111 +#define LQ_ICU_IM0_IMR ((u32 *)(LQ_ICU_BASE_ADDR + 0x0020))
113 +#define LQ_ICU_IM1_ISR ((u32 *)(LQ_ICU_BASE_ADDR + 0x0028))
114 +#define LQ_ICU_IM2_ISR ((u32 *)(LQ_ICU_BASE_ADDR + 0x0050))
115 +#define LQ_ICU_IM3_ISR ((u32 *)(LQ_ICU_BASE_ADDR + 0x0078))
116 +#define LQ_ICU_IM4_ISR ((u32 *)(LQ_ICU_BASE_ADDR + 0x00A0))
118 +#define LQ_ICU_OFFSET (LQ_ICU_IM1_ISR - LQ_ICU_IM0_ISR)
121 +lq_disable_irq(unsigned int irq_nr)
123 + u32 *ier = LQ_ICU_IM0_IER;
124 + irq_nr -= INT_NUM_IRQ0;
125 + ier += LQ_ICU_OFFSET * (irq_nr / INT_NUM_IM_OFFSET);
126 + irq_nr %= INT_NUM_IM_OFFSET;
127 + lq_w32(lq_r32(ier) & ~(1 << irq_nr), ier);
129 +EXPORT_SYMBOL(lq_disable_irq);
132 +lq_mask_and_ack_irq(unsigned int irq_nr)
134 + u32 *ier = LQ_ICU_IM0_IER;
135 + u32 *isr = LQ_ICU_IM0_ISR;
136 + irq_nr -= INT_NUM_IRQ0;
137 + ier += LQ_ICU_OFFSET * (irq_nr / INT_NUM_IM_OFFSET);
138 + isr += LQ_ICU_OFFSET * (irq_nr / INT_NUM_IM_OFFSET);
139 + irq_nr %= INT_NUM_IM_OFFSET;
140 + lq_w32(lq_r32(ier) & ~(1 << irq_nr), ier);
141 + lq_w32((1 << irq_nr), isr);
143 +EXPORT_SYMBOL(lq_mask_and_ack_irq);
146 +lq_ack_irq(unsigned int irq_nr)
148 + u32 *isr = LQ_ICU_IM0_ISR;
149 + irq_nr -= INT_NUM_IRQ0;
150 + isr += LQ_ICU_OFFSET * (irq_nr / INT_NUM_IM_OFFSET);
151 + irq_nr %= INT_NUM_IM_OFFSET;
152 + lq_w32((1 << irq_nr), isr);
156 +lq_enable_irq(unsigned int irq_nr)
158 + u32 *ier = LQ_ICU_IM0_IER;
159 + irq_nr -= INT_NUM_IRQ0;
160 + ier += LQ_ICU_OFFSET * (irq_nr / INT_NUM_IM_OFFSET);
161 + irq_nr %= INT_NUM_IM_OFFSET;
162 + lq_w32(lq_r32(ier) | (1 << irq_nr), ier);
164 +EXPORT_SYMBOL(lq_enable_irq);
167 +lq_startup_irq(unsigned int irq)
169 + lq_enable_irq(irq);
174 +lq_end_irq(unsigned int irq)
176 + if (!(irq_desc[irq].status & (IRQ_DISABLED | IRQ_INPROGRESS)))
177 + lq_enable_irq(irq);
180 +static struct irq_chip
183 + .startup = lq_startup_irq,
184 + .enable = lq_enable_irq,
185 + .disable = lq_disable_irq,
186 + .unmask = lq_enable_irq,
188 + .mask = lq_disable_irq,
189 + .mask_ack = lq_mask_and_ack_irq,
194 +lq_hw_irqdispatch(int module)
198 + irq = lq_r32(LQ_ICU_IM0_IOSR + (module * LQ_ICU_OFFSET));
202 + /* silicon bug causes only the msb set to 1 to be valid. all
203 + other bits might be bogus */
205 + do_IRQ((int)irq + INT_NUM_IM0_IRL0 + (INT_NUM_IM_OFFSET * module));
208 +#define DEFINE_HWx_IRQDISPATCH(x) \
209 +static void lq_hw ## x ## _irqdispatch(void)\
211 + lq_hw_irqdispatch(x); \
213 +static void lq_hw5_irqdispatch(void)
215 + do_IRQ(MIPS_CPU_TIMER_IRQ);
217 +DEFINE_HWx_IRQDISPATCH(0)
218 +DEFINE_HWx_IRQDISPATCH(1)
219 +DEFINE_HWx_IRQDISPATCH(2)
220 +DEFINE_HWx_IRQDISPATCH(3)
221 +DEFINE_HWx_IRQDISPATCH(4)
222 +/*DEFINE_HWx_IRQDISPATCH(5)*/
225 +plat_irq_dispatch(void)
227 + unsigned int pending = read_c0_status() & read_c0_cause() & ST0_IM;
230 + if (pending & CAUSEF_IP7)
232 + do_IRQ(MIPS_CPU_TIMER_IRQ);
235 + for (i = 0; i < 5; i++)
237 + if (pending & (CAUSEF_IP2 << i))
239 + lq_hw_irqdispatch(i);
244 + printk(KERN_ALERT "Spurious IRQ: CAUSE=0x%08x\n", read_c0_status());
250 +static struct irqaction
252 + .handler = no_action,
253 + .flags = IRQF_DISABLED,
262 + for (i = 0; i < 5; i++)
263 + lq_w32(0, LQ_ICU_IM0_IER + (i * LQ_ICU_OFFSET));
265 + mips_cpu_irq_init();
267 + for (i = 2; i <= 6; i++)
268 + setup_irq(i, &cascade);
270 + if (cpu_has_vint) {
271 + printk(KERN_INFO "Setting up vectored interrupts\n");
272 + set_vi_handler(2, lq_hw0_irqdispatch);
273 + set_vi_handler(3, lq_hw1_irqdispatch);
274 + set_vi_handler(4, lq_hw2_irqdispatch);
275 + set_vi_handler(5, lq_hw3_irqdispatch);
276 + set_vi_handler(6, lq_hw4_irqdispatch);
277 + set_vi_handler(7, lq_hw5_irqdispatch);
280 + for (i = INT_NUM_IRQ0; i <= (INT_NUM_IRQ0 + (5 * INT_NUM_IM_OFFSET)); i++)
281 + set_irq_chip_and_handler(i, &lq_irq_type,
284 + #if !defined(CONFIG_MIPS_MT_SMP) && !defined(CONFIG_MIPS_MT_SMTC)
285 + set_c0_status(IE_IRQ0 | IE_IRQ1 | IE_IRQ2 |
286 + IE_IRQ3 | IE_IRQ4 | IE_IRQ5);
288 + set_c0_status(IE_SW0 | IE_SW1 | IE_IRQ0 | IE_IRQ1 |
289 + IE_IRQ2 | IE_IRQ3 | IE_IRQ4 | IE_IRQ5);
294 +arch_fixup_c0_irqs(void)
296 + /* FIXME: check for CPUID and only do fix for specific chips/versions */
297 + cp0_compare_irq = CP0_LEGACY_COMPARE_IRQ;
298 + cp0_perfcount_irq = CP0_LEGACY_PERFCNT_IRQ;
301 +++ b/arch/mips/lantiq/setup.c
304 + * This program is free software; you can redistribute it and/or modify it
305 + * under the terms of the GNU General Public License version 2 as published
306 + * by the Free Software Foundation.
308 + * Copyright (C) 2010 John Crispin <blogic@openwrt.org>
311 +#include <linux/kernel.h>
312 +#include <linux/module.h>
313 +#include <linux/io.h>
314 +#include <linux/ioport.h>
317 +#include <lantiq_regs.h>
320 +plat_mem_setup(void)
322 + /* assume 16M as default */
324 + char **envp = (char **) KSEG1ADDR(fw_arg2);
327 + /* make sure to have no "reverse endian" for user mode! */
328 + status = read_c0_status();
329 + status &= (~(1<<25));
330 + write_c0_status(status);
332 + ioport_resource.start = IOPORT_RESOURCE_START;
333 + ioport_resource.end = IOPORT_RESOURCE_END;
334 + iomem_resource.start = IOMEM_RESOURCE_START;
335 + iomem_resource.end = IOMEM_RESOURCE_END;
339 + char *e = (char *)KSEG1ADDR(*envp);
340 + if (!strncmp(e, "memsize=", 8))
343 + memsize = simple_strtoul(e, NULL, 10);
347 + memsize *= 1024 * 1024;
348 + add_memory_region(0x00000000, memsize, BOOT_MEM_RAM);
351 +++ b/arch/mips/lantiq/clk.c
354 + * This program is free software; you can redistribute it and/or modify it
355 + * under the terms of the GNU General Public License version 2 as published
356 + * by the Free Software Foundation.
358 + * Copyright (C) 2010 Thomas Langer, Lantiq Deutschland
359 + * Copyright (C) 2010 John Crispin <blogic@openwrt.org>
362 +#include <linux/io.h>
363 +#include <linux/module.h>
364 +#include <linux/init.h>
365 +#include <linux/kernel.h>
366 +#include <linux/types.h>
367 +#include <linux/clk.h>
368 +#include <linux/err.h>
369 +#include <linux/list.h>
371 +#include <asm/time.h>
372 +#include <asm/irq.h>
373 +#include <asm/div64.h>
376 +#ifdef CONFIG_SOC_LANTIQ_XWAY
380 +extern unsigned long lq_get_cpu_hz(void);
381 +extern unsigned long lq_get_fpi_hz(void);
382 +extern unsigned long lq_get_io_region_clock(void);
386 + unsigned long rate;
387 + unsigned long (*get_rate) (void);
390 +static struct clk *cpu_clk = 0;
391 +static int cpu_clk_cnt = 0;
393 +static unsigned int r4k_offset;
394 +static unsigned int r4k_cur;
396 +static struct clk cpu_clk_generic[] = {
399 + .get_rate = lq_get_cpu_hz,
402 + .get_rate = lq_get_fpi_hz,
405 + .get_rate = lq_get_io_region_clock,
413 + cpu_clk = cpu_clk_generic;
414 + cpu_clk_cnt = ARRAY_SIZE(cpu_clk_generic);
415 + for(i = 0; i < cpu_clk_cnt; i++)
416 + printk("%s: %ld\n", cpu_clk[i].name, clk_get_rate(&cpu_clk[i]));
420 +clk_good(struct clk *clk)
422 + return clk && !IS_ERR(clk);
426 +clk_get_rate(struct clk *clk)
428 + if (unlikely(!clk_good(clk)))
431 + if (clk->rate != 0)
434 + if (clk->get_rate != NULL)
435 + return clk->get_rate();
439 +EXPORT_SYMBOL(clk_get_rate);
442 +clk_get(struct device *dev, const char *id)
445 + for(i = 0; i < cpu_clk_cnt; i++)
446 + if (!strcmp(id, cpu_clk[i].name))
447 + return &cpu_clk[i];
449 + return ERR_PTR(-ENOENT);
451 +EXPORT_SYMBOL(clk_get);
454 +clk_put(struct clk *clk)
458 +EXPORT_SYMBOL(clk_put);
461 +lq_get_counter_resolution(void)
464 + __asm__ __volatile__(
474 + instruction_hazard();
479 +plat_time_init(void)
481 + struct clk *clk = clk_get(0, "cpu");
482 + mips_hpt_frequency = clk_get_rate(clk) / lq_get_counter_resolution();
483 + r4k_cur = (read_c0_count() + r4k_offset);
484 + write_c0_compare(r4k_cur);
486 +#ifdef CONFIG_SOC_LANTIQ_XWAY
487 +#define LQ_GPTU_GPT_CLC ((u32 *)(LQ_GPTU_BASE_ADDR + 0x0000))
488 + lq_pmu_enable(PMU_GPT);
489 + lq_pmu_enable(PMU_FPI);
491 + lq_w32(0x100, LQ_GPTU_GPT_CLC);
495 +++ b/arch/mips/lantiq/prom.c
498 + * This program is free software; you can redistribute it and/or modify it
499 + * under the terms of the GNU General Public License version 2 as published
500 + * by the Free Software Foundation.
502 + * Copyright (C) 2010 John Crispin <blogic@openwrt.org>
505 +#include <linux/module.h>
506 +#include <linux/clk.h>
507 +#include <asm/bootinfo.h>
508 +#include <asm/time.h>
514 +static struct lq_soc_info soc_info;
516 +/* for Multithreading (APRP) on MIPS34K */
517 +unsigned long physical_memsize;
519 +/* all access to the ebu must be locked */
520 +DEFINE_SPINLOCK(ebu_lock);
521 +EXPORT_SYMBOL_GPL(ebu_lock);
523 +extern void clk_init(void);
526 +lq_get_cpu_ver(void)
528 + return soc_info.rev;
530 +EXPORT_SYMBOL(lq_get_cpu_ver);
533 +lq_get_soc_type(void)
535 + return soc_info.type;
537 +EXPORT_SYMBOL(lq_get_soc_type);
540 +get_system_type(void)
542 + return soc_info.sys_type;
546 +prom_free_prom_memory(void)
550 +#ifdef CONFIG_IMAGE_CMDLINE_HACK
551 +extern char __image_cmdline[];
554 +prom_init_image_cmdline(void)
556 + char *p = __image_cmdline;
568 + strlcpy(arcs_cmdline, p, sizeof(arcs_cmdline));
570 + strlcat(arcs_cmdline, " ", sizeof(arcs_cmdline));
571 + strlcat(arcs_cmdline, p, sizeof(arcs_cmdline));
575 +static void __init prom_init_image_cmdline(void) { return; }
579 +prom_init_cmdline(void)
581 + int argc = fw_arg0;
582 + char **argv = (char**)KSEG1ADDR(fw_arg1);
585 + arcs_cmdline[0] = '\0';
587 + for (i = 1; i < argc; i++)
589 + strlcat(arcs_cmdline, (char*)KSEG1ADDR(argv[i]), COMMAND_LINE_SIZE);
591 + strlcat(arcs_cmdline, " ", COMMAND_LINE_SIZE);
594 + if (!*arcs_cmdline)
595 + strcpy(&(arcs_cmdline[0]),
596 + "console=ttyS1,115200 rootfstype=squashfs,jffs2");
597 + prom_init_image_cmdline();
604 + lq_soc_detect(&soc_info);
607 + clk = clk_get(0, "cpu");
608 + snprintf(soc_info.sys_type, LQ_SYS_TYPE_LEN - 1, "%s rev1.%d %ldMhz",
609 + soc_info.name, soc_info.rev, clk_get_rate(clk) / 1000000);
610 + soc_info.sys_type[LQ_SYS_TYPE_LEN - 1] = '\0';
611 + printk("SoC: %s\n", soc_info.sys_type);
613 + prom_init_cmdline();
616 +++ b/arch/mips/lantiq/prom.h
619 + * This program is free software; you can redistribute it and/or modify it
620 + * under the terms of the GNU General Public License version 2 as published
621 + * by the Free Software Foundation.
623 + * Copyright (C) 2010 John Crispin <blogic@openwrt.org>
626 +#ifndef _LQ_PROM_H__
627 +#define _LQ_PROM_H__
629 +#define LQ_SYS_TYPE_LEN 0x100
631 +struct lq_soc_info {
632 + unsigned char *name;
634 + unsigned int partnum;
636 + unsigned char sys_type[LQ_SYS_TYPE_LEN];
639 +void lq_soc_detect(struct lq_soc_info *i);