intel_cacheinfo.c 25.3 KB
Newer Older
L
Linus Torvalds 已提交
1
/*
2
 *	Routines to indentify caches on Intel CPU.
L
Linus Torvalds 已提交
3
 *
4 5
 *	Changes:
 *	Venkatesh Pallipadi	: Adding cache identification through cpuid(4)
6
 *		Ashok Raj <ashok.raj@intel.com>: Work with CPU hotplug infrastructure.
7
 *	Andi Kleen / Andreas Herrmann	: CPUID4 emulation on AMD.
L
Linus Torvalds 已提交
8 9 10 11 12 13 14
 */

#include <linux/init.h>
#include <linux/slab.h>
#include <linux/device.h>
#include <linux/compiler.h>
#include <linux/cpu.h>
T
Tim Schmielau 已提交
15
#include <linux/sched.h>
16
#include <linux/pci.h>
L
Linus Torvalds 已提交
17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34

#include <asm/processor.h>
#include <asm/smp.h>

#define LVL_1_INST	1
#define LVL_1_DATA	2
#define LVL_2		3
#define LVL_3		4
#define LVL_TRACE	5

struct _cache_table
{
	unsigned char descriptor;
	char cache_type;
	short size;
};

/* all the cache descriptor types we care about (no TLB or trace cache entries) */
35
static struct _cache_table cache_table[] __cpuinitdata =
L
Linus Torvalds 已提交
36 37 38 39 40 41 42 43 44 45 46 47
{
	{ 0x06, LVL_1_INST, 8 },	/* 4-way set assoc, 32 byte line size */
	{ 0x08, LVL_1_INST, 16 },	/* 4-way set assoc, 32 byte line size */
	{ 0x0a, LVL_1_DATA, 8 },	/* 2 way set assoc, 32 byte line size */
	{ 0x0c, LVL_1_DATA, 16 },	/* 4-way set assoc, 32 byte line size */
	{ 0x22, LVL_3,      512 },	/* 4-way set assoc, sectored cache, 64 byte line size */
	{ 0x23, LVL_3,      1024 },	/* 8-way set assoc, sectored cache, 64 byte line size */
	{ 0x25, LVL_3,      2048 },	/* 8-way set assoc, sectored cache, 64 byte line size */
	{ 0x29, LVL_3,      4096 },	/* 8-way set assoc, sectored cache, 64 byte line size */
	{ 0x2c, LVL_1_DATA, 32 },	/* 8-way set assoc, 64 byte line size */
	{ 0x30, LVL_1_INST, 32 },	/* 8-way set assoc, 64 byte line size */
	{ 0x39, LVL_2,      128 },	/* 4-way set assoc, sectored cache, 64 byte line size */
48
	{ 0x3a, LVL_2,      192 },	/* 6-way set assoc, sectored cache, 64 byte line size */
L
Linus Torvalds 已提交
49 50
	{ 0x3b, LVL_2,      128 },	/* 2-way set assoc, sectored cache, 64 byte line size */
	{ 0x3c, LVL_2,      256 },	/* 4-way set assoc, sectored cache, 64 byte line size */
51 52
	{ 0x3d, LVL_2,      384 },	/* 6-way set assoc, sectored cache, 64 byte line size */
	{ 0x3e, LVL_2,      512 },	/* 4-way set assoc, sectored cache, 64 byte line size */
53
	{ 0x3f, LVL_2,      256 },	/* 2-way set assoc, 64 byte line size */
L
Linus Torvalds 已提交
54 55 56 57 58
	{ 0x41, LVL_2,      128 },	/* 4-way set assoc, 32 byte line size */
	{ 0x42, LVL_2,      256 },	/* 4-way set assoc, 32 byte line size */
	{ 0x43, LVL_2,      512 },	/* 4-way set assoc, 32 byte line size */
	{ 0x44, LVL_2,      1024 },	/* 4-way set assoc, 32 byte line size */
	{ 0x45, LVL_2,      2048 },	/* 4-way set assoc, 32 byte line size */
59 60 61 62 63 64 65
	{ 0x46, LVL_3,      4096 },	/* 4-way set assoc, 64 byte line size */
	{ 0x47, LVL_3,      8192 },	/* 8-way set assoc, 64 byte line size */
	{ 0x49, LVL_3,      4096 },	/* 16-way set assoc, 64 byte line size */
	{ 0x4a, LVL_3,      6144 },	/* 12-way set assoc, 64 byte line size */
	{ 0x4b, LVL_3,      8192 },	/* 16-way set assoc, 64 byte line size */
	{ 0x4c, LVL_3,     12288 },	/* 12-way set assoc, 64 byte line size */
	{ 0x4d, LVL_3,     16384 },	/* 16-way set assoc, 64 byte line size */
D
Dave Jones 已提交
66
	{ 0x4e, LVL_2,      6144 },	/* 24-way set assoc, 64 byte line size */
L
Linus Torvalds 已提交
67 68 69 70 71 72 73
	{ 0x60, LVL_1_DATA, 16 },	/* 8-way set assoc, sectored cache, 64 byte line size */
	{ 0x66, LVL_1_DATA, 8 },	/* 4-way set assoc, sectored cache, 64 byte line size */
	{ 0x67, LVL_1_DATA, 16 },	/* 4-way set assoc, sectored cache, 64 byte line size */
	{ 0x68, LVL_1_DATA, 32 },	/* 4-way set assoc, sectored cache, 64 byte line size */
	{ 0x70, LVL_TRACE,  12 },	/* 8-way set assoc */
	{ 0x71, LVL_TRACE,  16 },	/* 8-way set assoc */
	{ 0x72, LVL_TRACE,  32 },	/* 8-way set assoc */
74
	{ 0x73, LVL_TRACE,  64 },	/* 8-way set assoc */
L
Linus Torvalds 已提交
75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133
	{ 0x78, LVL_2,    1024 },	/* 4-way set assoc, 64 byte line size */
	{ 0x79, LVL_2,     128 },	/* 8-way set assoc, sectored cache, 64 byte line size */
	{ 0x7a, LVL_2,     256 },	/* 8-way set assoc, sectored cache, 64 byte line size */
	{ 0x7b, LVL_2,     512 },	/* 8-way set assoc, sectored cache, 64 byte line size */
	{ 0x7c, LVL_2,    1024 },	/* 8-way set assoc, sectored cache, 64 byte line size */
	{ 0x7d, LVL_2,    2048 },	/* 8-way set assoc, 64 byte line size */
	{ 0x7f, LVL_2,     512 },	/* 2-way set assoc, 64 byte line size */
	{ 0x82, LVL_2,     256 },	/* 8-way set assoc, 32 byte line size */
	{ 0x83, LVL_2,     512 },	/* 8-way set assoc, 32 byte line size */
	{ 0x84, LVL_2,    1024 },	/* 8-way set assoc, 32 byte line size */
	{ 0x85, LVL_2,    2048 },	/* 8-way set assoc, 32 byte line size */
	{ 0x86, LVL_2,     512 },	/* 4-way set assoc, 64 byte line size */
	{ 0x87, LVL_2,    1024 },	/* 8-way set assoc, 64 byte line size */
	{ 0x00, 0, 0}
};


