1 /*
2 * Copyright 2003-2011 NetLogic Microsystems, Inc. (NetLogic). All rights
3 * reserved.
4 *
5 * This software is available to you under a choice of one of two
6 * licenses. You may choose to be licensed under the terms of the GNU
7 * General Public License (GPL) Version 2, available from the file
8 * COPYING in the main directory of this source tree, or the NetLogic
9 * license below:
10 *
11 * Redistribution and use in source and binary forms, with or without
12 * modification, are permitted provided that the following conditions
13 * are met:
14 *
15 * 1. Redistributions of source code must retain the above copyright
16 * notice, this list of conditions and the following disclaimer.
17 * 2. Redistributions in binary form must reproduce the above copyright
18 * notice, this list of conditions and the following disclaimer in
19 * the documentation and/or other materials provided with the
20 * distribution.
21 *
22 * THIS SOFTWARE IS PROVIDED BY NETLOGIC ``AS IS'' AND ANY EXPRESS OR
23 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
24 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25 * ARE DISCLAIMED. IN NO EVENT SHALL NETLOGIC OR CONTRIBUTORS BE LIABLE
26 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
27 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
28 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
29 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
30 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
31 * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
32 * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33 */
34
35 #include <linux/kernel.h>
36 #include <linux/of_fdt.h>
37 #include <linux/memblock.h>
38
39 #include <asm/idle.h>
40 #include <asm/reboot.h>
41 #include <asm/time.h>
42 #include <asm/bootinfo.h>
43
44 #include <asm/netlogic/haldefs.h>
45 #include <asm/netlogic/common.h>
46
47 #include <asm/netlogic/xlp-hal/iomap.h>
48 #include <asm/netlogic/xlp-hal/xlp.h>
49 #include <asm/netlogic/xlp-hal/sys.h>
50
51 uint64_t nlm_io_base;
52 struct nlm_soc_info nlm_nodes[NLM_NR_NODES];
53 cpumask_t nlm_cpumask = CPU_MASK_CPU0;
54 unsigned int nlm_threads_per_core;
55
nlm_linux_exit(void)56 static void nlm_linux_exit(void)
57 {
58 uint64_t sysbase = nlm_get_node(0)->sysbase;
59
60 if (cpu_is_xlp9xx())
61 nlm_write_sys_reg(sysbase, SYS_9XX_CHIP_RESET, 1);
62 else
63 nlm_write_sys_reg(sysbase, SYS_CHIP_RESET, 1);
64 for ( ; ; )
65 cpu_wait();
66 }
67
nlm_fixup_mem(void)68 static void nlm_fixup_mem(void)
69 {
70 const int pref_backup = 512;
71 struct memblock_region *mem;
72
73 for_each_mem_region(mem) {
74 memblock_remove(mem->base + mem->size - pref_backup,
75 pref_backup);
76 }
77 }
78
xlp_init_mem_from_bars(void)79 static void __init xlp_init_mem_from_bars(void)
80 {
81 uint64_t map[16];
82 int i, n;
83
84 n = nlm_get_dram_map(-1, map, ARRAY_SIZE(map)); /* -1 : all nodes */
85 for (i = 0; i < n; i += 2) {
86 /* exclude 0x1000_0000-0x2000_0000, u-boot device */
87 if (map[i] <= 0x10000000 && map[i+1] > 0x10000000)
88 map[i+1] = 0x10000000;
89 if (map[i] > 0x10000000 && map[i] < 0x20000000)
90 map[i] = 0x20000000;
91
92 memblock_add(map[i], map[i+1] - map[i]);
93 }
94 }
95
plat_mem_setup(void)96 void __init plat_mem_setup(void)
97 {
98 #ifdef CONFIG_SMP
99 nlm_wakeup_secondary_cpus();
100
101 /* update TLB size after waking up threads */
102 current_cpu_data.tlbsize = ((read_c0_config6() >> 16) & 0xffff) + 1;
103
104 register_smp_ops(&nlm_smp_ops);
105 #endif
106 _machine_restart = (void (*)(char *))nlm_linux_exit;
107 _machine_halt = nlm_linux_exit;
108 pm_power_off = nlm_linux_exit;
109
110 /* memory and bootargs from DT */
111 xlp_early_init_devtree();
112
113 if (memblock_end_of_DRAM() == 0) {
114 pr_info("Using DRAM BARs for memory map.\n");
115 xlp_init_mem_from_bars();
116 }
117 /* Calculate and setup wired entries for mapped kernel */
118 nlm_fixup_mem();
119 }
120
get_system_type(void)121 const char *get_system_type(void)
122 {
123 switch (read_c0_prid() & PRID_IMP_MASK) {
124 case PRID_IMP_NETLOGIC_XLP9XX:
125 case PRID_IMP_NETLOGIC_XLP5XX:
126 case PRID_IMP_NETLOGIC_XLP2XX:
127 return "Broadcom XLPII Series";
128 default:
129 return "Netlogic XLP Series";
130 }
131 }
132
xlp_mmu_init(void)133 void xlp_mmu_init(void)
134 {
135 u32 conf4;
136
137 if (cpu_is_xlpii()) {
138 /* XLPII series has extended pagesize in config 4 */
139 conf4 = read_c0_config4() & ~0x1f00u;
140 write_c0_config4(conf4 | ((PAGE_SHIFT - 10) / 2 << 8));
141 } else {
142 /* enable extended TLB and Large Fixed TLB */
143 write_c0_config6(read_c0_config6() | 0x24);
144
145 /* set page mask of extended Fixed TLB in config7 */
146 write_c0_config7(PM_DEFAULT_MASK >>
147 (13 + (ffz(PM_DEFAULT_MASK >> 13) / 2)));
148 }
149 }
150
nlm_percpu_init(int hwcpuid)151 void nlm_percpu_init(int hwcpuid)
152 {
153 }
154
prom_init(void)155 void __init prom_init(void)
156 {
157 void *reset_vec;
158
159 nlm_io_base = CKSEG1ADDR(XLP_DEFAULT_IO_BASE);
160 nlm_init_boot_cpu();
161 xlp_mmu_init();
162 nlm_node_init(0);
163 xlp_dt_init((void *)(long)fw_arg0);
164
165 /* Update reset entry point with CPU init code */
166 reset_vec = (void *)CKSEG1ADDR(RESET_VEC_PHYS);
167 memset(reset_vec, 0, RESET_VEC_SIZE);
168 memcpy(reset_vec, (void *)nlm_reset_entry,
169 (nlm_reset_entry_end - nlm_reset_entry));
170
171 #ifdef CONFIG_SMP
172 cpumask_setall(&nlm_cpumask);
173 #endif
174 }
175