arch/sparc/kernel/mdesc.c

   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 * __cpuinit fill_in_one_cpu(struct mdesc_handle *hp, u64 mp, int cpuid, void *arg)
 821 {
 822         const u64 *cfreq = mdesc_get_property(hp, mp, "clock-frequency", NULL);
 823         struct trap_per_cpu *tb;
 824         cpuinfo_sparc *c;
 825         u64 a;
 826
 827 #ifndef CONFIG_SMP
 828         /* On uniprocessor we only want the values for the
 829          * real physical cpu the kernel booted onto, however
 830          * cpu_data() only has one entry at index 0.
 831          */
 832         if (cpuid != real_hard_smp_processor_id())
 833                 return NULL;
 834         cpuid = 0;
 835 #endif
 836
 837         c = &cpu_data(cpuid);
 838         c->clock_tick = *cfreq;
 839
 840         tb = &trap_block[cpuid];
 841         get_mondo_data(hp, mp, tb);
 842
 843         mdesc_for_each_arc(a, hp, mp, MDESC_ARC_TYPE_FWD) {
 844                 u64 j, t = mdesc_arc_target(hp, a);
 845                 const char *t_name;
 846
 847                 t_name = mdesc_node_name(hp, t);
 848                 if (!strcmp(t_name, "cache")) {
 849                         fill_in_one_cache(c, hp, t);
 850                         continue;
 851                 }
 852
 853                 mdesc_for_each_arc(j, hp, t, MDESC_ARC_TYPE_FWD) {
 854                         u64 n = mdesc_arc_target(hp, j);
 855                         const char *n_name;
 856
 857                         n_name = mdesc_node_name(hp, n);
 858                         if (!strcmp(n_name, "cache"))
 859                                 fill_in_one_cache(c, hp, n);
 860                 }
 861         }
 862
 863         c->core_id = 0;
 864         c->proc_id = -1;
 865
 866         return NULL;
 867 }
 868
 869 void __cpuinit mdesc_fill_in_cpu_data(cpumask_t *mask)
 870 {
 871         struct mdesc_handle *hp;
 872
 873         mdesc_iterate_over_cpus(fill_in_one_cpu, NULL, mask);
 874
 875 #ifdef CONFIG_SMP
 876         sparc64_multi_core = 1;
 877 #endif
 878
 879         hp = mdesc_grab();
 880
 881         set_core_ids(hp);
 882         set_proc_ids(hp);
 883
 884         mdesc_release(hp);
 885
 886         smp_fill_in_sib_core_maps();
 887 }
 888
 889 static ssize_t mdesc_read(struct file *file, char __user *buf,
 890                           size_t len, loff_t *offp)
 891 {
 892         struct mdesc_handle *hp = mdesc_grab();
 893         int err;
 894
 895         if (!hp)
 896                 return -ENODEV;
 897
 898         err = hp->handle_size;
 899         if (len < hp->handle_size)
 900                 err = -EMSGSIZE;
 901         else if (copy_to_user(buf, &hp->mdesc, hp->handle_size))
 902                 err = -EFAULT;
 903         mdesc_release(hp);
 904
 905         return err;
 906 }
 907
 908 static const struct file_operations mdesc_fops = {
 909         .read   = mdesc_read,
 910         .owner  = THIS_MODULE,
 911         .llseek = noop_llseek,
 912 };
 913
 914 static struct miscdevice mdesc_misc = {
 915         .minor  = MISC_DYNAMIC_MINOR,
 916         .name   = "mdesc",
 917         .fops   = &mdesc_fops,
 918 };
 919
 920 static int __init mdesc_misc_init(void)
 921 {
 922         return misc_register(&mdesc_misc);
 923 }
 924
 925 __initcall(mdesc_misc_init);
 926
 927 void __init sun4v_mdesc_init(void)
 928 {
 929         struct mdesc_handle *hp;
 930         unsigned long len, real_len, status;
 931
 932         (void) sun4v_mach_desc(0UL, 0UL, &len);
 933
 934         printk("MDESC: Size is %lu bytes.\n", len);
 935
 936         hp = mdesc_alloc(len, &memblock_mdesc_ops);
 937         if (hp == NULL) {
 938                 prom_printf("MDESC: alloc of %lu bytes failed.\n", len);
 939                 prom_halt();
 940         }
 941
 942         status = sun4v_mach_desc(__pa(&hp->mdesc), len, &real_len);
 943         if (status != HV_EOK || real_len > len) {
 944                 prom_printf("sun4v_mach_desc fails, err(%lu), "
 945                             "len(%lu), real_len(%lu)\n",
 946                             status, len, real_len);
 947                 mdesc_free(hp);
 948                 prom_halt();
 949         }
 950
 951         cur_mdesc = hp;
 952
 953         report_platform_properties();
 954 }