enum _cache_type
{
	CACHE_TYPE_NULL	= 0,
	CACHE_TYPE_DATA = 1,
	CACHE_TYPE_INST = 2,
	CACHE_TYPE_UNIFIED = 3
};

union _cpuid4_leaf_eax {
	struct {
		enum _cache_type	type:5;
		unsigned int		level:3;
		unsigned int		is_self_initializing:1;
		unsigned int		is_fully_associative:1;
		unsigned int		reserved:4;
		unsigned int		num_threads_sharing:12;
		unsigned int		num_cores_on_die:6;
	} split;
	u32 full;
};

union _cpuid4_leaf_ebx {
	struct {
		unsigned int		coherency_line_size:12;
		unsigned int		physical_line_partition:10;
		unsigned int		ways_of_associativity:10;
	} split;
	u32 full;
};

union _cpuid4_leaf_ecx {
	struct {
		unsigned int		number_of_sets:32;
	} split;
	u32 full;
};

struct _cpuid4_info {
	union _cpuid4_leaf_eax eax;
	union _cpuid4_leaf_ebx ebx;
	union _cpuid4_leaf_ecx ecx;
	unsigned long size;
134
	unsigned long can_disable;
135
	cpumask_t shared_cpu_map;	/* future?: only cpus/node is needed */
L
Linus Torvalds 已提交
136 137
};

138
#ifdef CONFIG_PCI
139
static struct pci_device_id k8_nb_id[] = {
140 141 142
	{ PCI_DEVICE(PCI_VENDOR_ID_AMD, 0x1103) },
	{ PCI_DEVICE(PCI_VENDOR_ID_AMD, 0x1203) },
	{}
143
};
144
#endif
145

146 147 148 149
unsigned short			num_cache_leaves;

/* AMD doesn't have CPUID4. Emulate it here to report the same
   information to the user.  This makes some assumptions about the machine:
150
   L2 not shared, no SMT etc. that is currently true on AMD CPUs.
151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173

   In theory the TLBs could be reported as fake type (they are in "dummy").
   Maybe later */
union l1_cache {
	struct {
		unsigned line_size : 8;
		unsigned lines_per_tag : 8;
		unsigned assoc : 8;
		unsigned size_in_kb : 8;
	};
	unsigned val;
};

union l2_cache {
	struct {
		unsigned line_size : 8;
		unsigned lines_per_tag : 4;
		unsigned assoc : 4;
		unsigned size_in_kb : 16;
	};
	unsigned val;
};

174 175 176 177 178 179 180 181 182 183 184
union l3_cache {
	struct {
		unsigned line_size : 8;
		unsigned lines_per_tag : 4;
		unsigned assoc : 4;
		unsigned res : 2;
		unsigned size_encoded : 14;
	};
	unsigned val;
};

185
static unsigned short assocs[] __cpuinitdata = {
186
	[1] = 1, [2] = 2, [4] = 4, [6] = 8,
187 188
	[8] = 16, [0xa] = 32, [0xb] = 48,
	[0xc] = 64,
189
	[0xf] = 0xffff // ??
190 191
};

192 193
static unsigned char levels[] __cpuinitdata = { 1, 1, 2, 3 };
static unsigned char types[] __cpuinitdata = { 1, 2, 3, 3 };
194

195 196 197 198
static void __cpuinit
amd_cpuid4(int leaf, union _cpuid4_leaf_eax *eax,
		     union _cpuid4_leaf_ebx *ebx,
		     union _cpuid4_leaf_ecx *ecx)
