1 --- a/arch/mips/Kconfig
2 +++ b/arch/mips/Kconfig
5 otherwise choose R3000.
11 bool "Jazz family of machines"
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"
22 +++ b/arch/mips/lantiq/Kconfig
28 + select DMA_NONCOHERENT
32 + select SYS_HAS_CPU_MIPS32_R1
33 + select SYS_HAS_CPU_MIPS32_R2
34 + select SYS_SUPPORTS_BIG_ENDIAN
35 + select SYS_SUPPORTS_32BIT_KERNEL
36 + select SYS_SUPPORTS_MULTITHREADING
37 + select SYS_HAS_EARLY_PRINTK
39 + select ARCH_REQUIRE_GPIOLIB
40 + select SWAP_IO_SPACE
45 + default SOC_LANTIQ_XWAY
47 +#config SOC_LANTIQ_FALCON
51 +config SOC_LANTIQ_XWAY
56 +#source "arch/mips/lantiq/falcon/Kconfig"
57 +source "arch/mips/lantiq/xway/Kconfig"
61 +++ b/arch/mips/lantiq/Makefile
63 +obj-y := irq.o setup.o clk.o prom.o
64 +obj-$(CONFIG_EARLY_PRINTK) += early_printk.o
65 +obj-$(CONFIG_SOC_LANTIQ_XWAY) += xway/
67 +++ b/arch/mips/lantiq/irq.c
70 + * This program is free software; you can redistribute it and/or modify it
71 + * under the terms of the GNU General Public License version 2 as published
72 + * by the Free Software Foundation.
74 + * Copyright (C) 2010 John Crispin <blogic@openwrt.org>
77 +#include <linux/module.h>
78 +#include <linux/interrupt.h>
80 +#include <asm/bootinfo.h>
81 +#include <asm/irq_cpu.h>
86 +#define LQ_ICU_BASE_ADDR (KSEG1 | 0x1F880200)
88 +#define LQ_ICU_IM0_ISR ((u32 *)(LQ_ICU_BASE_ADDR + 0x0000))
89 +#define LQ_ICU_IM0_IER ((u32 *)(LQ_ICU_BASE_ADDR + 0x0008))
90 +#define LQ_ICU_IM0_IOSR ((u32 *)(LQ_ICU_BASE_ADDR + 0x0010))
91 +#define LQ_ICU_IM0_IRSR ((u32 *)(LQ_ICU_BASE_ADDR + 0x0018))
92 +#define LQ_ICU_IM0_IMR ((u32 *)(LQ_ICU_BASE_ADDR + 0x0020))
94 +#define LQ_ICU_IM1_ISR ((u32 *)(LQ_ICU_BASE_ADDR + 0x0028))
95 +#define LQ_ICU_IM2_ISR ((u32 *)(LQ_ICU_BASE_ADDR + 0x0050))
96 +#define LQ_ICU_IM3_ISR ((u32 *)(LQ_ICU_BASE_ADDR + 0x0078))
97 +#define LQ_ICU_IM4_ISR ((u32 *)(LQ_ICU_BASE_ADDR + 0x00A0))
99 +#define LQ_ICU_OFFSET (LQ_ICU_IM1_ISR - LQ_ICU_IM0_ISR)
101 +#define LQ_EBU_BASE_ADDR 0xBE105300
102 +#define LQ_EBU_PCC_ISTAT ((u32 *)(LQ_EBU_BASE_ADDR + 0x00A0))
105 +lq_disable_irq(unsigned int irq_nr)
107 + u32 *ier = LQ_ICU_IM0_IER;
108 + irq_nr -= INT_NUM_IRQ0;
109 + ier += LQ_ICU_OFFSET * (irq_nr / INT_NUM_IM_OFFSET);
110 + irq_nr %= INT_NUM_IM_OFFSET;
111 + lq_w32(lq_r32(ier) & ~(1 << irq_nr), ier);
113 +EXPORT_SYMBOL(lq_disable_irq);
116 +lq_mask_and_ack_irq(unsigned int irq_nr)
118 + u32 *ier = LQ_ICU_IM0_IER;
119 + u32 *isr = LQ_ICU_IM0_ISR;
120 + irq_nr -= INT_NUM_IRQ0;
121 + ier += LQ_ICU_OFFSET * (irq_nr / INT_NUM_IM_OFFSET);
122 + isr += LQ_ICU_OFFSET * (irq_nr / INT_NUM_IM_OFFSET);
123 + irq_nr %= INT_NUM_IM_OFFSET;
124 + lq_w32(lq_r32(ier) & ~(1 << irq_nr), ier);
125 + lq_w32((1 << irq_nr), isr);
127 +EXPORT_SYMBOL(lq_mask_and_ack_irq);
130 +lq_ack_irq(unsigned int irq_nr)
132 + u32 *isr = LQ_ICU_IM0_ISR;
133 + irq_nr -= INT_NUM_IRQ0;
134 + isr += LQ_ICU_OFFSET * (irq_nr / INT_NUM_IM_OFFSET);
135 + irq_nr %= INT_NUM_IM_OFFSET;
136 + lq_w32((1 << irq_nr), isr);
140 +lq_enable_irq(unsigned int irq_nr)
142 + u32 *ier = LQ_ICU_IM0_IER;
143 + irq_nr -= INT_NUM_IRQ0;
144 + ier += LQ_ICU_OFFSET * (irq_nr / INT_NUM_IM_OFFSET);
145 + irq_nr %= INT_NUM_IM_OFFSET;
146 + lq_w32(lq_r32(ier) | (1 << irq_nr), ier);
148 +EXPORT_SYMBOL(lq_enable_irq);
151 +lq_startup_irq(unsigned int irq)
153 + lq_enable_irq(irq);
158 +lq_end_irq(unsigned int irq)
160 + if (!(irq_desc[irq].status & (IRQ_DISABLED | IRQ_INPROGRESS)))
161 + lq_enable_irq(irq);
164 +static struct irq_chip
167 + .startup = lq_startup_irq,
168 + .enable = lq_enable_irq,
169 + .disable = lq_disable_irq,
170 + .unmask = lq_enable_irq,
172 + .mask = lq_disable_irq,
173 + .mask_ack = lq_mask_and_ack_irq,
178 +lq_hw_irqdispatch(int module)
182 + irq = lq_r32(LQ_ICU_IM0_IOSR + (module * LQ_ICU_OFFSET));
186 + /* silicon bug causes only the msb set to 1 to be valid. all
187 + other bits might be bogus */
189 + do_IRQ((int)irq + INT_NUM_IM0_IRL0 + (INT_NUM_IM_OFFSET * module));
190 + if ((irq == 22) && (module == 0))
191 + lq_w32(lq_r32(LQ_EBU_PCC_ISTAT) | 0x10,
195 +#define DEFINE_HWx_IRQDISPATCH(x) \
196 +static void lq_hw ## x ## _irqdispatch(void)\
198 + lq_hw_irqdispatch(x); \
200 +static void lq_hw5_irqdispatch(void)
202 + do_IRQ(MIPS_CPU_TIMER_IRQ);
204 +DEFINE_HWx_IRQDISPATCH(0)
205 +DEFINE_HWx_IRQDISPATCH(1)
206 +DEFINE_HWx_IRQDISPATCH(2)
207 +DEFINE_HWx_IRQDISPATCH(3)
208 +DEFINE_HWx_IRQDISPATCH(4)
209 +/*DEFINE_HWx_IRQDISPATCH(5)*/
212 +plat_irq_dispatch(void)
214 + unsigned int pending = read_c0_status() & read_c0_cause() & ST0_IM;
217 + if (pending & CAUSEF_IP7)
219 + do_IRQ(MIPS_CPU_TIMER_IRQ);
222 + for (i = 0; i < 5; i++)
224 + if (pending & (CAUSEF_IP2 << i))
226 + lq_hw_irqdispatch(i);
231 + printk(KERN_ALERT "Spurious IRQ: CAUSE=0x%08x\n", read_c0_status());
237 +static struct irqaction
239 + .handler = no_action,
240 + .flags = IRQF_DISABLED,
249 + for (i = 0; i < 5; i++)
250 + lq_w32(0, LQ_ICU_IM0_IER + (i * LQ_ICU_OFFSET));
252 + mips_cpu_irq_init();
254 + for (i = 2; i <= 6; i++)
255 + setup_irq(i, &cascade);
257 + if (cpu_has_vint) {
258 + printk(KERN_INFO "Setting up vectored interrupts\n");
259 + set_vi_handler(2, lq_hw0_irqdispatch);
260 + set_vi_handler(3, lq_hw1_irqdispatch);
261 + set_vi_handler(4, lq_hw2_irqdispatch);
262 + set_vi_handler(5, lq_hw3_irqdispatch);
263 + set_vi_handler(6, lq_hw4_irqdispatch);
264 + set_vi_handler(7, lq_hw5_irqdispatch);
267 + for (i = INT_NUM_IRQ0; i <= (INT_NUM_IRQ0 + (5 * INT_NUM_IM_OFFSET)); i++)
268 + set_irq_chip_and_handler(i, &lq_irq_type,
271 + #if !defined(CONFIG_MIPS_MT_SMP) && !defined(CONFIG_MIPS_MT_SMTC)
272 + set_c0_status(IE_IRQ0 | IE_IRQ1 | IE_IRQ2 |
273 + IE_IRQ3 | IE_IRQ4 | IE_IRQ5);
275 + set_c0_status(IE_SW0 | IE_SW1 | IE_IRQ0 | IE_IRQ1 |
276 + IE_IRQ2 | IE_IRQ3 | IE_IRQ4 | IE_IRQ5);
281 +arch_fixup_c0_irqs(void)
283 + /* FIXME: check for CPUID and only do fix for specific chips/versions */
284 + cp0_compare_irq = CP0_LEGACY_COMPARE_IRQ;
285 + cp0_perfcount_irq = CP0_LEGACY_PERFCNT_IRQ;
288 +++ b/arch/mips/lantiq/setup.c
291 + * This program is free software; you can redistribute it and/or modify it
292 + * under the terms of the GNU General Public License version 2 as published
293 + * by the Free Software Foundation.
295 + * Copyright (C) 2010 John Crispin <blogic@openwrt.org>
298 +#include <linux/kernel.h>
299 +#include <linux/module.h>
300 +#include <linux/io.h>
301 +#include <linux/ioport.h>
304 +#include <lantiq_regs.h>
307 +plat_mem_setup(void)
309 + /* assume 16M as default */
311 + char **envp = (char **) KSEG1ADDR(fw_arg2);
314 + /* make sure to have no "reverse endian" for user mode! */
315 + status = read_c0_status();
316 + status &= (~(1<<25));
317 + write_c0_status(status);
319 + ioport_resource.start = IOPORT_RESOURCE_START;
320 + ioport_resource.end = IOPORT_RESOURCE_END;
321 + iomem_resource.start = IOMEM_RESOURCE_START;
322 + iomem_resource.end = IOMEM_RESOURCE_END;
326 + char *e = (char *)KSEG1ADDR(*envp);
327 + if (!strncmp(e, "memsize=", 8))
330 + memsize = simple_strtoul(e, NULL, 10);
334 + memsize *= 1024 * 1024;
335 + add_memory_region(0x00000000, memsize, BOOT_MEM_RAM);
338 +++ b/arch/mips/lantiq/clk.c
341 + * This program is free software; you can redistribute it and/or modify it
342 + * under the terms of the GNU General Public License version 2 as published
343 + * by the Free Software Foundation.
345 + * Copyright (C) 2010 Thomas Langer, Lantiq Deutschland
346 + * Copyright (C) 2010 John Crispin <blogic@openwrt.org>
349 +#include <linux/io.h>
350 +#include <linux/module.h>
351 +#include <linux/init.h>
352 +#include <linux/kernel.h>
353 +#include <linux/types.h>
354 +#include <linux/clk.h>
355 +#include <linux/err.h>
356 +#include <linux/list.h>
358 +#include <asm/time.h>
359 +#include <asm/irq.h>
360 +#include <asm/div64.h>
363 +#ifdef CONFIG_SOC_LANTIQ_XWAY
367 +extern unsigned long lq_get_cpu_hz(void);
368 +extern unsigned long lq_get_fpi_hz(void);
369 +extern unsigned long lq_get_io_region_clock(void);
373 + unsigned long rate;
374 + unsigned long (*get_rate) (void);
377 +static struct clk *cpu_clk = 0;
378 +static int cpu_clk_cnt = 0;
380 +static unsigned int r4k_offset;
381 +static unsigned int r4k_cur;
383 +static struct clk cpu_clk_generic[] = {
386 + .get_rate = lq_get_cpu_hz,
389 + .get_rate = lq_get_fpi_hz,
392 + .get_rate = lq_get_io_region_clock,
400 + cpu_clk = cpu_clk_generic;
401 + cpu_clk_cnt = ARRAY_SIZE(cpu_clk_generic);
402 + for(i = 0; i < cpu_clk_cnt; i++)
403 + printk("%s: %ld\n", cpu_clk[i].name, clk_get_rate(&cpu_clk[i]));
407 +clk_good(struct clk *clk)
409 + return clk && !IS_ERR(clk);
413 +clk_get_rate(struct clk *clk)
415 + if (unlikely(!clk_good(clk)))
418 + if (clk->rate != 0)
421 + if (clk->get_rate != NULL)
422 + return clk->get_rate();
426 +EXPORT_SYMBOL(clk_get_rate);
429 +clk_get(struct device *dev, const char *id)
432 + for(i = 0; i < cpu_clk_cnt; i++)
433 + if (!strcmp(id, cpu_clk[i].name))
434 + return &cpu_clk[i];
436 + return ERR_PTR(-ENOENT);
438 +EXPORT_SYMBOL(clk_get);
441 +clk_put(struct clk *clk)
445 +EXPORT_SYMBOL(clk_put);
448 +lq_get_counter_resolution(void)
451 + __asm__ __volatile__(
461 + instruction_hazard();
466 +plat_time_init(void)
468 + struct clk *clk = clk_get(0, "cpu");
469 + mips_hpt_frequency = clk_get_rate(clk) / lq_get_counter_resolution();
470 + r4k_cur = (read_c0_count() + r4k_offset);
471 + write_c0_compare(r4k_cur);
473 +#ifdef CONFIG_SOC_LANTIQ_XWAY
474 +#define LQ_GPTU_GPT_CLC ((u32 *)(LQ_GPTU_BASE_ADDR + 0x0000))
475 + lq_pmu_enable(PMU_GPT);
476 + lq_pmu_enable(PMU_FPI);
478 + lq_w32(0x100, LQ_GPTU_GPT_CLC);
482 +++ b/arch/mips/lantiq/prom.c
485 + * This program is free software; you can redistribute it and/or modify it
486 + * under the terms of the GNU General Public License version 2 as published
487 + * by the Free Software Foundation.
489 + * Copyright (C) 2010 John Crispin <blogic@openwrt.org>
492 +#include <linux/module.h>
493 +#include <linux/clk.h>
494 +#include <asm/bootinfo.h>
495 +#include <asm/time.h>
501 +static struct lq_soc_info soc_info;
503 +/* for Multithreading (APRP) on MIPS34K */
504 +unsigned long physical_memsize;
506 +/* all access to the ebu must be locked */
507 +DEFINE_SPINLOCK(ebu_lock);
508 +EXPORT_SYMBOL_GPL(ebu_lock);
510 +extern void clk_init(void);
513 +lq_get_cpu_ver(void)
515 + return soc_info.rev;
517 +EXPORT_SYMBOL(lq_get_cpu_ver);
520 +lq_get_soc_type(void)
522 + return soc_info.type;
524 +EXPORT_SYMBOL(lq_get_soc_type);
527 +get_system_type(void)
529 + return soc_info.sys_type;
533 +prom_free_prom_memory(void)
537 +#ifdef CONFIG_IMAGE_CMDLINE_HACK
538 +extern char __image_cmdline[];
541 +prom_init_image_cmdline(void)
543 + char *p = __image_cmdline;
555 + strlcpy(arcs_cmdline, p, sizeof(arcs_cmdline));
557 + strlcat(arcs_cmdline, " ", sizeof(arcs_cmdline));
558 + strlcat(arcs_cmdline, p, sizeof(arcs_cmdline));
562 +static void __init prom_init_image_cmdline(void) { return; }
566 +prom_init_cmdline(void)
568 + int argc = fw_arg0;
569 + char **argv = (char**)KSEG1ADDR(fw_arg1);
572 + arcs_cmdline[0] = '\0';
574 + for (i = 1; i < argc; i++)
576 + strlcat(arcs_cmdline, (char*)KSEG1ADDR(argv[i]), COMMAND_LINE_SIZE);
578 + strlcat(arcs_cmdline, " ", COMMAND_LINE_SIZE);
581 + if (!*arcs_cmdline)
582 + strcpy(&(arcs_cmdline[0]),
583 + "console=ttyS1,115200 rootfstype=squashfs,jffs2");
584 + prom_init_image_cmdline();
591 + lq_soc_detect(&soc_info);
594 + clk = clk_get(0, "cpu");
595 + snprintf(soc_info.sys_type, LQ_SYS_TYPE_LEN - 1, "%s rev1.%d %ldMhz",
596 + soc_info.name, soc_info.rev, clk_get_rate(clk) / 1000000);
597 + soc_info.sys_type[LQ_SYS_TYPE_LEN - 1] = '\0';
598 + printk("SoC: %s\n", soc_info.sys_type);
600 + prom_init_cmdline();
603 +++ b/arch/mips/lantiq/prom.h
606 + * This program is free software; you can redistribute it and/or modify it
607 + * under the terms of the GNU General Public License version 2 as published
608 + * by the Free Software Foundation.
610 + * Copyright (C) 2010 John Crispin <blogic@openwrt.org>
613 +#ifndef _LQ_PROM_H__
614 +#define _LQ_PROM_H__
616 +#define LQ_SYS_TYPE_LEN 0x100
618 +struct lq_soc_info {
619 + unsigned char *name;
621 + unsigned int partnum;
623 + unsigned char sys_type[LQ_SYS_TYPE_LEN];
626 +void lq_soc_detect(struct lq_soc_info *i);
629 --- a/arch/mips/Kbuild.platforms
630 +++ b/arch/mips/Kbuild.platforms
636 platforms += loongson
638 platforms += mti-malta
640 +++ b/arch/mips/lantiq/Platform
646 +platform-$(CONFIG_LANTIQ) += lantiq/
647 +cflags-$(CONFIG_LANTIQ) += -I$(srctree)/arch/mips/include/asm/mach-lantiq
648 +load-$(CONFIG_LANTIQ) = 0xffffffff80002000
649 +cflags-$(CONFIG_SOC_LANTIQ_XWAY) += -I$(srctree)/arch/mips/include/asm/mach-lantiq/xway