tools/perf/util/cpumap.c

   1 #include "util.h"
   2 #include <api/fs/fs.h>
   3 #include "../perf.h"
   4 #include "cpumap.h"
   5 #include <assert.h>
   6 #include <stdio.h>
   7 #include <stdlib.h>
   8 #include <linux/bitmap.h>
   9 #include "asm/bug.h"
  10
  11 static struct cpu_map *cpu_map__default_new(void)
  12 {
  13         struct cpu_map *cpus;
  14         int nr_cpus;
  15
  16         nr_cpus = sysconf(_SC_NPROCESSORS_ONLN);
  17         if (nr_cpus < 0)
  18                 return NULL;
  19
  20         cpus = malloc(sizeof(*cpus) + nr_cpus * sizeof(int));
  21         if (cpus != NULL) {
  22                 int i;
  23                 for (i = 0; i < nr_cpus; ++i)
  24                         cpus->map[i] = i;
  25
  26                 cpus->nr = nr_cpus;
  27                 atomic_set(&cpus->refcnt, 1);
  28         }
  29
  30         return cpus;
  31 }
  32
  33 static struct cpu_map *cpu_map__trim_new(int nr_cpus, int *tmp_cpus)
  34 {
  35         size_t payload_size = nr_cpus * sizeof(int);
  36         struct cpu_map *cpus = malloc(sizeof(*cpus) + payload_size);
  37
  38         if (cpus != NULL) {
  39                 cpus->nr = nr_cpus;
  40                 memcpy(cpus->map, tmp_cpus, payload_size);
  41                 atomic_set(&cpus->refcnt, 1);
  42         }
  43
  44         return cpus;
  45 }
  46
  47 struct cpu_map *cpu_map__read(FILE *file)
  48 {
  49         struct cpu_map *cpus = NULL;
  50         int nr_cpus = 0;
  51         int *tmp_cpus = NULL, *tmp;
  52         int max_entries = 0;
  53         int n, cpu, prev;
  54         char sep;
  55
  56         sep = 0;
  57         prev = -1;
  58         for (;;) {
  59                 n = fscanf(file, "%u%c", &cpu, &sep);
  60                 if (n <= 0)
  61                         break;
  62                 if (prev >= 0) {
  63                         int new_max = nr_cpus + cpu - prev - 1;
  64
  65                         if (new_max >= max_entries) {
  66                                 max_entries = new_max + MAX_NR_CPUS / 2;
  67                                 tmp = realloc(tmp_cpus, max_entries * sizeof(int));
  68                                 if (tmp == NULL)
  69                                         goto out_free_tmp;
  70                                 tmp_cpus = tmp;
  71                         }
  72
  73                         while (++prev < cpu)
  74                                 tmp_cpus[nr_cpus++] = prev;
  75                 }
  76                 if (nr_cpus == max_entries) {
  77                         max_entries += MAX_NR_CPUS;
  78                         tmp = realloc(tmp_cpus, max_entries * sizeof(int));
  79                         if (tmp == NULL)
  80                                 goto out_free_tmp;
  81                         tmp_cpus = tmp;
  82                 }
  83
  84                 tmp_cpus[nr_cpus++] = cpu;
  85                 if (n == 2 && sep == '-')
  86                         prev = cpu;
  87                 else
  88                         prev = -1;
  89                 if (n == 1 || sep == '\n')
  90                         break;
  91         }
  92
  93         if (nr_cpus > 0)
  94                 cpus = cpu_map__trim_new(nr_cpus, tmp_cpus);
  95         else
  96                 cpus = cpu_map__default_new();
  97 out_free_tmp:
  98         free(tmp_cpus);
  99         return cpus;
 100 }
 101
 102 static struct cpu_map *cpu_map__read_all_cpu_map(void)
 103 {
 104         struct cpu_map *cpus = NULL;
 105         FILE *onlnf;
 106
 107         onlnf = fopen("/sys/devices/system/cpu/online", "r");
 108         if (!onlnf)
 109                 return cpu_map__default_new();
 110
 111         cpus = cpu_map__read(onlnf);
 112         fclose(onlnf);
 113         return cpus;
 114 }
 115
 116 struct cpu_map *cpu_map__new(const char *cpu_list)
 117 {
 118         struct cpu_map *cpus = NULL;
 119         unsigned long start_cpu, end_cpu = 0;
 120         char *p = NULL;
 121         int i, nr_cpus = 0;
 122         int *tmp_cpus = NULL, *tmp;
 123         int max_entries = 0;
 124
 125         if (!cpu_list)
 126                 return cpu_map__read_all_cpu_map();
 127
 128         if (!isdigit(*cpu_list))
 129                 goto out;
 130
 131         while (isdigit(*cpu_list)) {
 132                 p = NULL;
 133                 start_cpu = strtoul(cpu_list, &p, 0);
 134                 if (start_cpu >= INT_MAX
 135                     || (*p != '\0' && *p != ',' && *p != '-'))
 136                         goto invalid;
 137
 138                 if (*p == '-') {
 139                         cpu_list = ++p;
 140                         p = NULL;
 141                         end_cpu = strtoul(cpu_list, &p, 0);
 142
 143                         if (end_cpu >= INT_MAX || (*p != '\0' && *p != ','))
 144                                 goto invalid;
 145
 146                         if (end_cpu < start_cpu)
 147                                 goto invalid;
 148                 } else {
 149                         end_cpu = start_cpu;
 150                 }
 151
 152                 for (; start_cpu <= end_cpu; start_cpu++) {
 153                         /* check for duplicates */
 154                         for (i = 0; i < nr_cpus; i++)
 155                                 if (tmp_cpus[i] == (int)start_cpu)
 156                                         goto invalid;
 157
 158                         if (nr_cpus == max_entries) {
 159                                 max_entries += MAX_NR_CPUS;
 160                                 tmp = realloc(tmp_cpus, max_entries * sizeof(int));
 161                                 if (tmp == NULL)
 162                                         goto invalid;
 163                                 tmp_cpus = tmp;
 164                         }
 165                         tmp_cpus[nr_cpus++] = (int)start_cpu;
 166                 }
 167                 if (*p)
 168                         ++p;
 169
 170                 cpu_list = p;
 171         }
 172
 173         if (nr_cpus > 0)
 174                 cpus = cpu_map__trim_new(nr_cpus, tmp_cpus);
 175         else
 176                 cpus = cpu_map__default_new();
 177 invalid:
 178         free(tmp_cpus);
 179 out:
 180         return cpus;
 181 }
 182
 183 static struct cpu_map *cpu_map__from_entries(struct cpu_map_entries *cpus)
 184 {
 185         struct cpu_map *map;
 186
 187         map = cpu_map__empty_new(cpus->nr);
 188         if (map) {
 189                 unsigned i;
 190
 191                 for (i = 0; i < cpus->nr; i++) {
 192                         /*
 193                          * Special treatment for -1, which is not real cpu number,
 194                          * and we need to use (int) -1 to initialize map[i],
 195                          * otherwise it would become 65535.
 196                          */
 197                         if (cpus->cpu[i] == (u16) -1)
 198                                 map->map[i] = -1;
 199                         else
 200                                 map->map[i] = (int) cpus->cpu[i];
 201                 }
 202         }
 203
 204         return map;
 205 }
 206
 207 static struct cpu_map *cpu_map__from_mask(struct cpu_map_mask *mask)
 208 {
 209         struct cpu_map *map;
 210         int nr, nbits = mask->nr * mask->long_size * BITS_PER_BYTE;
 211
 212         nr = bitmap_weight(mask->mask, nbits);
 213
 214         map = cpu_map__empty_new(nr);
 215         if (map) {
 216                 int cpu, i = 0;
 217
 218                 for_each_set_bit(cpu, mask->mask, nbits)
 219                         map->map[i++] = cpu;
 220         }
 221         return map;
 222
 223 }
 224
 225 struct cpu_map *cpu_map__new_data(struct cpu_map_data *data)
 226 {
 227         if (data->type == PERF_CPU_MAP__CPUS)
 228                 return cpu_map__from_entries((struct cpu_map_entries *)data->data);
 229         else
 230                 return cpu_map__from_mask((struct cpu_map_mask *)data->data);
 231 }
 232
 233 size_t cpu_map__fprintf(struct cpu_map *map, FILE *fp)
 234 {
 235         int i;
 236         size_t printed = fprintf(fp, "%d cpu%s: ",
 237                                  map->nr, map->nr > 1 ? "s" : "");
 238         for (i = 0; i < map->nr; ++i)
 239                 printed += fprintf(fp, "%s%d", i ? ", " : "", map->map[i]);
 240
 241         return printed + fprintf(fp, "\n");
 242 }
 243
 244 struct cpu_map *cpu_map__dummy_new(void)
 245 {
 246         struct cpu_map *cpus = malloc(sizeof(*cpus) + sizeof(int));
 247
 248         if (cpus != NULL) {
 249                 cpus->nr = 1;
 250                 cpus->map[0] = -1;
 251                 atomic_set(&cpus->refcnt, 1);
 252         }
 253
 254         return cpus;
 255 }
 256
 257 struct cpu_map *cpu_map__empty_new(int nr)
 258 {
 259         struct cpu_map *cpus = malloc(sizeof(*cpus) + sizeof(int) * nr);
 260
 261         if (cpus != NULL) {
 262                 int i;
 263
 264                 cpus->nr = nr;
 265                 for (i = 0; i < nr; i++)
 266                         cpus->map[i] = -1;
 267
 268                 atomic_set(&cpus->refcnt, 1);
 269         }
 270
 271         return cpus;
 272 }
 273
 274 static void cpu_map__delete(struct cpu_map *map)
 275 {
 276         if (map) {
 277                 WARN_ONCE(atomic_read(&map->refcnt) != 0,
 278                           "cpu_map refcnt unbalanced\n");
 279                 free(map);
 280         }
 281 }
 282
 283 struct cpu_map *cpu_map__get(struct cpu_map *map)
 284 {
 285         if (map)
 286                 atomic_inc(&map->refcnt);
 287         return map;
 288 }
 289
 290 void cpu_map__put(struct cpu_map *map)
 291 {
 292         if (map && atomic_dec_and_test(&map->refcnt))
 293                 cpu_map__delete(map);
 294 }
 295
 296 static int cpu__get_topology_int(int cpu, const char *name, int *value)
 297 {
 298         char path[PATH_MAX];
 299
 300         snprintf(path, PATH_MAX,
 301                 "devices/system/cpu/cpu%d/topology/%s", cpu, name);
 302
 303         return sysfs__read_int(path, value);
 304 }
 305
 306 int cpu_map__get_socket_id(int cpu)
 307 {
 308         int value, ret = cpu__get_topology_int(cpu, "physical_package_id", &value);
 309         return ret ?: value;
 310 }
 311
 312 int cpu_map__get_socket(struct cpu_map *map, int idx, void *data __maybe_unused)
 313 {
 314         int cpu;
 315
 316         if (idx > map->nr)
 317                 return -1;
 318
 319         cpu = map->map[idx];
 320
 321         return cpu_map__get_socket_id(cpu);
 322 }
 323
 324 static int cmp_ids(const void *a, const void *b)
 325 {
 326         return *(int *)a - *(int *)b;
 327 }
 328
 329 int cpu_map__build_map(struct cpu_map *cpus, struct cpu_map **res,
 330                        int (*f)(struct cpu_map *map, int cpu, void *data),
 331                        void *data)
 332 {
 333         struct cpu_map *c;
 334         int nr = cpus->nr;
 335         int cpu, s1, s2;
 336
 337         /* allocate as much as possible */
 338         c = calloc(1, sizeof(*c) + nr * sizeof(int));
 339         if (!c)
 340                 return -1;
 341
 342         for (cpu = 0; cpu < nr; cpu++) {
 343                 s1 = f(cpus, cpu, data);
 344                 for (s2 = 0; s2 < c->nr; s2++) {
 345                         if (s1 == c->map[s2])
 346                                 break;
 347                 }
 348                 if (s2 == c->nr) {
 349                         c->map[c->nr] = s1;
 350                         c->nr++;
 351                 }
 352         }
 353         /* ensure we process id in increasing order */
 354         qsort(c->map, c->nr, sizeof(int), cmp_ids);
 355
 356         atomic_set(&c->refcnt, 1);
 357         *res = c;
 358         return 0;
 359 }
 360
 361 int cpu_map__get_core_id(int cpu)
 362 {
 363         int value, ret = cpu__get_topology_int(cpu, "core_id", &value);
 364         return ret ?: value;
 365 }
 366
 367 int cpu_map__get_core(struct cpu_map *map, int idx, void *data)
 368 {
 369         int cpu, s;
 370
 371         if (idx > map->nr)
 372                 return -1;
 373
 374         cpu = map->map[idx];
 375
 376         cpu = cpu_map__get_core_id(cpu);
 377
 378         s = cpu_map__get_socket(map, idx, data);
 379         if (s == -1)
 380                 return -1;
 381
 382         /*
 383          * encode socket in upper 16 bits
 384          * core_id is relative to socket, and
 385          * we need a global id. So we combine
 386          * socket+ core id
 387          */
 388         return (s << 16) | (cpu & 0xffff);
 389 }
 390
 391 int cpu_map__build_socket_map(struct cpu_map *cpus, struct cpu_map **sockp)
 392 {
 393         return cpu_map__build_map(cpus, sockp, cpu_map__get_socket, NULL);
 394 }
 395
 396 int cpu_map__build_core_map(struct cpu_map *cpus, struct cpu_map **corep)
 397 {
 398         return cpu_map__build_map(cpus, corep, cpu_map__get_core, NULL);
 399 }
 400
 401 /* setup simple routines to easily access node numbers given a cpu number */
 402 static int get_max_num(char *path, int *max)
 403 {
 404         size_t num;
 405         char *buf;
 406         int err = 0;
 407
 408         if (filename__read_str(path, &buf, &num))
 409                 return -1;
 410
 411         buf[num] = '\0';
 412
 413         /* start on the right, to find highest node num */
 414         while (--num) {
 415                 if ((buf[num] == ',') || (buf[num] == '-')) {
 416                         num++;
 417                         break;
 418                 }
 419         }
 420         if (sscanf(&buf[num], "%d", max) < 1) {
 421                 err = -1;
 422                 goto out;
 423         }
 424
 425         /* convert from 0-based to 1-based */
 426         (*max)++;
 427
 428 out:
 429         free(buf);
 430         return err;
 431 }
 432
 433 /* Determine highest possible cpu in the system for sparse allocation */
 434 static void set_max_cpu_num(void)
 435 {
 436         const char *mnt;
 437         char path[PATH_MAX];
 438         int ret = -1;
 439
 440         /* set up default */
 441         max_cpu_num = 4096;
 442
 443         mnt = sysfs__mountpoint();
 444         if (!mnt)
 445                 goto out;
 446
 447         /* get the highest possible cpu number for a sparse allocation */
 448         ret = snprintf(path, PATH_MAX, "%s/devices/system/cpu/possible", mnt);
 449         if (ret == PATH_MAX) {
 450                 pr_err("sysfs path crossed PATH_MAX(%d) size\n", PATH_MAX);
 451                 goto out;
 452         }
 453
 454         ret = get_max_num(path, &max_cpu_num);
 455
 456 out:
 457         if (ret)
 458                 pr_err("Failed to read max cpus, using default of %d\n", max_cpu_num);
 459 }
 460
 461 /* Determine highest possible node in the system for sparse allocation */
 462 static void set_max_node_num(void)
 463 {
 464         const char *mnt;
 465         char path[PATH_MAX];
 466         int ret = -1;
 467
 468         /* set up default */
 469         max_node_num = 8;
 470
 471         mnt = sysfs__mountpoint();
 472         if (!mnt)
 473                 goto out;
 474
 475         /* get the highest possible cpu number for a sparse allocation */
 476         ret = snprintf(path, PATH_MAX, "%s/devices/system/node/possible", mnt);
 477         if (ret == PATH_MAX) {
 478                 pr_err("sysfs path crossed PATH_MAX(%d) size\n", PATH_MAX);
 479                 goto out;
 480         }
 481
 482         ret = get_max_num(path, &max_node_num);
 483
 484 out:
 485         if (ret)
 486                 pr_err("Failed to read max nodes, using default of %d\n", max_node_num);
 487 }
 488
 489 static int init_cpunode_map(void)
 490 {
 491         int i;
 492
 493         set_max_cpu_num();
 494         set_max_node_num();
 495
 496         cpunode_map = calloc(max_cpu_num, sizeof(int));
 497         if (!cpunode_map) {
 498                 pr_err("%s: calloc failed\n", __func__);
 499                 return -1;
 500         }
 501
 502         for (i = 0; i < max_cpu_num; i++)
 503                 cpunode_map[i] = -1;
 504
 505         return 0;
 506 }
 507
 508 int cpu__setup_cpunode_map(void)
 509 {
 510         struct dirent *dent1, *dent2;
 511         DIR *dir1, *dir2;
 512         unsigned int cpu, mem;
 513         char buf[PATH_MAX];
 514         char path[PATH_MAX];
 515         const char *mnt;
 516         int n;
 517
 518         /* initialize globals */
 519         if (init_cpunode_map())
 520                 return -1;
 521
 522         mnt = sysfs__mountpoint();
 523         if (!mnt)
 524                 return 0;
 525
 526         n = snprintf(path, PATH_MAX, "%s/devices/system/node", mnt);
 527         if (n == PATH_MAX) {
 528                 pr_err("sysfs path crossed PATH_MAX(%d) size\n", PATH_MAX);
 529                 return -1;
 530         }
 531
 532         dir1 = opendir(path);
 533         if (!dir1)
 534                 return 0;
 535
 536         /* walk tree and setup map */
 537         while ((dent1 = readdir(dir1)) != NULL) {
 538                 if (dent1->d_type != DT_DIR || sscanf(dent1->d_name, "node%u", &mem) < 1)
 539                         continue;
 540
 541                 n = snprintf(buf, PATH_MAX, "%s/%s", path, dent1->d_name);
 542                 if (n == PATH_MAX) {
 543                         pr_err("sysfs path crossed PATH_MAX(%d) size\n", PATH_MAX);
 544                         continue;
 545                 }
 546
 547                 dir2 = opendir(buf);
 548                 if (!dir2)
 549                         continue;
 550                 while ((dent2 = readdir(dir2)) != NULL) {
 551                         if (dent2->d_type != DT_LNK || sscanf(dent2->d_name, "cpu%u", &cpu) < 1)
 552                                 continue;
 553                         cpunode_map[cpu] = mem;
 554                 }
 555                 closedir(dir2);
 556         }
 557         closedir(dir1);
 558         return 0;
 559 }