199 200 201 202 203
{
	unsigned dummy;
	unsigned line_size, lines_per_tag, assoc, size_in_kb;
	union l1_cache l1i, l1d;
	union l2_cache l2;
204 205
	union l3_cache l3;
	union l1_cache *l1 = &l1d;
206 207 208 209 210 211

	eax->full = 0;
	ebx->full = 0;
	ecx->full = 0;

	cpuid(0x80000005, &dummy, &dummy, &l1d.val, &l1i.val);
212
	cpuid(0x80000006, &dummy, &dummy, &l2.val, &l3.val);
213

214 215 216 217 218 219
	switch (leaf) {
	case 1:
		l1 = &l1i;
	case 0:
		if (!l1->val)
			return;
220 221 222 223
		assoc = l1->assoc;
		line_size = l1->line_size;
		lines_per_tag = l1->lines_per_tag;
		size_in_kb = l1->size_in_kb;
224 225 226 227
		break;
	case 2:
		if (!l2.val)
			return;
228 229 230 231 232
		assoc = l2.assoc;
		line_size = l2.line_size;
		lines_per_tag = l2.lines_per_tag;
		/* cpu_data has errata corrections for K7 applied */
		size_in_kb = current_cpu_data.x86_cache_size;
233 234 235 236 237 238 239 240 241 242 243
		break;
	case 3:
		if (!l3.val)
			return;
		assoc = l3.assoc;
		line_size = l3.line_size;
		lines_per_tag = l3.lines_per_tag;
		size_in_kb = l3.size_encoded * 512;
		break;
	default:
		return;
244 245
	}

246 247 248 249 250 251 252 253 254 255
	eax->split.is_self_initializing = 1;
	eax->split.type = types[leaf];
	eax->split.level = levels[leaf];
	if (leaf == 3)
		eax->split.num_threads_sharing = current_cpu_data.x86_max_cores - 1;
	else
		eax->split.num_threads_sharing = 0;
	eax->split.num_cores_on_die = current_cpu_data.x86_max_cores - 1;


256 257 258 259 260 261 262 263
	if (assoc == 0xf)
		eax->split.is_fully_associative = 1;
	ebx->split.coherency_line_size = line_size - 1;
	ebx->split.ways_of_associativity = assocs[assoc] - 1;
	ebx->split.physical_line_partition = lines_per_tag - 1;
	ecx->split.number_of_sets = (size_in_kb * 1024) / line_size /
		(ebx->split.ways_of_associativity + 1) - 1;
}
L
Linus Torvalds 已提交
264

265 266
static void __cpuinit
amd_check_l3_disable(int index, struct _cpuid4_info *this_leaf)
267 268 269
{
	if (index < 3)
		return;
270
	this_leaf->can_disable = 1;
271 272
}

273 274
static int
__cpuinit cpuid4_cache_lookup(int index, struct _cpuid4_info *this_leaf)
L
Linus Torvalds 已提交
275
{
276 277 278 279
	union _cpuid4_leaf_eax 	eax;
	union _cpuid4_leaf_ebx 	ebx;
	union _cpuid4_leaf_ecx 	ecx;
	unsigned		edx;
L
Linus Torvalds 已提交
280

281
	if (boot_cpu_data.x86_vendor == X86_VENDOR_AMD) {
282
		amd_cpuid4(index, &eax, &ebx, &ecx);
283 284
		if (boot_cpu_data.x86 >= 0x10)
			amd_check_l3_disable(index, this_leaf);
285 286 287 288
	} else {
		cpuid_count(4, index, &eax.full, &ebx.full, &ecx.full, &edx);
	}

289
	if (eax.split.type == CACHE_TYPE_NULL)
290
		return -EIO; /* better error ? */
L
Linus Torvalds 已提交
291

292 293 294
	this_leaf->eax = eax;
	this_leaf->ebx = ebx;
	this_leaf->ecx = ecx;
295 296 297 298
	this_leaf->size = (ecx.split.number_of_sets          + 1) *
			  (ebx.split.coherency_line_size     + 1) *
			  (ebx.split.physical_line_partition + 1) *
			  (ebx.split.ways_of_associativity   + 1);
L
Linus Torvalds 已提交
299 300 301
	return 0;
}

302
static int __cpuinit find_num_cache_leaves(void)
L
Linus Torvalds 已提交
303 304 305
{
	unsigned int		eax, ebx, ecx, edx;
	union _cpuid4_leaf_eax	cache_eax;
306
	int 			i = -1;
L
Linus Torvalds 已提交
307

308 309 310
	do {
		++i;
		/* Do cpuid(4) loop to find out num_cache_leaves */
L
Linus Torvalds 已提交
311 312
		cpuid_count(4, i, &eax, &ebx, &ecx, &edx);
		cache_eax.full = eax;
313 314
	} while (cache_eax.split.type != CACHE_TYPE_NULL);
	return i;
L
Linus Torvalds 已提交
315 316
}

