1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 *
4 * Copyright (C) 2012 Thomas Langer <thomas.langer@lantiq.com>
5 * Copyright (C) 2012 John Crispin <john@phrozen.org>
6 */
7
8 #include <linux/kernel.h>
9 #include <asm/cacheflush.h>
10 #include <asm/traps.h>
11 #include <asm/io.h>
12
13 #include <lantiq_soc.h>
14
15 #include "../prom.h"
16
17 #define SOC_FALCON "Falcon"
18 #define SOC_FALCON_D "Falcon-D"
19 #define SOC_FALCON_V "Falcon-V"
20 #define SOC_FALCON_M "Falcon-M"
21
22 #define COMP_FALCON "lantiq,falcon"
23
24 #define PART_SHIFT 12
25 #define PART_MASK 0x0FFFF000
26 #define REV_SHIFT 28
27 #define REV_MASK 0xF0000000
28 #define SREV_SHIFT 22
29 #define SREV_MASK 0x03C00000
30 #define TYPE_SHIFT 26
31 #define TYPE_MASK 0x3C000000
32
33 /* reset, nmi and ejtag exception vectors */
34 #define BOOT_REG_BASE (KSEG1 | 0x1F200000)
35 #define BOOT_RVEC (BOOT_REG_BASE | 0x00)
36 #define BOOT_NVEC (BOOT_REG_BASE | 0x04)
37 #define BOOT_EVEC (BOOT_REG_BASE | 0x08)
38
39 void __init ltq_soc_nmi_setup(void)
40 {
41 extern void (*nmi_handler)(void);
42
43 ltq_w32((unsigned long)&nmi_handler, (void *)BOOT_NVEC);
44 }
45
46 void __init ltq_soc_ejtag_setup(void)
47 {
48 extern void (*ejtag_debug_handler)(void);
49
50 ltq_w32((unsigned long)&ejtag_debug_handler, (void *)BOOT_EVEC);
51 }
52
53 void __init ltq_soc_detect(struct ltq_soc_info *i)
54 {
55 u32 type;
56 i->partnum = (ltq_r32(FALCON_CHIPID) & PART_MASK) >> PART_SHIFT;
57 i->rev = (ltq_r32(FALCON_CHIPID) & REV_MASK) >> REV_SHIFT;
58 i->srev = ((ltq_r32(FALCON_CHIPCONF) & SREV_MASK) >> SREV_SHIFT);
59 i->compatible = COMP_FALCON;
60 i->type = SOC_TYPE_FALCON;
61 sprintf(i->rev_type, "%c%d%d", (i->srev & 0x4) ? ('B') : ('A'),
62 i->rev & 0x7, (i->srev & 0x3) + 1);
63
64 switch (i->partnum) {
65 case SOC_ID_FALCON:
66 type = (ltq_r32(FALCON_CHIPTYPE) & TYPE_MASK) >> TYPE_SHIFT;
67 switch (type) {
68 case 0:
69 i->name = SOC_FALCON_D;
70 break;
71 case 1:
72 i->name = SOC_FALCON_V;
73 break;
74 case 2:
75 i->name = SOC_FALCON_M;
76 break;
77 default:
78 i->name = SOC_FALCON;
79 break;
80 }
81 break;
82
83 default:
84 unreachable();
85 break;
86 }
87
88 board_nmi_handler_setup = ltq_soc_nmi_setup;
89 board_ejtag_handler_setup = ltq_soc_ejtag_setup;
90 }
91
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.