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