317
unsigned int __cpuinit init_intel_cacheinfo(struct cpuinfo_x86 *c)
L
Linus Torvalds 已提交
318 319 320 321
{
	unsigned int trace = 0, l1i = 0, l1d = 0, l2 = 0, l3 = 0; /* Cache sizes */
	unsigned int new_l1d = 0, new_l1i = 0; /* Cache sizes from cpuid(4) */
	unsigned int new_l2 = 0, new_l3 = 0, i; /* Cache sizes from cpuid(4) */
322
	unsigned int l2_id = 0, l3_id = 0, num_threads_sharing, index_msb;
323
#ifdef CONFIG_X86_HT
324
	unsigned int cpu = c->cpu_index;
325
#endif
L
Linus Torvalds 已提交
326

327
	if (c->cpuid_level > 3) {
L
Linus Torvalds 已提交
328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357
		static int is_initialized;

		if (is_initialized == 0) {
			/* Init num_cache_leaves from boot CPU */
			num_cache_leaves = find_num_cache_leaves();
			is_initialized++;
		}

		/*
		 * Whenever possible use cpuid(4), deterministic cache
		 * parameters cpuid leaf to find the cache details
		 */
		for (i = 0; i < num_cache_leaves; i++) {
			struct _cpuid4_info this_leaf;

			int retval;

			retval = cpuid4_cache_lookup(i, &this_leaf);
			if (retval >= 0) {
				switch(this_leaf.eax.split.level) {
				    case 1:
					if (this_leaf.eax.split.type ==
							CACHE_TYPE_DATA)
						new_l1d = this_leaf.size/1024;
					else if (this_leaf.eax.split.type ==
							CACHE_TYPE_INST)
						new_l1i = this_leaf.size/1024;
					break;
				    case 2:
					new_l2 = this_leaf.size/1024;
358 359 360
					num_threads_sharing = 1 + this_leaf.eax.split.num_threads_sharing;
					index_msb = get_count_order(num_threads_sharing);
					l2_id = c->apicid >> index_msb;
L
Linus Torvalds 已提交
361 362 363
					break;
				    case 3:
					new_l3 = this_leaf.size/1024;
364 365 366
					num_threads_sharing = 1 + this_leaf.eax.split.num_threads_sharing;
					index_msb = get_count_order(num_threads_sharing);
					l3_id = c->apicid >> index_msb;
L
Linus Torvalds 已提交
367 368 369 370 371 372 373
					break;
				    default:
					break;
				}
			}
		}
	}
374 375 376 377 378
	/*
	 * Don't use cpuid2 if cpuid4 is supported. For P4, we use cpuid2 for
	 * trace cache
	 */
	if ((num_cache_leaves == 0 || c->x86 == 15) && c->cpuid_level > 1) {
L
Linus Torvalds 已提交
379
		/* supports eax=2  call */
380 381
		int j, n;
		unsigned int regs[4];
L
Linus Torvalds 已提交
382
		unsigned char *dp = (unsigned char *)regs;
383 384 385 386
		int only_trace = 0;

		if (num_cache_leaves != 0 && c->x86 == 15)
			only_trace = 1;
L
Linus Torvalds 已提交
387 388 389 390 391 392 393 394 395

		/* Number of times to iterate */
		n = cpuid_eax(2) & 0xFF;

		for ( i = 0 ; i < n ; i++ ) {
			cpuid(2, &regs[0], &regs[1], &regs[2], &regs[3]);

			/* If bit 31 is set, this is an unknown format */
			for ( j = 0 ; j < 3 ; j++ ) {
396
				if (regs[j] & (1 << 31)) regs[j] = 0;
L
Linus Torvalds 已提交
397 398 399 400 401 402 403 404 405 406 407
			}

			/* Byte 0 is level count, not a descriptor */
			for ( j = 1 ; j < 16 ; j++ ) {
				unsigned char des = dp[j];
				unsigned char k = 0;

				/* look up this descriptor in the table */
				while (cache_table[k].descriptor != 0)
				{
					if (cache_table[k].descriptor == des) {
408 409
						if (only_trace && cache_table[k].cache_type != LVL_TRACE)
							break;
L
Linus Torvalds 已提交
410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434
						switch (cache_table[k].cache_type) {
						case LVL_1_INST:
							l1i += cache_table[k].size;
							break;
						case LVL_1_DATA:
							l1d += cache_table[k].size;
							break;
						case LVL_2:
							l2 += cache_table[k].size;
							break;
						case LVL_3:
							l3 += cache_table[k].size;
							break;
						case LVL_TRACE:
							trace += cache_table[k].size;
							break;
						}

						break;
					}

					k++;
				}
			}
		}
435
	}
L
Linus Torvalds 已提交
436

437 438
	if (new_l1d)
		l1d = new_l1d;
L
Linus Torvalds 已提交
439

440 441
	if (new_l1i)
		l1i = new_l1i;
L
Linus Torvalds 已提交
442

443 444
	if (new_l2) {
		l2 = new_l2;
445
#ifdef CONFIG_X86_HT
446
		per_cpu(cpu_llc_id, cpu) = l2_id;
447
#endif
448
	}
L
Linus Torvalds 已提交
449

450 451
	if (new_l3) {
		l3 = new_l3;
452
#ifdef CONFIG_X86_HT
453
		per_cpu(cpu_llc_id, cpu) = l3_id;
454
#endif
L
Linus Torvalds 已提交
455 456
	}

457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474
	if (trace)
		printk (KERN_INFO "CPU: Trace cache: %dK uops", trace);
	else if ( l1i )
		printk (KERN_INFO "CPU: L1 I cache: %dK", l1i);

	if (l1d)
		printk(", L1 D cache: %dK\n", l1d);
	else
		printk("\n");

	if (l2)
		printk(KERN_INFO "CPU: L2 cache: %dK\n", l2);

	if (l3)
		printk(KERN_INFO "CPU: L3 cache: %dK\n", l3);

	c->x86_cache_size = l3 ? l3 : (l2 ? l2 : (l1i+l1d));

L
Linus Torvalds 已提交
475 476 477 478
	return l2;
}

