Commit | Line | Data |
---|---|---|
5cbc3073 DM |
1 | /* mdesc.c: Sun4V machine description handling. |
2 | * | |
3 | * Copyright (C) 2007 David S. Miller <davem@davemloft.net> | |
4 | */ | |
5 | #include <linux/kernel.h> | |
6 | #include <linux/types.h> | |
7 | #include <linux/bootmem.h> | |
8 | #include <linux/log2.h> | |
43fdf274 DM |
9 | #include <linux/list.h> |
10 | #include <linux/slab.h> | |
5cbc3073 DM |
11 | |
12 | #include <asm/hypervisor.h> | |
13 | #include <asm/mdesc.h> | |
14 | #include <asm/prom.h> | |
15 | #include <asm/oplib.h> | |
16 | #include <asm/smp.h> | |
17 | ||
18 | /* Unlike the OBP device tree, the machine description is a full-on | |
19 | * DAG. An arbitrary number of ARCs are possible from one | |
20 | * node to other nodes and thus we can't use the OBP device_node | |
21 | * data structure to represent these nodes inside of the kernel. | |
22 | * | |
23 | * Actually, it isn't even a DAG, because there are back pointers | |
24 | * which create cycles in the graph. | |
25 | * | |
26 | * mdesc_hdr and mdesc_elem describe the layout of the data structure | |
27 | * we get from the Hypervisor. | |
28 | */ | |
29 | struct mdesc_hdr { | |
30 | u32 version; /* Transport version */ | |
31 | u32 node_sz; /* node block size */ | |
32 | u32 name_sz; /* name block size */ | |
33 | u32 data_sz; /* data block size */ | |
43fdf274 | 34 | } __attribute__((aligned(16))); |
5cbc3073 DM |
35 | |
36 | struct mdesc_elem { | |
37 | u8 tag; | |
38 | #define MD_LIST_END 0x00 | |
39 | #define MD_NODE 0x4e | |
40 | #define MD_NODE_END 0x45 | |
41 | #define MD_NOOP 0x20 | |
42 | #define MD_PROP_ARC 0x61 | |
43 | #define MD_PROP_VAL 0x76 | |
44 | #define MD_PROP_STR 0x73 | |
45 | #define MD_PROP_DATA 0x64 | |
46 | u8 name_len; | |
47 | u16 resv; | |
48 | u32 name_offset; | |
49 | union { | |
50 | struct { | |
51 | u32 data_len; | |
52 | u32 data_offset; | |
53 | } data; | |
54 | u64 val; | |
55 | } d; | |
56 | }; | |
57 | ||
43fdf274 DM |
58 | struct mdesc_mem_ops { |
59 | struct mdesc_handle *(*alloc)(unsigned int mdesc_size); | |
60 | void (*free)(struct mdesc_handle *handle); | |
61 | }; | |
5cbc3073 | 62 | |
43fdf274 DM |
63 | struct mdesc_handle { |
64 | struct list_head list; | |
65 | struct mdesc_mem_ops *mops; | |
66 | void *self_base; | |
67 | atomic_t refcnt; | |
68 | unsigned int handle_size; | |
69 | struct mdesc_hdr mdesc; | |
70 | }; | |
5cbc3073 | 71 | |
43fdf274 DM |
72 | static void mdesc_handle_init(struct mdesc_handle *hp, |
73 | unsigned int handle_size, | |
74 | void *base) | |
5cbc3073 | 75 | { |
43fdf274 DM |
76 | BUG_ON(((unsigned long)&hp->mdesc) & (16UL - 1)); |
77 | ||
78 | memset(hp, 0, handle_size); | |
79 | INIT_LIST_HEAD(&hp->list); | |
80 | hp->self_base = base; | |
81 | atomic_set(&hp->refcnt, 1); | |
82 | hp->handle_size = handle_size; | |
5cbc3073 DM |
83 | } |
84 | ||
43fdf274 | 85 | static struct mdesc_handle *mdesc_bootmem_alloc(unsigned int mdesc_size) |
5cbc3073 | 86 | { |
43fdf274 DM |
87 | struct mdesc_handle *hp; |
88 | unsigned int handle_size, alloc_size; | |
5cbc3073 | 89 | |
43fdf274 DM |
90 | handle_size = (sizeof(struct mdesc_handle) - |
91 | sizeof(struct mdesc_hdr) + | |
92 | mdesc_size); | |
93 | alloc_size = PAGE_ALIGN(handle_size); | |
5cbc3073 | 94 | |
43fdf274 DM |
95 | hp = __alloc_bootmem(alloc_size, PAGE_SIZE, 0UL); |
96 | if (hp) | |
97 | mdesc_handle_init(hp, handle_size, hp); | |
98 | ||
99 | return hp; | |
5cbc3073 DM |
100 | } |
101 | ||
43fdf274 | 102 | static void mdesc_bootmem_free(struct mdesc_handle *hp) |
5cbc3073 | 103 | { |
43fdf274 DM |
104 | unsigned int alloc_size, handle_size = hp->handle_size; |
105 | unsigned long start, end; | |
5cbc3073 | 106 | |
43fdf274 DM |
107 | BUG_ON(atomic_read(&hp->refcnt) != 0); |
108 | BUG_ON(!list_empty(&hp->list)); | |
5cbc3073 | 109 | |
43fdf274 DM |
110 | alloc_size = PAGE_ALIGN(handle_size); |
111 | ||
112 | start = (unsigned long) hp; | |
113 | end = start + alloc_size; | |
114 | ||
115 | while (start < end) { | |
116 | struct page *p; | |
117 | ||
118 | p = virt_to_page(start); | |
119 | ClearPageReserved(p); | |
120 | __free_page(p); | |
121 | start += PAGE_SIZE; | |
5cbc3073 | 122 | } |
5cbc3073 DM |
123 | } |
124 | ||
43fdf274 DM |
125 | static struct mdesc_mem_ops bootmem_mdesc_memops = { |
126 | .alloc = mdesc_bootmem_alloc, | |
127 | .free = mdesc_bootmem_free, | |
128 | }; | |
129 | ||
130 | static struct mdesc_handle *mdesc_kmalloc(unsigned int mdesc_size) | |
5cbc3073 | 131 | { |
43fdf274 DM |
132 | unsigned int handle_size; |
133 | void *base; | |
5cbc3073 | 134 | |
43fdf274 DM |
135 | handle_size = (sizeof(struct mdesc_handle) - |
136 | sizeof(struct mdesc_hdr) + | |
137 | mdesc_size); | |
138 | ||
139 | base = kmalloc(handle_size + 15, GFP_KERNEL); | |
140 | if (base) { | |
141 | struct mdesc_handle *hp; | |
142 | unsigned long addr; | |
143 | ||
144 | addr = (unsigned long)base; | |
145 | addr = (addr + 15UL) & ~15UL; | |
146 | hp = (struct mdesc_handle *) addr; | |
147 | ||
148 | mdesc_handle_init(hp, handle_size, base); | |
149 | return hp; | |
5cbc3073 | 150 | } |
43fdf274 DM |
151 | |
152 | return NULL; | |
5cbc3073 | 153 | } |
5cbc3073 | 154 | |
43fdf274 | 155 | static void mdesc_kfree(struct mdesc_handle *hp) |
5cbc3073 | 156 | { |
43fdf274 DM |
157 | BUG_ON(atomic_read(&hp->refcnt) != 0); |
158 | BUG_ON(!list_empty(&hp->list)); | |
159 | ||
160 | kfree(hp->self_base); | |
5cbc3073 | 161 | } |
5cbc3073 | 162 | |
43fdf274 DM |
163 | static struct mdesc_mem_ops kmalloc_mdesc_memops = { |
164 | .alloc = mdesc_kmalloc, | |
165 | .free = mdesc_kfree, | |
166 | }; | |
167 | ||
168 | static struct mdesc_handle *mdesc_alloc(unsigned int mdesc_size, | |
169 | struct mdesc_mem_ops *mops) | |
5cbc3073 | 170 | { |
43fdf274 | 171 | struct mdesc_handle *hp = mops->alloc(mdesc_size); |
5cbc3073 | 172 | |
43fdf274 DM |
173 | if (hp) |
174 | hp->mops = mops; | |
5cbc3073 | 175 | |
43fdf274 DM |
176 | return hp; |
177 | } | |
5cbc3073 | 178 | |
43fdf274 | 179 | static void mdesc_free(struct mdesc_handle *hp) |
5cbc3073 | 180 | { |
43fdf274 DM |
181 | hp->mops->free(hp); |
182 | } | |
5cbc3073 | 183 | |
43fdf274 DM |
184 | static struct mdesc_handle *cur_mdesc; |
185 | static LIST_HEAD(mdesc_zombie_list); | |
186 | static DEFINE_SPINLOCK(mdesc_lock); | |
5cbc3073 | 187 | |
43fdf274 DM |
188 | struct mdesc_handle *mdesc_grab(void) |
189 | { | |
190 | struct mdesc_handle *hp; | |
191 | unsigned long flags; | |
5cbc3073 | 192 | |
43fdf274 DM |
193 | spin_lock_irqsave(&mdesc_lock, flags); |
194 | hp = cur_mdesc; | |
195 | if (hp) | |
196 | atomic_inc(&hp->refcnt); | |
197 | spin_unlock_irqrestore(&mdesc_lock, flags); | |
5cbc3073 | 198 | |
43fdf274 | 199 | return hp; |
5cbc3073 | 200 | } |
43fdf274 | 201 | EXPORT_SYMBOL(mdesc_grab); |
5cbc3073 | 202 | |
43fdf274 | 203 | void mdesc_release(struct mdesc_handle *hp) |
5cbc3073 | 204 | { |
43fdf274 | 205 | unsigned long flags; |
5cbc3073 | 206 | |
43fdf274 DM |
207 | spin_lock_irqsave(&mdesc_lock, flags); |
208 | if (atomic_dec_and_test(&hp->refcnt)) { | |
209 | list_del_init(&hp->list); | |
210 | hp->mops->free(hp); | |
5cbc3073 | 211 | } |
43fdf274 | 212 | spin_unlock_irqrestore(&mdesc_lock, flags); |
5cbc3073 | 213 | } |
43fdf274 | 214 | EXPORT_SYMBOL(mdesc_release); |
5cbc3073 | 215 | |
43fdf274 | 216 | static void do_mdesc_update(struct work_struct *work) |
5cbc3073 | 217 | { |
43fdf274 DM |
218 | unsigned long len, real_len, status; |
219 | struct mdesc_handle *hp, *orig_hp; | |
220 | unsigned long flags; | |
221 | ||
222 | (void) sun4v_mach_desc(0UL, 0UL, &len); | |
223 | ||
224 | hp = mdesc_alloc(len, &kmalloc_mdesc_memops); | |
225 | if (!hp) { | |
226 | printk(KERN_ERR "MD: mdesc alloc fails\n"); | |
227 | return; | |
228 | } | |
229 | ||
230 | status = sun4v_mach_desc(__pa(&hp->mdesc), len, &real_len); | |
231 | if (status != HV_EOK || real_len > len) { | |
232 | printk(KERN_ERR "MD: mdesc reread fails with %lu\n", | |
233 | status); | |
234 | atomic_dec(&hp->refcnt); | |
235 | mdesc_free(hp); | |
236 | return; | |
237 | } | |
5cbc3073 | 238 | |
43fdf274 DM |
239 | spin_lock_irqsave(&mdesc_lock, flags); |
240 | orig_hp = cur_mdesc; | |
241 | cur_mdesc = hp; | |
5cbc3073 | 242 | |
43fdf274 DM |
243 | if (atomic_dec_and_test(&orig_hp->refcnt)) |
244 | mdesc_free(orig_hp); | |
245 | else | |
246 | list_add(&orig_hp->list, &mdesc_zombie_list); | |
247 | spin_unlock_irqrestore(&mdesc_lock, flags); | |
5cbc3073 DM |
248 | } |
249 | ||
43fdf274 DM |
250 | static DECLARE_WORK(mdesc_update_work, do_mdesc_update); |
251 | ||
252 | void mdesc_update(void) | |
253 | { | |
254 | schedule_work(&mdesc_update_work); | |
255 | } | |
256 | ||
257 | static struct mdesc_elem *node_block(struct mdesc_hdr *mdesc) | |
5cbc3073 DM |
258 | { |
259 | return (struct mdesc_elem *) (mdesc + 1); | |
260 | } | |
261 | ||
43fdf274 | 262 | static void *name_block(struct mdesc_hdr *mdesc) |
5cbc3073 DM |
263 | { |
264 | return ((void *) node_block(mdesc)) + mdesc->node_sz; | |
265 | } | |
266 | ||
43fdf274 | 267 | static void *data_block(struct mdesc_hdr *mdesc) |
5cbc3073 DM |
268 | { |
269 | return ((void *) name_block(mdesc)) + mdesc->name_sz; | |
270 | } | |
271 | ||
43fdf274 DM |
272 | u64 mdesc_node_by_name(struct mdesc_handle *hp, |
273 | u64 from_node, const char *name) | |
5cbc3073 | 274 | { |
43fdf274 DM |
275 | struct mdesc_elem *ep = node_block(&hp->mdesc); |
276 | const char *names = name_block(&hp->mdesc); | |
277 | u64 last_node = hp->mdesc.node_sz / 16; | |
278 | u64 ret; | |
279 | ||
280 | if (from_node == MDESC_NODE_NULL) | |
281 | from_node = 0; | |
282 | ||
283 | if (from_node >= last_node) | |
284 | return MDESC_NODE_NULL; | |
285 | ||
286 | ret = ep[from_node].d.val; | |
287 | while (ret < last_node) { | |
288 | if (ep[ret].tag != MD_NODE) | |
289 | return MDESC_NODE_NULL; | |
290 | if (!strcmp(names + ep[ret].name_offset, name)) | |
291 | break; | |
292 | ret = ep[ret].d.val; | |
293 | } | |
294 | if (ret >= last_node) | |
295 | ret = MDESC_NODE_NULL; | |
296 | return ret; | |
297 | } | |
298 | EXPORT_SYMBOL(mdesc_node_by_name); | |
5cbc3073 | 299 | |
43fdf274 DM |
300 | const void *mdesc_get_property(struct mdesc_handle *hp, u64 node, |
301 | const char *name, int *lenp) | |
302 | { | |
303 | const char *names = name_block(&hp->mdesc); | |
304 | u64 last_node = hp->mdesc.node_sz / 16; | |
305 | void *data = data_block(&hp->mdesc); | |
306 | struct mdesc_elem *ep; | |
5cbc3073 | 307 | |
43fdf274 DM |
308 | if (node == MDESC_NODE_NULL || node >= last_node) |
309 | return NULL; | |
5cbc3073 | 310 | |
43fdf274 DM |
311 | ep = node_block(&hp->mdesc) + node; |
312 | ep++; | |
313 | for (; ep->tag != MD_NODE_END; ep++) { | |
314 | void *val = NULL; | |
315 | int len = 0; | |
316 | ||
317 | switch (ep->tag) { | |
318 | case MD_PROP_VAL: | |
319 | val = &ep->d.val; | |
320 | len = 8; | |
5cbc3073 DM |
321 | break; |
322 | ||
43fdf274 DM |
323 | case MD_PROP_STR: |
324 | case MD_PROP_DATA: | |
325 | val = data + ep->d.data.data_offset; | |
326 | len = ep->d.data.data_len; | |
327 | break; | |
5cbc3073 | 328 | |
43fdf274 | 329 | default: |
5cbc3073 DM |
330 | break; |
331 | } | |
43fdf274 DM |
332 | if (!val) |
333 | continue; | |
5cbc3073 | 334 | |
43fdf274 DM |
335 | if (!strcmp(names + ep->name_offset, name)) { |
336 | if (lenp) | |
337 | *lenp = len; | |
338 | return val; | |
339 | } | |
5cbc3073 DM |
340 | } |
341 | ||
43fdf274 DM |
342 | return NULL; |
343 | } | |
344 | EXPORT_SYMBOL(mdesc_get_property); | |
5cbc3073 | 345 | |
43fdf274 DM |
346 | u64 mdesc_next_arc(struct mdesc_handle *hp, u64 from, const char *arc_type) |
347 | { | |
348 | struct mdesc_elem *ep, *base = node_block(&hp->mdesc); | |
349 | const char *names = name_block(&hp->mdesc); | |
350 | u64 last_node = hp->mdesc.node_sz / 16; | |
5cbc3073 | 351 | |
43fdf274 DM |
352 | if (from == MDESC_NODE_NULL || from >= last_node) |
353 | return MDESC_NODE_NULL; | |
5cbc3073 | 354 | |
43fdf274 DM |
355 | ep = base + from; |
356 | ||
357 | ep++; | |
358 | for (; ep->tag != MD_NODE_END; ep++) { | |
359 | if (ep->tag != MD_PROP_ARC) | |
360 | continue; | |
361 | ||
362 | if (strcmp(names + ep->name_offset, arc_type)) | |
363 | continue; | |
364 | ||
365 | return ep - base; | |
5cbc3073 | 366 | } |
43fdf274 DM |
367 | |
368 | return MDESC_NODE_NULL; | |
5cbc3073 | 369 | } |
43fdf274 | 370 | EXPORT_SYMBOL(mdesc_next_arc); |
5cbc3073 | 371 | |
43fdf274 | 372 | u64 mdesc_arc_target(struct mdesc_handle *hp, u64 arc) |
5cbc3073 | 373 | { |
43fdf274 DM |
374 | struct mdesc_elem *ep, *base = node_block(&hp->mdesc); |
375 | ||
376 | ep = base + arc; | |
377 | ||
378 | return ep->d.val; | |
5cbc3073 | 379 | } |
43fdf274 DM |
380 | EXPORT_SYMBOL(mdesc_arc_target); |
381 | ||
382 | const char *mdesc_node_name(struct mdesc_handle *hp, u64 node) | |
383 | { | |
384 | struct mdesc_elem *ep, *base = node_block(&hp->mdesc); | |
385 | const char *names = name_block(&hp->mdesc); | |
386 | u64 last_node = hp->mdesc.node_sz / 16; | |
387 | ||
388 | if (node == MDESC_NODE_NULL || node >= last_node) | |
389 | return NULL; | |
390 | ||
391 | ep = base + node; | |
392 | if (ep->tag != MD_NODE) | |
393 | return NULL; | |
394 | ||
395 | return names + ep->name_offset; | |
396 | } | |
397 | EXPORT_SYMBOL(mdesc_node_name); | |
5cbc3073 DM |
398 | |
399 | static void __init report_platform_properties(void) | |
400 | { | |
43fdf274 DM |
401 | struct mdesc_handle *hp = mdesc_grab(); |
402 | u64 pn = mdesc_node_by_name(hp, MDESC_NODE_NULL, "platform"); | |
5cbc3073 DM |
403 | const char *s; |
404 | const u64 *v; | |
405 | ||
43fdf274 | 406 | if (pn == MDESC_NODE_NULL) { |
5cbc3073 DM |
407 | prom_printf("No platform node in machine-description.\n"); |
408 | prom_halt(); | |
409 | } | |
410 | ||
43fdf274 | 411 | s = mdesc_get_property(hp, pn, "banner-name", NULL); |
5cbc3073 | 412 | printk("PLATFORM: banner-name [%s]\n", s); |
43fdf274 | 413 | s = mdesc_get_property(hp, pn, "name", NULL); |
5cbc3073 DM |
414 | printk("PLATFORM: name [%s]\n", s); |
415 | ||
43fdf274 | 416 | v = mdesc_get_property(hp, pn, "hostid", NULL); |
5cbc3073 DM |
417 | if (v) |
418 | printk("PLATFORM: hostid [%08lx]\n", *v); | |
43fdf274 | 419 | v = mdesc_get_property(hp, pn, "serial#", NULL); |
5cbc3073 DM |
420 | if (v) |
421 | printk("PLATFORM: serial# [%08lx]\n", *v); | |
43fdf274 | 422 | v = mdesc_get_property(hp, pn, "stick-frequency", NULL); |
5cbc3073 | 423 | printk("PLATFORM: stick-frequency [%08lx]\n", *v); |
43fdf274 | 424 | v = mdesc_get_property(hp, pn, "mac-address", NULL); |
5cbc3073 DM |
425 | if (v) |
426 | printk("PLATFORM: mac-address [%lx]\n", *v); | |
43fdf274 | 427 | v = mdesc_get_property(hp, pn, "watchdog-resolution", NULL); |
5cbc3073 DM |
428 | if (v) |
429 | printk("PLATFORM: watchdog-resolution [%lu ms]\n", *v); | |
43fdf274 | 430 | v = mdesc_get_property(hp, pn, "watchdog-max-timeout", NULL); |
5cbc3073 DM |
431 | if (v) |
432 | printk("PLATFORM: watchdog-max-timeout [%lu ms]\n", *v); | |
43fdf274 | 433 | v = mdesc_get_property(hp, pn, "max-cpus", NULL); |
5cbc3073 DM |
434 | if (v) |
435 | printk("PLATFORM: max-cpus [%lu]\n", *v); | |
43fdf274 | 436 | |
4f0234f4 DM |
437 | #ifdef CONFIG_SMP |
438 | { | |
439 | int max_cpu, i; | |
440 | ||
441 | if (v) { | |
442 | max_cpu = *v; | |
443 | if (max_cpu > NR_CPUS) | |
444 | max_cpu = NR_CPUS; | |
445 | } else { | |
446 | max_cpu = NR_CPUS; | |
447 | } | |
448 | for (i = 0; i < max_cpu; i++) | |
449 | cpu_set(i, cpu_possible_map); | |
450 | } | |
451 | #endif | |
452 | ||
43fdf274 | 453 | mdesc_release(hp); |
5cbc3073 DM |
454 | } |
455 | ||
456 | static int inline find_in_proplist(const char *list, const char *match, int len) | |
457 | { | |
458 | while (len > 0) { | |
459 | int l; | |
460 | ||
461 | if (!strcmp(list, match)) | |
462 | return 1; | |
463 | l = strlen(list) + 1; | |
464 | list += l; | |
465 | len -= l; | |
466 | } | |
467 | return 0; | |
468 | } | |
469 | ||
4f0234f4 DM |
470 | static void __devinit fill_in_one_cache(cpuinfo_sparc *c, |
471 | struct mdesc_handle *hp, | |
472 | u64 mp) | |
5cbc3073 | 473 | { |
43fdf274 DM |
474 | const u64 *level = mdesc_get_property(hp, mp, "level", NULL); |
475 | const u64 *size = mdesc_get_property(hp, mp, "size", NULL); | |
476 | const u64 *line_size = mdesc_get_property(hp, mp, "line-size", NULL); | |
5cbc3073 DM |
477 | const char *type; |
478 | int type_len; | |
479 | ||
43fdf274 | 480 | type = mdesc_get_property(hp, mp, "type", &type_len); |
5cbc3073 DM |
481 | |
482 | switch (*level) { | |
483 | case 1: | |
484 | if (find_in_proplist(type, "instn", type_len)) { | |
485 | c->icache_size = *size; | |
486 | c->icache_line_size = *line_size; | |
487 | } else if (find_in_proplist(type, "data", type_len)) { | |
488 | c->dcache_size = *size; | |
489 | c->dcache_line_size = *line_size; | |
490 | } | |
491 | break; | |
492 | ||
493 | case 2: | |
494 | c->ecache_size = *size; | |
495 | c->ecache_line_size = *line_size; | |
496 | break; | |
497 | ||
498 | default: | |
499 | break; | |
500 | } | |
501 | ||
502 | if (*level == 1) { | |
43fdf274 | 503 | u64 a; |
5cbc3073 | 504 | |
43fdf274 DM |
505 | mdesc_for_each_arc(a, hp, mp, MDESC_ARC_TYPE_FWD) { |
506 | u64 target = mdesc_arc_target(hp, a); | |
507 | const char *name = mdesc_node_name(hp, target); | |
5cbc3073 | 508 | |
43fdf274 DM |
509 | if (!strcmp(name, "cache")) |
510 | fill_in_one_cache(c, hp, target); | |
5cbc3073 DM |
511 | } |
512 | } | |
513 | } | |
514 | ||
4f0234f4 DM |
515 | static void __devinit mark_core_ids(struct mdesc_handle *hp, u64 mp, |
516 | int core_id) | |
5cbc3073 | 517 | { |
43fdf274 | 518 | u64 a; |
5cbc3073 | 519 | |
43fdf274 DM |
520 | mdesc_for_each_arc(a, hp, mp, MDESC_ARC_TYPE_BACK) { |
521 | u64 t = mdesc_arc_target(hp, a); | |
522 | const char *name; | |
5cbc3073 DM |
523 | const u64 *id; |
524 | ||
43fdf274 DM |
525 | name = mdesc_node_name(hp, t); |
526 | if (!strcmp(name, "cpu")) { | |
527 | id = mdesc_get_property(hp, t, "id", NULL); | |
5cbc3073 DM |
528 | if (*id < NR_CPUS) |
529 | cpu_data(*id).core_id = core_id; | |
530 | } else { | |
43fdf274 | 531 | u64 j; |
5cbc3073 | 532 | |
43fdf274 DM |
533 | mdesc_for_each_arc(j, hp, t, MDESC_ARC_TYPE_BACK) { |
534 | u64 n = mdesc_arc_target(hp, j); | |
535 | const char *n_name; | |
5cbc3073 | 536 | |
43fdf274 DM |
537 | n_name = mdesc_node_name(hp, n); |
538 | if (strcmp(n_name, "cpu")) | |
5cbc3073 DM |
539 | continue; |
540 | ||
43fdf274 | 541 | id = mdesc_get_property(hp, n, "id", NULL); |
5cbc3073 DM |
542 | if (*id < NR_CPUS) |
543 | cpu_data(*id).core_id = core_id; | |
544 | } | |
545 | } | |
546 | } | |
547 | } | |
548 | ||
4f0234f4 | 549 | static void __devinit set_core_ids(struct mdesc_handle *hp) |
5cbc3073 | 550 | { |
5cbc3073 | 551 | int idx; |
43fdf274 | 552 | u64 mp; |
5cbc3073 DM |
553 | |
554 | idx = 1; | |
43fdf274 DM |
555 | mdesc_for_each_node_by_name(hp, mp, "cache") { |
556 | const u64 *level; | |
5cbc3073 DM |
557 | const char *type; |
558 | int len; | |
559 | ||
43fdf274 | 560 | level = mdesc_get_property(hp, mp, "level", NULL); |
5cbc3073 DM |
561 | if (*level != 1) |
562 | continue; | |
563 | ||
43fdf274 | 564 | type = mdesc_get_property(hp, mp, "type", &len); |
5cbc3073 DM |
565 | if (!find_in_proplist(type, "instn", len)) |
566 | continue; | |
567 | ||
43fdf274 | 568 | mark_core_ids(hp, mp, idx); |
5cbc3073 DM |
569 | |
570 | idx++; | |
571 | } | |
572 | } | |
573 | ||
4f0234f4 DM |
574 | static void __devinit mark_proc_ids(struct mdesc_handle *hp, u64 mp, |
575 | int proc_id) | |
f78eae2e | 576 | { |
43fdf274 | 577 | u64 a; |
f78eae2e | 578 | |
43fdf274 DM |
579 | mdesc_for_each_arc(a, hp, mp, MDESC_ARC_TYPE_BACK) { |
580 | u64 t = mdesc_arc_target(hp, a); | |
581 | const char *name; | |
f78eae2e DM |
582 | const u64 *id; |
583 | ||
43fdf274 DM |
584 | name = mdesc_node_name(hp, t); |
585 | if (strcmp(name, "cpu")) | |
f78eae2e DM |
586 | continue; |
587 | ||
43fdf274 | 588 | id = mdesc_get_property(hp, t, "id", NULL); |
f78eae2e DM |
589 | if (*id < NR_CPUS) |
590 | cpu_data(*id).proc_id = proc_id; | |
591 | } | |
592 | } | |
593 | ||
4f0234f4 DM |
594 | static void __devinit __set_proc_ids(struct mdesc_handle *hp, |
595 | const char *exec_unit_name) | |
f78eae2e | 596 | { |
f78eae2e | 597 | int idx; |
43fdf274 | 598 | u64 mp; |
f78eae2e DM |
599 | |
600 | idx = 0; | |
43fdf274 | 601 | mdesc_for_each_node_by_name(hp, mp, exec_unit_name) { |
f78eae2e DM |
602 | const char *type; |
603 | int len; | |
604 | ||
43fdf274 | 605 | type = mdesc_get_property(hp, mp, "type", &len); |
f78eae2e DM |
606 | if (!find_in_proplist(type, "int", len) && |
607 | !find_in_proplist(type, "integer", len)) | |
608 | continue; | |
609 | ||
43fdf274 | 610 | mark_proc_ids(hp, mp, idx); |
f78eae2e DM |
611 | |
612 | idx++; | |
613 | } | |
614 | } | |
615 | ||
4f0234f4 | 616 | static void __devinit set_proc_ids(struct mdesc_handle *hp) |
f78eae2e | 617 | { |
43fdf274 DM |
618 | __set_proc_ids(hp, "exec_unit"); |
619 | __set_proc_ids(hp, "exec-unit"); | |
f78eae2e DM |
620 | } |
621 | ||
4f0234f4 DM |
622 | static void __devinit get_one_mondo_bits(const u64 *p, unsigned int *mask, |
623 | unsigned char def) | |
5cbc3073 DM |
624 | { |
625 | u64 val; | |
626 | ||
627 | if (!p) | |
628 | goto use_default; | |
629 | val = *p; | |
630 | ||
631 | if (!val || val >= 64) | |
632 | goto use_default; | |
633 | ||
634 | *mask = ((1U << val) * 64U) - 1U; | |
635 | return; | |
636 | ||
637 | use_default: | |
638 | *mask = ((1U << def) * 64U) - 1U; | |
639 | } | |
640 | ||
4f0234f4 DM |
641 | static void __devinit get_mondo_data(struct mdesc_handle *hp, u64 mp, |
642 | struct trap_per_cpu *tb) | |
5cbc3073 DM |
643 | { |
644 | const u64 *val; | |
645 | ||
43fdf274 | 646 | val = mdesc_get_property(hp, mp, "q-cpu-mondo-#bits", NULL); |
5cbc3073 DM |
647 | get_one_mondo_bits(val, &tb->cpu_mondo_qmask, 7); |
648 | ||
43fdf274 | 649 | val = mdesc_get_property(hp, mp, "q-dev-mondo-#bits", NULL); |
5cbc3073 DM |
650 | get_one_mondo_bits(val, &tb->dev_mondo_qmask, 7); |
651 | ||
43fdf274 | 652 | val = mdesc_get_property(hp, mp, "q-resumable-#bits", NULL); |
5cbc3073 DM |
653 | get_one_mondo_bits(val, &tb->resum_qmask, 6); |
654 | ||
43fdf274 | 655 | val = mdesc_get_property(hp, mp, "q-nonresumable-#bits", NULL); |
5cbc3073 DM |
656 | get_one_mondo_bits(val, &tb->nonresum_qmask, 2); |
657 | } | |
658 | ||
4f0234f4 | 659 | void __devinit mdesc_fill_in_cpu_data(cpumask_t mask) |
5cbc3073 | 660 | { |
43fdf274 DM |
661 | struct mdesc_handle *hp = mdesc_grab(); |
662 | u64 mp; | |
5cbc3073 DM |
663 | |
664 | ncpus_probed = 0; | |
43fdf274 DM |
665 | mdesc_for_each_node_by_name(hp, mp, "cpu") { |
666 | const u64 *id = mdesc_get_property(hp, mp, "id", NULL); | |
667 | const u64 *cfreq = mdesc_get_property(hp, mp, "clock-frequency", NULL); | |
5cbc3073 DM |
668 | struct trap_per_cpu *tb; |
669 | cpuinfo_sparc *c; | |
5cbc3073 | 670 | int cpuid; |
43fdf274 | 671 | u64 a; |
5cbc3073 DM |
672 | |
673 | ncpus_probed++; | |
674 | ||
675 | cpuid = *id; | |
676 | ||
677 | #ifdef CONFIG_SMP | |
678 | if (cpuid >= NR_CPUS) | |
679 | continue; | |
4f0234f4 DM |
680 | if (!cpu_isset(cpuid, mask)) |
681 | continue; | |
5cbc3073 DM |
682 | #else |
683 | /* On uniprocessor we only want the values for the | |
684 | * real physical cpu the kernel booted onto, however | |
685 | * cpu_data() only has one entry at index 0. | |
686 | */ | |
687 | if (cpuid != real_hard_smp_processor_id()) | |
688 | continue; | |
689 | cpuid = 0; | |
690 | #endif | |
691 | ||
692 | c = &cpu_data(cpuid); | |
693 | c->clock_tick = *cfreq; | |
694 | ||
695 | tb = &trap_block[cpuid]; | |
43fdf274 | 696 | get_mondo_data(hp, mp, tb); |
5cbc3073 | 697 | |
43fdf274 DM |
698 | mdesc_for_each_arc(a, hp, mp, MDESC_ARC_TYPE_FWD) { |
699 | u64 j, t = mdesc_arc_target(hp, a); | |
700 | const char *t_name; | |
5cbc3073 | 701 | |
43fdf274 DM |
702 | t_name = mdesc_node_name(hp, t); |
703 | if (!strcmp(t_name, "cache")) { | |
704 | fill_in_one_cache(c, hp, t); | |
5cbc3073 DM |
705 | continue; |
706 | } | |
707 | ||
43fdf274 DM |
708 | mdesc_for_each_arc(j, hp, t, MDESC_ARC_TYPE_FWD) { |
709 | u64 n = mdesc_arc_target(hp, j); | |
710 | const char *n_name; | |
5cbc3073 | 711 | |
43fdf274 DM |
712 | n_name = mdesc_node_name(hp, n); |
713 | if (!strcmp(n_name, "cache")) | |
714 | fill_in_one_cache(c, hp, n); | |
5cbc3073 DM |
715 | } |
716 | } | |
717 | ||
718 | #ifdef CONFIG_SMP | |
719 | cpu_set(cpuid, cpu_present_map); | |
5cbc3073 DM |
720 | #endif |
721 | ||
722 | c->core_id = 0; | |
f78eae2e | 723 | c->proc_id = -1; |
5cbc3073 DM |
724 | } |
725 | ||
a2f9f6bb DM |
726 | #ifdef CONFIG_SMP |
727 | sparc64_multi_core = 1; | |
728 | #endif | |
729 | ||
43fdf274 DM |
730 | set_core_ids(hp); |
731 | set_proc_ids(hp); | |
5cbc3073 DM |
732 | |
733 | smp_fill_in_sib_core_maps(); | |
43fdf274 DM |
734 | |
735 | mdesc_release(hp); | |
5cbc3073 DM |
736 | } |
737 | ||
738 | void __init sun4v_mdesc_init(void) | |
739 | { | |
43fdf274 | 740 | struct mdesc_handle *hp; |
5cbc3073 | 741 | unsigned long len, real_len, status; |
4f0234f4 | 742 | cpumask_t mask; |
5cbc3073 DM |
743 | |
744 | (void) sun4v_mach_desc(0UL, 0UL, &len); | |
745 | ||
746 | printk("MDESC: Size is %lu bytes.\n", len); | |
747 | ||
43fdf274 DM |
748 | hp = mdesc_alloc(len, &bootmem_mdesc_memops); |
749 | if (hp == NULL) { | |
750 | prom_printf("MDESC: alloc of %lu bytes failed.\n", len); | |
751 | prom_halt(); | |
752 | } | |
5cbc3073 | 753 | |
43fdf274 | 754 | status = sun4v_mach_desc(__pa(&hp->mdesc), len, &real_len); |
5cbc3073 DM |
755 | if (status != HV_EOK || real_len > len) { |
756 | prom_printf("sun4v_mach_desc fails, err(%lu), " | |
757 | "len(%lu), real_len(%lu)\n", | |
758 | status, len, real_len); | |
43fdf274 | 759 | mdesc_free(hp); |
5cbc3073 DM |
760 | prom_halt(); |
761 | } | |
762 | ||
43fdf274 | 763 | cur_mdesc = hp; |
5cbc3073 DM |
764 | |
765 | report_platform_properties(); | |
4f0234f4 DM |
766 | |
767 | cpus_setall(mask); | |
768 | mdesc_fill_in_cpu_data(mask); | |
5cbc3073 | 769 | } |