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