/* pointer to _cpuid4_info array (for each cache leaf) */
479
static DEFINE_PER_CPU(struct _cpuid4_info *, cpuid4_info);
480
#define CPUID4_INFO_IDX(x, y)	(&((per_cpu(cpuid4_info, x))[y]))
L
Linus Torvalds 已提交
481 482

#ifdef CONFIG_SMP
483
static void __cpuinit cache_shared_cpu_map_setup(unsigned int cpu, int index)
L
Linus Torvalds 已提交
484
{
485
	struct _cpuid4_info	*this_leaf, *sibling_leaf;
L
Linus Torvalds 已提交
486
	unsigned long num_threads_sharing;
487
	int index_msb, i;
488
	struct cpuinfo_x86 *c = &cpu_data(cpu);
L
Linus Torvalds 已提交
489 490 491 492 493 494

	this_leaf = CPUID4_INFO_IDX(cpu, index);
	num_threads_sharing = 1 + this_leaf->eax.split.num_threads_sharing;

	if (num_threads_sharing == 1)
		cpu_set(cpu, this_leaf->shared_cpu_map);
495 496 497 498
	else {
		index_msb = get_count_order(num_threads_sharing);

		for_each_online_cpu(i) {
499 500
			if (cpu_data(i).apicid >> index_msb ==
			    c->apicid >> index_msb) {
501
				cpu_set(i, this_leaf->shared_cpu_map);
502
				if (i != cpu && per_cpu(cpuid4_info, i))  {
503 504 505 506 507 508 509
					sibling_leaf = CPUID4_INFO_IDX(i, index);
					cpu_set(cpu, sibling_leaf->shared_cpu_map);
				}
			}
		}
	}
}
510
static void __cpuinit cache_remove_shared_cpu_map(unsigned int cpu, int index)
511 512 513 514 515
{
	struct _cpuid4_info	*this_leaf, *sibling_leaf;
	int sibling;

	this_leaf = CPUID4_INFO_IDX(cpu, index);
516
	for_each_cpu_mask_nr(sibling, this_leaf->shared_cpu_map) {
517
		sibling_leaf = CPUID4_INFO_IDX(sibling, index);
518 519
		cpu_clear(cpu, sibling_leaf->shared_cpu_map);
	}
L
Linus Torvalds 已提交
520 521
}
#else
522 523
static void __cpuinit cache_shared_cpu_map_setup(unsigned int cpu, int index) {}
static void __cpuinit cache_remove_shared_cpu_map(unsigned int cpu, int index) {}
L
Linus Torvalds 已提交
524 525
#endif

526
static void __cpuinit free_cache_attributes(unsigned int cpu)
L
Linus Torvalds 已提交
527
{
528 529 530 531 532
	int i;

	for (i = 0; i < num_cache_leaves; i++)
		cache_remove_shared_cpu_map(cpu, i);

533 534
	kfree(per_cpu(cpuid4_info, cpu));
	per_cpu(cpuid4_info, cpu) = NULL;
L
Linus Torvalds 已提交
535 536
}

537
static int __cpuinit detect_cache_attributes(unsigned int cpu)
L
Linus Torvalds 已提交
538 539
{
	struct _cpuid4_info	*this_leaf;
540 541
	unsigned long		j;
	int			retval;
542
	cpumask_t		oldmask;
L
Linus Torvalds 已提交
543 544 545 546

	if (num_cache_leaves == 0)
		return -ENOENT;

547
	per_cpu(cpuid4_info, cpu) = kzalloc(
L
Linus Torvalds 已提交
548
	    sizeof(struct _cpuid4_info) * num_cache_leaves, GFP_KERNEL);
549
	if (per_cpu(cpuid4_info, cpu) == NULL)
L
Linus Torvalds 已提交
550 551
		return -ENOMEM;

552
	oldmask = current->cpus_allowed;
553
	retval = set_cpus_allowed_ptr(current, &cpumask_of_cpu(cpu));
554 555 556
	if (retval)
		goto out;

L
Linus Torvalds 已提交
557 558 559 560
	/* Do cpuid and store the results */
	for (j = 0; j < num_cache_leaves; j++) {
		this_leaf = CPUID4_INFO_IDX(cpu, j);
		retval = cpuid4_cache_lookup(j, this_leaf);
561 562 563 564 565
		if (unlikely(retval < 0)) {
			int i;

			for (i = 0; i < j; i++)
				cache_remove_shared_cpu_map(cpu, i);
566
			break;
567
		}
L
Linus Torvalds 已提交
568 569
		cache_shared_cpu_map_setup(cpu, j);
	}
570
	set_cpus_allowed_ptr(current, &oldmask);
L
Linus Torvalds 已提交
571

572
out:
573
	if (retval) {
574 575
		kfree(per_cpu(cpuid4_info, cpu));
		per_cpu(cpuid4_info, cpu) = NULL;
576 577
	}

578
	return retval;
L
Linus Torvalds 已提交
579 580 581 582 583 584 585 586 587 588
}

