1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35#include <linux/kernel.h>
36#include <linux/serial_8250.h>
37#include <linux/pm.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/interrupt.h>
45#include <asm/netlogic/psb-bootinfo.h>
46#include <asm/netlogic/haldefs.h>
47#include <asm/netlogic/common.h>
48
49#include <asm/netlogic/xlr/xlr.h>
50#include <asm/netlogic/xlr/iomap.h>
51#include <asm/netlogic/xlr/pic.h>
52#include <asm/netlogic/xlr/gpio.h>
53#include <asm/netlogic/xlr/fmn.h>
54
55uint64_t nlm_io_base = DEFAULT_NETLOGIC_IO_BASE;
56struct psb_info nlm_prom_info;
57
58
59unsigned int nlm_threads_per_core = 1;
60struct nlm_soc_info nlm_nodes[NLM_NR_NODES];
61cpumask_t nlm_cpumask = CPU_MASK_CPU0;
62
63static void nlm_linux_exit(void)
64{
65 uint64_t gpiobase;
66
67 gpiobase = nlm_mmio_base(NETLOGIC_IO_GPIO_OFFSET);
68
69 nlm_write_reg(gpiobase, GPIO_SWRESET_REG, 1);
70 for ( ; ; )
71 cpu_wait();
72}
73
74void __init plat_mem_setup(void)
75{
76 _machine_restart = (void (*)(char *))nlm_linux_exit;
77 _machine_halt = nlm_linux_exit;
78 pm_power_off = nlm_linux_exit;
79}
80
81const char *get_system_type(void)
82{
83 return "Netlogic XLR/XLS Series";
84}
85
86unsigned int nlm_get_cpu_frequency(void)
87{
88 return (unsigned int)nlm_prom_info.cpu_frequency;
89}
90
91void __init prom_free_prom_memory(void)
92{
93
94}
95
96void nlm_percpu_init(int hwcpuid)
97{
98 if (hwcpuid % 4 == 0)
99 xlr_percpu_fmn_init();
100}
101
102static void __init build_arcs_cmdline(int *argv)
103{
104 int i, remain, len;
105 char *arg;
106
107 remain = sizeof(arcs_cmdline) - 1;
108 arcs_cmdline[0] = '\0';
109 for (i = 0; argv[i] != 0; i++) {
110 arg = (char *)(long)argv[i];
111 len = strlen(arg);
112 if (len + 1 > remain)
113 break;
114 strcat(arcs_cmdline, arg);
115 strcat(arcs_cmdline, " ");
116 remain -= len + 1;
117 }
118
119
120 if ((strstr(arcs_cmdline, "console=")) == NULL) {
121 arg = "console=ttyS0,38400 ";
122 len = strlen(arg);
123 if (len > remain)
124 goto fail;
125 strcat(arcs_cmdline, arg);
126 remain -= len;
127 }
128#ifdef CONFIG_BLK_DEV_INITRD
129 if ((strstr(arcs_cmdline, "rdinit=")) == NULL) {
130 arg = "rdinit=/sbin/init ";
131 len = strlen(arg);
132 if (len > remain)
133 goto fail;
134 strcat(arcs_cmdline, arg);
135 remain -= len;
136 }
137#endif
138 return;
139fail:
140 panic("Cannot add %s, command line too big!", arg);
141}
142
143static void prom_add_memory(void)
144{
145 struct nlm_boot_mem_map *bootm;
146 u64 start, size;
147 u64 pref_backup = 512;
148 int i;
149
150 bootm = (void *)(long)nlm_prom_info.psb_mem_map;
151 for (i = 0; i < bootm->nr_map; i++) {
152 if (bootm->map[i].type != BOOT_MEM_RAM)
153 continue;
154 start = bootm->map[i].addr;
155 size = bootm->map[i].size;
156
157
158 if (i == 0 && start == 0 && size == 0x0c000000)
159 size = 0x0ff00000;
160
161 add_memory_region(start, size - pref_backup, BOOT_MEM_RAM);
162 }
163}
164
165static void nlm_init_node(void)
166{
167 struct nlm_soc_info *nodep;
168
169 nodep = nlm_current_node();
170 nodep->picbase = nlm_mmio_base(NETLOGIC_IO_PIC_OFFSET);
171 nodep->ebase = read_c0_ebase() & MIPS_EBASE_BASE;
172 spin_lock_init(&nodep->piclock);
173}
174
175void __init prom_init(void)
176{
177 int *argv, *envp;
178 struct psb_info *prom_infop;
179 void *reset_vec;
180#ifdef CONFIG_SMP
181 int i;
182#endif
183
184
185 argv = (int *)(long)(int)fw_arg1;
186 envp = (int *)(long)(int)fw_arg2;
187 prom_infop = (struct psb_info *)(long)(int)fw_arg3;
188
189 nlm_prom_info = *prom_infop;
190 nlm_init_node();
191
192
193 reset_vec = (void *)CKSEG1ADDR(RESET_VEC_PHYS);
194 memset(reset_vec, 0, RESET_VEC_SIZE);
195 memcpy(reset_vec, (void *)nlm_reset_entry,
196 (nlm_reset_entry_end - nlm_reset_entry));
197
198 build_arcs_cmdline(argv);
199 prom_add_memory();
200
201#ifdef CONFIG_SMP
202 for (i = 0; i < 32; i++)
203 if (nlm_prom_info.online_cpu_map & (1 << i))
204 cpumask_set_cpu(i, &nlm_cpumask);
205 nlm_wakeup_secondary_cpus();
206 register_smp_ops(&nlm_smp_ops);
207#endif
208 xlr_board_info_setup();
209 xlr_percpu_fmn_init();
210}
211