~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

TOMOYO Linux Cross Reference
Linux/arch/sparc/kernel/mdesc.c

Version: ~ [ linux-5.10-rc1 ] ~ [ linux-5.9.1 ] ~ [ linux-5.8.16 ] ~ [ linux-5.7.19 ] ~ [ linux-5.6.19 ] ~ [ linux-5.5.19 ] ~ [ linux-5.4.72 ] ~ [ linux-5.3.18 ] ~ [ linux-5.2.21 ] ~ [ linux-5.1.21 ] ~ [ linux-5.0.21 ] ~ [ linux-4.20.17 ] ~ [ linux-4.19.152 ] ~ [ linux-4.18.20 ] ~ [ linux-4.17.19 ] ~ [ linux-4.16.18 ] ~ [ linux-4.15.18 ] ~ [ linux-4.14.202 ] ~ [ linux-4.13.16 ] ~ [ linux-4.12.14 ] ~ [ linux-4.11.12 ] ~ [ linux-4.10.17 ] ~ [ linux-4.9.240 ] ~ [ linux-4.8.17 ] ~ [ linux-4.7.10 ] ~ [ linux-4.6.7 ] ~ [ linux-4.5.7 ] ~ [ linux-4.4.240 ] ~ [ linux-4.3.6 ] ~ [ linux-4.2.8 ] ~ [ linux-4.1.52 ] ~ [ linux-4.0.9 ] ~ [ linux-3.19.8 ] ~ [ linux-3.18.140 ] ~ [ linux-3.17.8 ] ~ [ linux-3.16.85 ] ~ [ linux-3.15.10 ] ~ [ linux-3.14.79 ] ~ [ linux-3.13.11 ] ~ [ linux-3.12.74 ] ~ [ linux-3.11.10 ] ~ [ linux-3.10.108 ] ~ [ linux-2.6.32.71 ] ~ [ linux-2.6.0 ] ~ [ linux-2.4.37.11 ] ~ [ unix-v6-master ] ~ [ ccs-tools-1.8.5 ] ~ [ policy-sample ] ~
Architecture: ~ [ i386 ] ~ [ alpha ] ~ [ m68k ] ~ [ mips ] ~ [ ppc ] ~ [ sparc ] ~ [ sparc64 ] ~

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

~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

kernel.org | git.kernel.org | LWN.net | Project Home | Wiki (Japanese) | Wiki (English) | SVN repository | Mail admin

Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.

osdn.jp