#ifdef CONFIG_SYSFS

#include <linux/kobject.h>
#include <linux/sysfs.h>

extern struct sysdev_class cpu_sysdev_class; /* from drivers/base/cpu.c */

/* pointer to kobject for cpuX/cache */
589
static DEFINE_PER_CPU(struct kobject *, cache_kobject);
L
Linus Torvalds 已提交
590 591 592 593 594 595 596 597

struct _index_kobject {
	struct kobject kobj;
	unsigned int cpu;
	unsigned short index;
};

/* pointer to array of kobjects for cpuX/cache/indexY */
598
static DEFINE_PER_CPU(struct _index_kobject *, index_kobject);
599
#define INDEX_KOBJECT_PTR(x, y)		(&((per_cpu(index_kobject, x))[y]))
L
Linus Torvalds 已提交
600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618

#define show_one_plus(file_name, object, val)				\
static ssize_t show_##file_name						\
			(struct _cpuid4_info *this_leaf, char *buf)	\
{									\
	return sprintf (buf, "%lu\n", (unsigned long)this_leaf->object + val); \
}

show_one_plus(level, eax.split.level, 0);
show_one_plus(coherency_line_size, ebx.split.coherency_line_size, 1);
show_one_plus(physical_line_partition, ebx.split.physical_line_partition, 1);
show_one_plus(ways_of_associativity, ebx.split.ways_of_associativity, 1);
show_one_plus(number_of_sets, ecx.split.number_of_sets, 1);

static ssize_t show_size(struct _cpuid4_info *this_leaf, char *buf)
{
	return sprintf (buf, "%luK\n", this_leaf->size / 1024);
}

619 620
static ssize_t show_shared_cpu_map_func(struct _cpuid4_info *this_leaf,
					int type, char *buf)
L
Linus Torvalds 已提交
621
{
622
	ptrdiff_t len = PTR_ALIGN(buf + PAGE_SIZE - 1, PAGE_SIZE) - buf;
623 624
	int n = 0;

625 626 627 628
	if (len > 1) {
		cpumask_t *mask = &this_leaf->shared_cpu_map;

		n = type?
629 630
			cpulist_scnprintf(buf, len-2, mask) :
			cpumask_scnprintf(buf, len-2, mask);
631 632
		buf[n++] = '\n';
		buf[n] = '\0';
633 634
	}
	return n;
L
Linus Torvalds 已提交
635 636
}

637 638 639 640 641 642 643 644 645 646
static inline ssize_t show_shared_cpu_map(struct _cpuid4_info *leaf, char *buf)
{
	return show_shared_cpu_map_func(leaf, 0, buf);
}

static inline ssize_t show_shared_cpu_list(struct _cpuid4_info *leaf, char *buf)
{
	return show_shared_cpu_map_func(leaf, 1, buf);
}

L
Linus Torvalds 已提交
647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663
static ssize_t show_type(struct _cpuid4_info *this_leaf, char *buf) {
	switch(this_leaf->eax.split.type) {
	    case CACHE_TYPE_DATA:
		return sprintf(buf, "Data\n");
		break;
	    case CACHE_TYPE_INST:
		return sprintf(buf, "Instruction\n");
		break;
	    case CACHE_TYPE_UNIFIED:
		return sprintf(buf, "Unified\n");
		break;
	    default:
		return sprintf(buf, "Unknown\n");
		break;
	}
}

664 665
#define to_object(k)	container_of(k, struct _index_kobject, kobj)
#define to_attr(a)	container_of(a, struct _cache_attr, attr)
666

667
#ifdef CONFIG_PCI
668 669 670 671 672 673 674 675 676 677 678 679 680 681
static struct pci_dev *get_k8_northbridge(int node)
{
	struct pci_dev *dev = NULL;
	int i;

	for (i = 0; i <= node; i++) {
		do {
			dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, dev);
			if (!dev)
				break;
		} while (!pci_match_id(&k8_nb_id[0], dev));
		if (!dev)
			break;
	}
682
	return dev;
683
}
684 685 686 687 688 689
#else
static struct pci_dev *get_k8_northbridge(int node)
{
	return NULL;
}
#endif
690

691 692
static ssize_t show_cache_disable(struct _cpuid4_info *this_leaf, char *buf)
{
693
	int node = cpu_to_node(first_cpu(this_leaf->shared_cpu_map));
694
	struct pci_dev *dev = NULL;
695 696
	ssize_t ret = 0;
	int i;
697

698 699 700
	if (!this_leaf->can_disable)
		return sprintf(buf, "Feature not enabled\n");

701 702 703 704 705 706
	dev = get_k8_northbridge(node);
	if (!dev) {
		printk(KERN_ERR "Attempting AMD northbridge operation on a system with no northbridge\n");
		return -EINVAL;
	}

707 708 709 710 711 712 713 714 715 716 717 718
	for (i = 0; i < 2; i++) {
		unsigned int reg;

		pci_read_config_dword(dev, 0x1BC + i * 4, &reg);

		ret += sprintf(buf, "%sEntry: %d\n", buf, i);
		ret += sprintf(buf, "%sReads:  %s\tNew Entries: %s\n",  
			buf,
			reg & 0x80000000 ? "Disabled" : "Allowed",
			reg & 0x40000000 ? "Disabled" : "Allowed");
		ret += sprintf(buf, "%sSubCache: %x\tIndex: %x\n",
			buf, (reg & 0x30000) >> 16, reg & 0xfff);
719
	}
720
	return ret;
721 722
}

