arch/i386/kernel/cpu/intel_cacheinfo.c

   1 /*
   2  *      Routines to indentify caches on Intel CPU.
   3  *
   4  *      Changes:
   5  *      Venkatesh Pallipadi     : Adding cache identification through cpuid(4)
   6  *              Ashok Raj <ashok.raj@intel.com>: Work with CPU hotplug infrastructure.
   7  */
   8
   9 #include <linux/init.h>
  10 #include <linux/slab.h>
  11 #include <linux/device.h>
  12 #include <linux/compiler.h>
  13 #include <linux/cpu.h>
  14 #include <linux/sched.h>
  15
  16 #include <asm/processor.h>
  17 #include <asm/smp.h>
  18
  19 #define LVL_1_INST      1
  20 #define LVL_1_DATA      2
  21 #define LVL_2           3
  22 #define LVL_3           4
  23 #define LVL_TRACE       5
  24
  25 struct _cache_table
  26 {
  27         unsigned char descriptor;
  28         char cache_type;
  29         short size;
  30 };
  31
  32 /* all the cache descriptor types we care about (no TLB or trace cache entries) */
  33 static struct _cache_table cache_table[] __cpuinitdata =
  34 {
  35         { 0x06, LVL_1_INST, 8 },        /* 4-way set assoc, 32 byte line size */
  36         { 0x08, LVL_1_INST, 16 },       /* 4-way set assoc, 32 byte line size */
  37         { 0x0a, LVL_1_DATA, 8 },        /* 2 way set assoc, 32 byte line size */
  38         { 0x0c, LVL_1_DATA, 16 },       /* 4-way set assoc, 32 byte line size */
  39         { 0x22, LVL_3,      512 },      /* 4-way set assoc, sectored cache, 64 byte line size */
  40         { 0x23, LVL_3,      1024 },     /* 8-way set assoc, sectored cache, 64 byte line size */
  41         { 0x25, LVL_3,      2048 },     /* 8-way set assoc, sectored cache, 64 byte line size */
  42         { 0x29, LVL_3,      4096 },     /* 8-way set assoc, sectored cache, 64 byte line size */
  43         { 0x2c, LVL_1_DATA, 32 },       /* 8-way set assoc, 64 byte line size */
  44         { 0x30, LVL_1_INST, 32 },       /* 8-way set assoc, 64 byte line size */
  45         { 0x39, LVL_2,      128 },      /* 4-way set assoc, sectored cache, 64 byte line size */
  46         { 0x3a, LVL_2,      192 },      /* 6-way set assoc, sectored cache, 64 byte line size */
  47         { 0x3b, LVL_2,      128 },      /* 2-way set assoc, sectored cache, 64 byte line size */
  48         { 0x3c, LVL_2,      256 },      /* 4-way set assoc, sectored cache, 64 byte line size */
  49         { 0x3d, LVL_2,      384 },      /* 6-way set assoc, sectored cache, 64 byte line size */
  50         { 0x3e, LVL_2,      512 },      /* 4-way set assoc, sectored cache, 64 byte line size */
  51         { 0x41, LVL_2,      128 },      /* 4-way set assoc, 32 byte line size */
  52         { 0x42, LVL_2,      256 },      /* 4-way set assoc, 32 byte line size */
  53         { 0x43, LVL_2,      512 },      /* 4-way set assoc, 32 byte line size */
  54         { 0x44, LVL_2,      1024 },     /* 4-way set assoc, 32 byte line size */
  55         { 0x45, LVL_2,      2048 },     /* 4-way set assoc, 32 byte line size */
  56         { 0x46, LVL_3,      4096 },     /* 4-way set assoc, 64 byte line size */
  57         { 0x47, LVL_3,      8192 },     /* 8-way set assoc, 64 byte line size */
  58         { 0x49, LVL_3,      4096 },     /* 16-way set assoc, 64 byte line size */
  59         { 0x4a, LVL_3,      6144 },     /* 12-way set assoc, 64 byte line size */
  60         { 0x4b, LVL_3,      8192 },     /* 16-way set assoc, 64 byte line size */
  61         { 0x4c, LVL_3,     12288 },     /* 12-way set assoc, 64 byte line size */
  62         { 0x4d, LVL_3,     16384 },     /* 16-way set assoc, 64 byte line size */
  63         { 0x60, LVL_1_DATA, 16 },       /* 8-way set assoc, sectored cache, 64 byte line size */
  64         { 0x66, LVL_1_DATA, 8 },        /* 4-way set assoc, sectored cache, 64 byte line size */
  65         { 0x67, LVL_1_DATA, 16 },       /* 4-way set assoc, sectored cache, 64 byte line size */
  66         { 0x68, LVL_1_DATA, 32 },       /* 4-way set assoc, sectored cache, 64 byte line size */
  67         { 0x70, LVL_TRACE,  12 },       /* 8-way set assoc */
  68         { 0x71, LVL_TRACE,  16 },       /* 8-way set assoc */
  69         { 0x72, LVL_TRACE,  32 },       /* 8-way set assoc */
  70         { 0x73, LVL_TRACE,  64 },       /* 8-way set assoc */
  71         { 0x78, LVL_2,    1024 },       /* 4-way set assoc, 64 byte line size */
  72         { 0x79, LVL_2,     128 },       /* 8-way set assoc, sectored cache, 64 byte line size */
  73         { 0x7a, LVL_2,     256 },       /* 8-way set assoc, sectored cache, 64 byte line size */
  74         { 0x7b, LVL_2,     512 },       /* 8-way set assoc, sectored cache, 64 byte line size */
  75         { 0x7c, LVL_2,    1024 },       /* 8-way set assoc, sectored cache, 64 byte line size */
  76         { 0x7d, LVL_2,    2048 },       /* 8-way set assoc, 64 byte line size */
  77         { 0x7f, LVL_2,     512 },       /* 2-way set assoc, 64 byte line size */
  78         { 0x82, LVL_2,     256 },       /* 8-way set assoc, 32 byte line size */
  79         { 0x83, LVL_2,     512 },       /* 8-way set assoc, 32 byte line size */
  80         { 0x84, LVL_2,    1024 },       /* 8-way set assoc, 32 byte line size */
  81         { 0x85, LVL_2,    2048 },       /* 8-way set assoc, 32 byte line size */
  82         { 0x86, LVL_2,     512 },       /* 4-way set assoc, 64 byte line size */
  83         { 0x87, LVL_2,    1024 },       /* 8-way set assoc, 64 byte line size */
  84         { 0x00, 0, 0}
  85 };
  86
  87
  88 enum _cache_type
  89 {
  90         CACHE_TYPE_NULL = 0,
  91         CACHE_TYPE_DATA = 1,
  92         CACHE_TYPE_INST = 2,
  93         CACHE_TYPE_UNIFIED = 3
  94 };
  95
  96 union _cpuid4_leaf_eax {
  97         struct {
  98                 enum _cache_type        type:5;
  99                 unsigned int            level:3;
 100                 unsigned int            is_self_initializing:1;
 101                 unsigned int            is_fully_associative:1;
 102                 unsigned int            reserved:4;
 103                 unsigned int            num_threads_sharing:12;
 104                 unsigned int            num_cores_on_die:6;
 105         } split;
 106         u32 full;
 107 };
 108
 109 union _cpuid4_leaf_ebx {
 110         struct {
 111                 unsigned int            coherency_line_size:12;
 112                 unsigned int            physical_line_partition:10;
 113                 unsigned int            ways_of_associativity:10;
 114         } split;
 115         u32 full;
 116 };
 117
 118 union _cpuid4_leaf_ecx {
 119         struct {
 120                 unsigned int            number_of_sets:32;
 121         } split;
 122         u32 full;
 123 };
 124
 125 struct _cpuid4_info {
 126         union _cpuid4_leaf_eax eax;
 127         union _cpuid4_leaf_ebx ebx;
 128         union _cpuid4_leaf_ecx ecx;
 129         unsigned long size;
 130         cpumask_t shared_cpu_map;
 131 };
 132
 133 static unsigned short                   num_cache_leaves;
 134
 135 static int __cpuinit cpuid4_cache_lookup(int index, struct _cpuid4_info *this_leaf)
 136 {
 137         unsigned int            eax, ebx, ecx, edx;
 138         union _cpuid4_leaf_eax  cache_eax;
 139
 140         cpuid_count(4, index, &eax, &ebx, &ecx, &edx);
 141         cache_eax.full = eax;
 142         if (cache_eax.split.type == CACHE_TYPE_NULL)
 143                 return -EIO; /* better error ? */
 144
 145         this_leaf->eax.full = eax;
 146         this_leaf->ebx.full = ebx;
 147         this_leaf->ecx.full = ecx;
 148         this_leaf->size = (this_leaf->ecx.split.number_of_sets + 1) *
 149                 (this_leaf->ebx.split.coherency_line_size + 1) *
 150                 (this_leaf->ebx.split.physical_line_partition + 1) *
 151                 (this_leaf->ebx.split.ways_of_associativity + 1);
 152         return 0;
 153 }
 154
 155 /* will only be called once; __init is safe here */
 156 static int __init find_num_cache_leaves(void)
 157 {
 158         unsigned int            eax, ebx, ecx, edx;
 159         union _cpuid4_leaf_eax  cache_eax;
 160         int                     i = -1;
 161
 162         do {
 163                 ++i;
 164                 /* Do cpuid(4) loop to find out num_cache_leaves */
 165                 cpuid_count(4, i, &eax, &ebx, &ecx, &edx);
 166                 cache_eax.full = eax;
 167         } while (cache_eax.split.type != CACHE_TYPE_NULL);
 168         return i;
 169 }
 170
 171 unsigned int __cpuinit init_intel_cacheinfo(struct cpuinfo_x86 *c)
 172 {
 173         unsigned int trace = 0, l1i = 0, l1d = 0, l2 = 0, l3 = 0; /* Cache sizes */
 174         unsigned int new_l1d = 0, new_l1i = 0; /* Cache sizes from cpuid(4) */
 175         unsigned int new_l2 = 0, new_l3 = 0, i; /* Cache sizes from cpuid(4) */
 176         unsigned int l2_id = 0, l3_id = 0, num_threads_sharing, index_msb;
 177 #ifdef CONFIG_SMP
 178         unsigned int cpu = (c == &boot_cpu_data) ? 0 : (c - cpu_data);
 179 #endif
 180
 181         if (c->cpuid_level > 3) {
 182                 static int is_initialized;
 183
 184                 if (is_initialized == 0) {
 185                         /* Init num_cache_leaves from boot CPU */
 186                         num_cache_leaves = find_num_cache_leaves();
 187                         is_initialized++;
 188                 }
 189
 190                 /*
 191                  * Whenever possible use cpuid(4), deterministic cache
 192                  * parameters cpuid leaf to find the cache details
 193                  */
 194                 for (i = 0; i < num_cache_leaves; i++) {
 195                         struct _cpuid4_info this_leaf;
 196
 197                         int retval;
 198
 199                         retval = cpuid4_cache_lookup(i, &this_leaf);
 200                         if (retval >= 0) {
 201                                 switch(this_leaf.eax.split.level) {
 202                                     case 1:
 203                                         if (this_leaf.eax.split.type ==
 204                                                         CACHE_TYPE_DATA)
 205                                                 new_l1d = this_leaf.size/1024;
 206                                         else if (this_leaf.eax.split.type ==
 207                                                         CACHE_TYPE_INST)
 208                                                 new_l1i = this_leaf.size/1024;
 209                                         break;
 210                                     case 2:
 211                                         new_l2 = this_leaf.size/1024;
 212                                         num_threads_sharing = 1 + this_leaf.eax.split.num_threads_sharing;
 213                                         index_msb = get_count_order(num_threads_sharing);
 214                                         l2_id = c->apicid >> index_msb;
 215                                         break;
 216                                     case 3:
 217                                         new_l3 = this_leaf.size/1024;
 218                                         num_threads_sharing = 1 + this_leaf.eax.split.num_threads_sharing;
 219                                         index_msb = get_count_order(num_threads_sharing);
 220                                         l3_id = c->apicid >> index_msb;
 221                                         break;
 222                                     default:
 223                                         break;
 224                                 }
 225                         }
 226                 }
 227         }
 228         /*
 229          * Don't use cpuid2 if cpuid4 is supported. For P4, we use cpuid2 for
 230          * trace cache
 231          */
 232         if ((num_cache_leaves == 0 || c->x86 == 15) && c->cpuid_level > 1) {
 233                 /* supports eax=2  call */
 234                 int i, j, n;
 235                 int regs[4];
 236                 unsigned char *dp = (unsigned char *)regs;
 237                 int only_trace = 0;
 238
 239                 if (num_cache_leaves != 0 && c->x86 == 15)
 240                         only_trace = 1;
 241
 242                 /* Number of times to iterate */
 243                 n = cpuid_eax(2) & 0xFF;
 244
 245                 for ( i = 0 ; i < n ; i++ ) {
 246                         cpuid(2, &regs[0], &regs[1], &regs[2], &regs[3]);
 247
 248                         /* If bit 31 is set, this is an unknown format */
 249                         for ( j = 0 ; j < 3 ; j++ ) {
 250                                 if ( regs[j] < 0 ) regs[j] = 0;
 251                         }
 252
 253                         /* Byte 0 is level count, not a descriptor */
 254                         for ( j = 1 ; j < 16 ; j++ ) {
 255                                 unsigned char des = dp[j];
 256                                 unsigned char k = 0;
 257
 258                                 /* look up this descriptor in the table */
 259                                 while (cache_table[k].descriptor != 0)
 260                                 {
 261                                         if (cache_table[k].descriptor == des) {
 262                                                 if (only_trace && cache_table[k].cache_type != LVL_TRACE)
 263                                                         break;
 264                                                 switch (cache_table[k].cache_type) {
 265                                                 case LVL_1_INST:
 266                                                         l1i += cache_table[k].size;
 267                                                         break;
 268                                                 case LVL_1_DATA:
 269                                                         l1d += cache_table[k].size;
 270                                                         break;
 271                                                 case LVL_2:
 272                                                         l2 += cache_table[k].size;
 273                                                         break;
 274                                                 case LVL_3:
 275                                                         l3 += cache_table[k].size;
 276                                                         break;
 277                                                 case LVL_TRACE:
 278                                                         trace += cache_table[k].size;
 279                                                         break;
 280                                                 }
 281
 282                                                 break;
 283                                         }
 284
 285                                         k++;
 286                                 }
 287                         }
 288                 }
 289         }
 290
 291         if (new_l1d)
 292                 l1d = new_l1d;
 293
 294         if (new_l1i)
 295                 l1i = new_l1i;
 296
 297         if (new_l2) {
 298                 l2 = new_l2;
 299 #ifdef CONFIG_SMP
 300                 cpu_llc_id[cpu] = l2_id;
 301 #endif
 302         }
 303
 304         if (new_l3) {
 305                 l3 = new_l3;
 306 #ifdef CONFIG_SMP
 307                 cpu_llc_id[cpu] = l3_id;
 308 #endif
 309         }
 310
 311         if (trace)
 312                 printk (KERN_INFO "CPU: Trace cache: %dK uops", trace);
 313         else if ( l1i )
 314                 printk (KERN_INFO "CPU: L1 I cache: %dK", l1i);
 315
 316         if (l1d)
 317                 printk(", L1 D cache: %dK\n", l1d);
 318         else
 319                 printk("\n");
 320
 321         if (l2)
 322                 printk(KERN_INFO "CPU: L2 cache: %dK\n", l2);
 323
 324         if (l3)
 325                 printk(KERN_INFO "CPU: L3 cache: %dK\n", l3);
 326
 327         c->x86_cache_size = l3 ? l3 : (l2 ? l2 : (l1i+l1d));
 328
 329         return l2;
 330 }
 331
 332 /* pointer to _cpuid4_info array (for each cache leaf) */
 333 static struct _cpuid4_info *cpuid4_info[NR_CPUS];
 334 #define CPUID4_INFO_IDX(x,y)    (&((cpuid4_info[x])[y]))
 335
 336 #ifdef CONFIG_SMP
 337 static void __cpuinit cache_shared_cpu_map_setup(unsigned int cpu, int index)
 338 {
 339         struct _cpuid4_info     *this_leaf, *sibling_leaf;
 340         unsigned long num_threads_sharing;
 341         int index_msb, i;
 342         struct cpuinfo_x86 *c = cpu_data;
 343
 344         this_leaf = CPUID4_INFO_IDX(cpu, index);
 345         num_threads_sharing = 1 + this_leaf->eax.split.num_threads_sharing;
 346
 347         if (num_threads_sharing == 1)
 348                 cpu_set(cpu, this_leaf->shared_cpu_map);
 349         else {
 350                 index_msb = get_count_order(num_threads_sharing);
 351
 352                 for_each_online_cpu(i) {
 353                         if (c[i].apicid >> index_msb ==
 354                             c[cpu].apicid >> index_msb) {
 355                                 cpu_set(i, this_leaf->shared_cpu_map);
 356                                 if (i != cpu && cpuid4_info[i])  {
 357                                         sibling_leaf = CPUID4_INFO_IDX(i, index);
 358                                         cpu_set(cpu, sibling_leaf->shared_cpu_map);
 359                                 }
 360                         }
 361                 }
 362         }
 363 }
 364 static void __cpuinit cache_remove_shared_cpu_map(unsigned int cpu, int index)
 365 {
 366         struct _cpuid4_info     *this_leaf, *sibling_leaf;
 367         int sibling;
 368
 369         this_leaf = CPUID4_INFO_IDX(cpu, index);
 370         for_each_cpu_mask(sibling, this_leaf->shared_cpu_map) {
 371                 sibling_leaf = CPUID4_INFO_IDX(sibling, index);
 372                 cpu_clear(cpu, sibling_leaf->shared_cpu_map);
 373         }
 374 }
 375 #else
 376 static void __init cache_shared_cpu_map_setup(unsigned int cpu, int index) {}
 377 static void __init cache_remove_shared_cpu_map(unsigned int cpu, int index) {}
 378 #endif
 379
 380 static void free_cache_attributes(unsigned int cpu)
 381 {
 382         kfree(cpuid4_info[cpu]);
 383         cpuid4_info[cpu] = NULL;
 384 }
 385
 386 static int __cpuinit detect_cache_attributes(unsigned int cpu)
 387 {
 388         struct _cpuid4_info     *this_leaf;
 389         unsigned long           j;
 390         int                     retval;
 391         cpumask_t               oldmask;
 392
 393         if (num_cache_leaves == 0)
 394                 return -ENOENT;
 395
 396         cpuid4_info[cpu] = kmalloc(
 397             sizeof(struct _cpuid4_info) * num_cache_leaves, GFP_KERNEL);
 398         if (unlikely(cpuid4_info[cpu] == NULL))
 399                 return -ENOMEM;
 400         memset(cpuid4_info[cpu], 0,
 401             sizeof(struct _cpuid4_info) * num_cache_leaves);
 402
 403         oldmask = current->cpus_allowed;
 404         retval = set_cpus_allowed(current, cpumask_of_cpu(cpu));
 405         if (retval)
 406                 goto out;
 407
 408         /* Do cpuid and store the results */
 409         retval = 0;
 410         for (j = 0; j < num_cache_leaves; j++) {
 411                 this_leaf = CPUID4_INFO_IDX(cpu, j);
 412                 retval = cpuid4_cache_lookup(j, this_leaf);
 413                 if (unlikely(retval < 0))
 414                         break;
 415                 cache_shared_cpu_map_setup(cpu, j);
 416         }
 417         set_cpus_allowed(current, oldmask);
 418
 419 out:
 420         if (retval)
 421                 free_cache_attributes(cpu);
 422         return retval;
 423 }
 424
 425 #ifdef CONFIG_SYSFS
 426
 427 #include <linux/kobject.h>
 428 #include <linux/sysfs.h>
 429
 430 extern struct sysdev_class cpu_sysdev_class; /* from drivers/base/cpu.c */
 431
 432 /* pointer to kobject for cpuX/cache */
 433 static struct kobject * cache_kobject[NR_CPUS];
 434
 435 struct _index_kobject {
 436         struct kobject kobj;
 437         unsigned int cpu;
 438         unsigned short index;
 439 };
 440
 441 /* pointer to array of kobjects for cpuX/cache/indexY */
 442 static struct _index_kobject *index_kobject[NR_CPUS];
 443 #define INDEX_KOBJECT_PTR(x,y)    (&((index_kobject[x])[y]))
 444
 445 #define show_one_plus(file_name, object, val)                           \
 446 static ssize_t show_##file_name                                         \
 447                         (struct _cpuid4_info *this_leaf, char *buf)     \
 448 {                                                                       \
 449         return sprintf (buf, "%lu\n", (unsigned long)this_leaf->object + val); \
 450 }
 451
 452 show_one_plus(level, eax.split.level, 0);
 453 show_one_plus(coherency_line_size, ebx.split.coherency_line_size, 1);
 454 show_one_plus(physical_line_partition, ebx.split.physical_line_partition, 1);
 455 show_one_plus(ways_of_associativity, ebx.split.ways_of_associativity, 1);
 456 show_one_plus(number_of_sets, ecx.split.number_of_sets, 1);
 457
 458 static ssize_t show_size(struct _cpuid4_info *this_leaf, char *buf)
 459 {
 460         return sprintf (buf, "%luK\n", this_leaf->size / 1024);
 461 }
 462
 463 static ssize_t show_shared_cpu_map(struct _cpuid4_info *this_leaf, char *buf)
 464 {
 465         char mask_str[NR_CPUS];
 466         cpumask_scnprintf(mask_str, NR_CPUS, this_leaf->shared_cpu_map);
 467         return sprintf(buf, "%s\n", mask_str);
 468 }
 469
 470 static ssize_t show_type(struct _cpuid4_info *this_leaf, char *buf) {
 471         switch(this_leaf->eax.split.type) {
 472             case CACHE_TYPE_DATA:
 473                 return sprintf(buf, "Data\n");
 474                 break;
 475             case CACHE_TYPE_INST:
 476                 return sprintf(buf, "Instruction\n");
 477                 break;
 478             case CACHE_TYPE_UNIFIED:
 479                 return sprintf(buf, "Unified\n");
 480                 break;
 481             default:
 482                 return sprintf(buf, "Unknown\n");
 483                 break;
 484         }
 485 }
 486
 487 struct _cache_attr {
 488         struct attribute attr;
 489         ssize_t (*show)(struct _cpuid4_info *, char *);
 490         ssize_t (*store)(struct _cpuid4_info *, const char *, size_t count);
 491 };
 492
 493 #define define_one_ro(_name) \
 494 static struct _cache_attr _name = \
 495         __ATTR(_name, 0444, show_##_name, NULL)
 496
 497 define_one_ro(level);
 498 define_one_ro(type);
 499 define_one_ro(coherency_line_size);
 500 define_one_ro(physical_line_partition);
 501 define_one_ro(ways_of_associativity);
 502 define_one_ro(number_of_sets);
 503 define_one_ro(size);
 504 define_one_ro(shared_cpu_map);
 505
 506 static struct attribute * default_attrs[] = {
 507         &type.attr,
 508         &level.attr,
 509         &coherency_line_size.attr,
 510         &physical_line_partition.attr,
 511         &ways_of_associativity.attr,
 512         &number_of_sets.attr,
 513         &size.attr,
 514         &shared_cpu_map.attr,
 515         NULL
 516 };
 517
 518 #define to_object(k) container_of(k, struct _index_kobject, kobj)
 519 #define to_attr(a) container_of(a, struct _cache_attr, attr)
 520
 521 static ssize_t show(struct kobject * kobj, struct attribute * attr, char * buf)
 522 {
 523         struct _cache_attr *fattr = to_attr(attr);
 524         struct _index_kobject *this_leaf = to_object(kobj);
 525         ssize_t ret;
 526
 527         ret = fattr->show ?
 528                 fattr->show(CPUID4_INFO_IDX(this_leaf->cpu, this_leaf->index),
 529                         buf) :
 530                 0;
 531         return ret;
 532 }
 533
 534 static ssize_t store(struct kobject * kobj, struct attribute * attr,
 535                      const char * buf, size_t count)
 536 {
 537         return 0;
 538 }
 539
 540 static struct sysfs_ops sysfs_ops = {
 541         .show   = show,
 542         .store  = store,
 543 };
 544
 545 static struct kobj_type ktype_cache = {
 546         .sysfs_ops      = &sysfs_ops,
 547         .default_attrs  = default_attrs,
 548 };
 549
 550 static struct kobj_type ktype_percpu_entry = {
 551         .sysfs_ops      = &sysfs_ops,
 552 };
 553
 554 static void cpuid4_cache_sysfs_exit(unsigned int cpu)
 555 {
 556         kfree(cache_kobject[cpu]);
 557         kfree(index_kobject[cpu]);
 558         cache_kobject[cpu] = NULL;
 559         index_kobject[cpu] = NULL;
 560         free_cache_attributes(cpu);
 561 }
 562
 563 static int __cpuinit cpuid4_cache_sysfs_init(unsigned int cpu)
 564 {
 565
 566         if (num_cache_leaves == 0)
 567                 return -ENOENT;
 568
 569         detect_cache_attributes(cpu);
 570         if (cpuid4_info[cpu] == NULL)
 571                 return -ENOENT;
 572
 573         /* Allocate all required memory */
 574         cache_kobject[cpu] = kmalloc(sizeof(struct kobject), GFP_KERNEL);
 575         if (unlikely(cache_kobject[cpu] == NULL))
 576                 goto err_out;
 577         memset(cache_kobject[cpu], 0, sizeof(struct kobject));
 578
 579         index_kobject[cpu] = kmalloc(
 580             sizeof(struct _index_kobject ) * num_cache_leaves, GFP_KERNEL);
 581         if (unlikely(index_kobject[cpu] == NULL))
 582                 goto err_out;
 583         memset(index_kobject[cpu], 0,
 584             sizeof(struct _index_kobject) * num_cache_leaves);
 585
 586         return 0;
 587
 588 err_out:
 589         cpuid4_cache_sysfs_exit(cpu);
 590         return -ENOMEM;
 591 }
 592
 593 /* Add/Remove cache interface for CPU device */
 594 static int __cpuinit cache_add_dev(struct sys_device * sys_dev)
 595 {
 596         unsigned int cpu = sys_dev->id;
 597         unsigned long i, j;
 598         struct _index_kobject *this_object;
 599         int retval = 0;
 600
 601         retval = cpuid4_cache_sysfs_init(cpu);
 602         if (unlikely(retval < 0))
 603                 return retval;
 604
 605         cache_kobject[cpu]->parent = &sys_dev->kobj;
 606         kobject_set_name(cache_kobject[cpu], "%s", "cache");
 607         cache_kobject[cpu]->ktype = &ktype_percpu_entry;
 608         retval = kobject_register(cache_kobject[cpu]);
 609
 610         for (i = 0; i < num_cache_leaves; i++) {
 611                 this_object = INDEX_KOBJECT_PTR(cpu,i);
 612                 this_object->cpu = cpu;
 613                 this_object->index = i;
 614                 this_object->kobj.parent = cache_kobject[cpu];
 615                 kobject_set_name(&(this_object->kobj), "index%1lu", i);
 616                 this_object->kobj.ktype = &ktype_cache;
 617                 retval = kobject_register(&(this_object->kobj));
 618                 if (unlikely(retval)) {
 619                         for (j = 0; j < i; j++) {
 620                                 kobject_unregister(
 621                                         &(INDEX_KOBJECT_PTR(cpu,j)->kobj));
 622                         }
 623                         kobject_unregister(cache_kobject[cpu]);
 624                         cpuid4_cache_sysfs_exit(cpu);
 625                         break;
 626                 }
 627         }
 628         return retval;
 629 }
 630
 631 static void __cpuexit cache_remove_dev(struct sys_device * sys_dev)
 632 {
 633         unsigned int cpu = sys_dev->id;
 634         unsigned long i;
 635
 636         for (i = 0; i < num_cache_leaves; i++) {
 637                 cache_remove_shared_cpu_map(cpu, i);
 638                 kobject_unregister(&(INDEX_KOBJECT_PTR(cpu,i)->kobj));
 639         }
 640         kobject_unregister(cache_kobject[cpu]);
 641         cpuid4_cache_sysfs_exit(cpu);
 642         return;
 643 }
 644
 645 static int cacheinfo_cpu_callback(struct notifier_block *nfb,
 646                                         unsigned long action, void *hcpu)
 647 {
 648         unsigned int cpu = (unsigned long)hcpu;
 649         struct sys_device *sys_dev;
 650
 651         sys_dev = get_cpu_sysdev(cpu);
 652         switch (action) {
 653         case CPU_ONLINE:
 654                 cache_add_dev(sys_dev);
 655                 break;
 656         case CPU_DEAD:
 657                 cache_remove_dev(sys_dev);
 658                 break;
 659         }
 660         return NOTIFY_OK;
 661 }
 662
 663 static struct notifier_block cacheinfo_cpu_notifier =
 664 {
 665     .notifier_call = cacheinfo_cpu_callback,
 666 };
 667
 668 static int __cpuinit cache_sysfs_init(void)
 669 {
 670         int i;
 671
 672         if (num_cache_leaves == 0)
 673                 return 0;
 674
 675         register_cpu_notifier(&cacheinfo_cpu_notifier);
 676
 677         for_each_online_cpu(i) {
 678                 cacheinfo_cpu_callback(&cacheinfo_cpu_notifier, CPU_ONLINE,
 679                         (void *)(long)i);
 680         }
 681
 682         return 0;
 683 }
 684
 685 device_initcall(cache_sysfs_init);
 686
 687 #endif