723 724 725
static ssize_t
store_cache_disable(struct _cpuid4_info *this_leaf, const char *buf,
		    size_t count)
726
{
727
	int node = cpu_to_node(first_cpu(this_leaf->shared_cpu_map));
728
	struct pci_dev *dev = NULL;
729 730 731 732 733 734 735 736 737 738 739 740 741 742 743
	unsigned int ret, index, val;

	if (!this_leaf->can_disable)
		return 0;

	if (strlen(buf) > 15)
		return -EINVAL;

	ret = sscanf(buf, "%x %x", &index, &val);
	if (ret != 2)
		return -EINVAL;
	if (index > 1)
		return -EINVAL;

	val |= 0xc0000000;
744 745 746 747 748
	dev = get_k8_northbridge(node);
	if (!dev) {
		printk(KERN_ERR "Attempting AMD northbridge operation on a system with no northbridge\n");
		return -EINVAL;
	}
749

750 751 752 753 754
	pci_write_config_dword(dev, 0x1BC + index * 4, val & ~0x40000000);
	wbinvd();
	pci_write_config_dword(dev, 0x1BC + index * 4, val);

	return 1;
755 756
}

L
Linus Torvalds 已提交
757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774
struct _cache_attr {
	struct attribute attr;
	ssize_t (*show)(struct _cpuid4_info *, char *);
	ssize_t (*store)(struct _cpuid4_info *, const char *, size_t count);
};

#define define_one_ro(_name) \
static struct _cache_attr _name = \
	__ATTR(_name, 0444, show_##_name, NULL)

define_one_ro(level);
define_one_ro(type);
define_one_ro(coherency_line_size);
define_one_ro(physical_line_partition);
define_one_ro(ways_of_associativity);
define_one_ro(number_of_sets);
define_one_ro(size);
define_one_ro(shared_cpu_map);
775
define_one_ro(shared_cpu_list);
L
Linus Torvalds 已提交
776

777 778
static struct _cache_attr cache_disable = __ATTR(cache_disable, 0644, show_cache_disable, store_cache_disable);

L
Linus Torvalds 已提交
779 780 781 782 783 784 785 786 787
static struct attribute * default_attrs[] = {
	&type.attr,
	&level.attr,
	&coherency_line_size.attr,
	&physical_line_partition.attr,
	&ways_of_associativity.attr,
	&number_of_sets.attr,
	&size.attr,
	&shared_cpu_map.attr,
788
	&shared_cpu_list.attr,
789
	&cache_disable.attr,
L
Linus Torvalds 已提交
790 791 792 793 794 795 796 797 798 799 800 801
	NULL
};

static ssize_t show(struct kobject * kobj, struct attribute * attr, char * buf)
{
	struct _cache_attr *fattr = to_attr(attr);
	struct _index_kobject *this_leaf = to_object(kobj);
	ssize_t ret;

	ret = fattr->show ?
		fattr->show(CPUID4_INFO_IDX(this_leaf->cpu, this_leaf->index),
			buf) :
802
		0;
L
Linus Torvalds 已提交
803 804 805 806 807 808
	return ret;
}

static ssize_t store(struct kobject * kobj, struct attribute * attr,
		     const char * buf, size_t count)
{
809 810 811 812
	struct _cache_attr *fattr = to_attr(attr);
	struct _index_kobject *this_leaf = to_object(kobj);
	ssize_t ret;

813 814 815
	ret = fattr->store ?
		fattr->store(CPUID4_INFO_IDX(this_leaf->cpu, this_leaf->index),
			buf, count) :
816 817
		0;
	return ret;
L
Linus Torvalds 已提交
818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833
}

static struct sysfs_ops sysfs_ops = {
	.show   = show,
	.store  = store,
};

static struct kobj_type ktype_cache = {
	.sysfs_ops	= &sysfs_ops,
	.default_attrs	= default_attrs,
};

static struct kobj_type ktype_percpu_entry = {
	.sysfs_ops	= &sysfs_ops,
};

834
static void __cpuinit cpuid4_cache_sysfs_exit(unsigned int cpu)
L
Linus Torvalds 已提交
835
{
836 837 838 839
	kfree(per_cpu(cache_kobject, cpu));
	kfree(per_cpu(index_kobject, cpu));
	per_cpu(cache_kobject, cpu) = NULL;
	per_cpu(index_kobject, cpu) = NULL;
L
Linus Torvalds 已提交
840 841 842
	free_cache_attributes(cpu);
}

843
static int __cpuinit cpuid4_cache_sysfs_init(unsigned int cpu)
L
Linus Torvalds 已提交
844
{
845
	int err;
L
Linus Torvalds 已提交
846 847 848 849

	if (num_cache_leaves == 0)
		return -ENOENT;

850 851 852
	err = detect_cache_attributes(cpu);
	if (err)
		return err;
L
Linus Torvalds 已提交
853 854

	/* Allocate all required memory */
855 856 857
	per_cpu(cache_kobject, cpu) =
		kzalloc(sizeof(struct kobject), GFP_KERNEL);
	if (unlikely(per_cpu(cache_kobject, cpu) == NULL))
L
Linus Torvalds 已提交
858 859
		goto err_out;

860
	per_cpu(index_kobject, cpu) = kzalloc(
L
Linus Torvalds 已提交
861
	    sizeof(struct _index_kobject ) * num_cache_leaves, GFP_KERNEL);
862
	if (unlikely(per_cpu(index_kobject, cpu) == NULL))
L
Linus Torvalds 已提交
863 864 865 866 867 868 869 870 871
		goto err_out;

	return 0;

err_out:
	cpuid4_cache_sysfs_exit(cpu);
	return -ENOMEM;
}

872 873
static cpumask_t cache_dev_map = CPU_MASK_NONE;

L
Linus Torvalds 已提交
874
/* Add/Remove cache interface for CPU device */
875
static int __cpuinit cache_add_dev(struct sys_device * sys_dev)
L
Linus Torvalds 已提交
876 877 878 879
{
	unsigned int cpu = sys_dev->id;
	unsigned long i, j;
	struct _index_kobject *this_object;
880
	int retval;
L
Linus Torvalds 已提交
881 882 883 884 885

	retval = cpuid4_cache_sysfs_init(cpu);
	if (unlikely(retval < 0))
		return retval;

886 887
	retval = kobject_init_and_add(per_cpu(cache_kobject, cpu),
				      &ktype_percpu_entry,
888
				      &sys_dev->kobj, "%s", "cache");
889 890 891 892
	if (retval < 0) {
		cpuid4_cache_sysfs_exit(cpu);
		return retval;
	}
L
Linus Torvalds 已提交
893 894 895 896 897

	for (i = 0; i < num_cache_leaves; i++) {
		this_object = INDEX_KOBJECT_PTR(cpu,i);
		this_object->cpu = cpu;
		this_object->index = i;
898
		retval = kobject_init_and_add(&(this_object->kobj),
899 900
					      &ktype_cache,
					      per_cpu(cache_kobject, cpu),
901
					      "index%1lu", i);
L
Linus Torvalds 已提交
902 903
		if (unlikely(retval)) {
			for (j = 0; j < i; j++) {
904
				kobject_put(&(INDEX_KOBJECT_PTR(cpu,j)->kobj));
L
Linus Torvalds 已提交
905
			}
906
			kobject_put(per_cpu(cache_kobject, cpu));
L
Linus Torvalds 已提交
907
			cpuid4_cache_sysfs_exit(cpu);
908
			return retval;
L
Linus Torvalds 已提交
909
		}
910
		kobject_uevent(&(this_object->kobj), KOBJ_ADD);
L
Linus Torvalds 已提交
911
	}
912
	cpu_set(cpu, cache_dev_map);
913

914
	kobject_uevent(per_cpu(cache_kobject, cpu), KOBJ_ADD);
915
	return 0;
L
Linus Torvalds 已提交
916 917
}

918
static void __cpuinit cache_remove_dev(struct sys_device * sys_dev)
L
Linus Torvalds 已提交
919 920 921 922
{
	unsigned int cpu = sys_dev->id;
	unsigned long i;

923
	if (per_cpu(cpuid4_info, cpu) == NULL)
924
		return;
925 926 927 928 929
	if (!cpu_isset(cpu, cache_dev_map))
		return;
	cpu_clear(cpu, cache_dev_map);

	for (i = 0; i < num_cache_leaves; i++)
930
		kobject_put(&(INDEX_KOBJECT_PTR(cpu,i)->kobj));
931
	kobject_put(per_cpu(cache_kobject, cpu));
L
Linus Torvalds 已提交
932
	cpuid4_cache_sysfs_exit(cpu);
933 934
}

935
static int __cpuinit cacheinfo_cpu_callback(struct notifier_block *nfb,
936 937 938 939 940 941 942 943
					unsigned long action, void *hcpu)
{
	unsigned int cpu = (unsigned long)hcpu;
	struct sys_device *sys_dev;

	sys_dev = get_cpu_sysdev(cpu);
	switch (action) {
	case CPU_ONLINE:
944
	case CPU_ONLINE_FROZEN:
945 946 947
		cache_add_dev(sys_dev);
		break;
	case CPU_DEAD:
948
	case CPU_DEAD_FROZEN:
949 950 951 952
		cache_remove_dev(sys_dev);
		break;
	}
	return NOTIFY_OK;
L
Linus Torvalds 已提交
953 954
}

955
static struct notifier_block __cpuinitdata cacheinfo_cpu_notifier =
956
{
957
	.notifier_call = cacheinfo_cpu_callback,
L
Linus Torvalds 已提交
958 959
};

960
static int __cpuinit cache_sysfs_init(void)
L
Linus Torvalds 已提交
961
{
962 963
	int i;

L
Linus Torvalds 已提交
964 965 966
	if (num_cache_leaves == 0)
		return 0;

967
	for_each_online_cpu(i) {
968 969
		int err;
		struct sys_device *sys_dev = get_cpu_sysdev(i);
970

971 972 973
		err = cache_add_dev(sys_dev);
		if (err)
			return err;
974
	}
975
	register_hotcpu_notifier(&cacheinfo_cpu_notifier);
976
	return 0;
L
Linus Torvalds 已提交
977 978
}

979
device_initcall(cache_sysfs_init);
L
Linus Torvalds 已提交
980 981

#endif