microcode_amd.c 8.2 KB
Newer Older
1
2
3
4
5
6
7
8
9
10
11
12
/*
 *  AMD CPU Microcode Update Driver for Linux
 *  Copyright (C) 2008 Advanced Micro Devices Inc.
 *
 *  Author: Peter Oruba <peter.oruba@amd.com>
 *
 *  Based on work by:
 *  Tigran Aivazian <tigran@aivazian.fsnet.co.uk>
 *
 *  This driver allows to upgrade microcode on AMD
 *  family 0x10 and 0x11 processors.
 *
13
 *  Licensed under the terms of the GNU General Public
14
 *  License version 2. See file COPYING for details.
Ingo Molnar's avatar
Ingo Molnar committed
15
 */
16
17
18

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

Ingo Molnar's avatar
Ingo Molnar committed
19
20
21
22
23
24
#include <linux/firmware.h>
#include <linux/pci_ids.h>
#include <linux/uaccess.h>
#include <linux/vmalloc.h>
#include <linux/kernel.h>
#include <linux/module.h>
25
26
27
#include <linux/pci.h>

#include <asm/microcode.h>
Ingo Molnar's avatar
Ingo Molnar committed
28
29
#include <asm/processor.h>
#include <asm/msr.h>
30
31

MODULE_DESCRIPTION("AMD Microcode Update Driver");
32
MODULE_AUTHOR("Peter Oruba");
33
MODULE_LICENSE("GPL v2");
34
35
36
37
38

#define UCODE_MAGIC                0x00414d44
#define UCODE_EQUIV_CPU_TABLE_TYPE 0x00000000
#define UCODE_UCODE_TYPE           0x00000001

39
const struct firmware *firmware;
40
static int supported_cpu;
41

42
struct equiv_cpu_entry {
43
44
45
46
47
48
	u32	installed_cpu;
	u32	fixed_errata_mask;
	u32	fixed_errata_compare;
	u16	equiv_cpu;
	u16	res;
} __attribute__((packed));
49
50

struct microcode_header_amd {
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
	u32	data_code;
	u32	patch_id;
	u16	mc_patch_data_id;
	u8	mc_patch_data_len;
	u8	init_flag;
	u32	mc_patch_data_checksum;
	u32	nb_dev_id;
	u32	sb_dev_id;
	u16	processor_rev_id;
	u8	nb_rev_id;
	u8	sb_rev_id;
	u8	bios_api_rev;
	u8	reserved1[3];
	u32	match_reg[8];
} __attribute__((packed));
66
67

struct microcode_amd {
Ingo Molnar's avatar
Ingo Molnar committed
68
69
	struct microcode_header_amd	hdr;
	unsigned int			mpb[0];
70
71
};

72
73
74
#define UCODE_MAX_SIZE			2048
#define UCODE_CONTAINER_SECTION_HDR	8
#define UCODE_CONTAINER_HEADER_SIZE	12
75

Dmitry Adamushko's avatar
Dmitry Adamushko committed
76
static struct equiv_cpu_entry *equiv_cpu_table;
77

78
static int collect_cpu_info_amd(int cpu, struct cpu_signature *csig)
79
{
80
	u32 dummy;
81

82
	if (!supported_cpu)
83
		return -1;
84
85

	memset(csig, 0, sizeof(*csig));
86
	rdmsr(MSR_AMD64_PATCH_LEVEL, csig->rev, dummy);
87
	pr_info("CPU%d: patch_level=0x%x\n", cpu, csig->rev);
88
	return 0;
89
90
}

Dmitry Adamushko's avatar
Dmitry Adamushko committed
91
static int get_matching_microcode(int cpu, void *mc, int rev)
92
93
94
{
	struct microcode_header_amd *mc_header = mc;
	unsigned int current_cpu_id;
95
	u16 equiv_cpu_id = 0;
96
97
	unsigned int i = 0;

Dmitry Adamushko's avatar
Dmitry Adamushko committed
98
	BUG_ON(equiv_cpu_table == NULL);
99
100
101
102
	current_cpu_id = cpuid_eax(0x00000001);

	while (equiv_cpu_table[i].installed_cpu != 0) {
		if (current_cpu_id == equiv_cpu_table[i].installed_cpu) {
103
			equiv_cpu_id = equiv_cpu_table[i].equiv_cpu;
104
105
106
107
108
			break;
		}
		i++;
	}

109
	if (!equiv_cpu_id)
110
111
		return 0;

112
	if (mc_header->processor_rev_id != equiv_cpu_id)
113
114
		return 0;

115
116
	/* ucode might be chipset specific -- currently we don't support this */
	if (mc_header->nb_dev_id || mc_header->sb_dev_id) {
117
118
		pr_err("CPU%d: loading of chipset specific code not yet supported\n",
		       cpu);
119
		return 0;
120
121
	}

Dmitry Adamushko's avatar
Dmitry Adamushko committed
122
	if (mc_header->patch_id <= rev)
123
124
125
126
127
		return 0;

	return 1;
}

128
static int apply_microcode_amd(int cpu)
129
{
130
	u32 rev, dummy;
131
132
	int cpu_num = raw_smp_processor_id();
	struct ucode_cpu_info *uci = ucode_cpu_info + cpu_num;
133
	struct microcode_amd *mc_amd = uci->mc;
134
135
136
137

	/* We should bind the task to the CPU */
	BUG_ON(cpu_num != cpu);

138
	if (mc_amd == NULL)
139
		return 0;
140

141
	wrmsrl(MSR_AMD64_PATCH_LOADER, (u64)(long)&mc_amd->hdr.data_code);
142
	/* get patch id after patching */
143
	rdmsr(MSR_AMD64_PATCH_LEVEL, rev, dummy);
144
145

	/* check current patch id and patch's id for match */
146
	if (rev != mc_amd->hdr.patch_id) {
147
148
		pr_err("CPU%d: update failed (for patch_level=0x%x)\n",
		       cpu, mc_amd->hdr.patch_id);
149
		return -1;
150
151
	}

152
	pr_info("CPU%d: updated (new patch_level=0x%x)\n", cpu, rev);
153
	uci->cpu_sig.rev = rev;
154
155

	return 0;
156
157
}

158
159
160
161
162
163
static int get_ucode_data(void *to, const u8 *from, size_t n)
{
	memcpy(to, from, n);
	return 0;
}

Ingo Molnar's avatar
Ingo Molnar committed
164
165
static void *
get_next_ucode(const u8 *buf, unsigned int size, unsigned int *mc_size)
166
{
Dmitry Adamushko's avatar
Dmitry Adamushko committed
167
	unsigned int total_size;
168
	u8 section_hdr[UCODE_CONTAINER_SECTION_HDR];
Dmitry Adamushko's avatar
Dmitry Adamushko committed
169
	void *mc;
170

171
	if (get_ucode_data(section_hdr, buf, UCODE_CONTAINER_SECTION_HDR))
Dmitry Adamushko's avatar
Dmitry Adamushko committed
172
		return NULL;
173

174
	if (section_hdr[0] != UCODE_UCODE_TYPE) {
175
		pr_err("error: invalid type field in container file section header\n");
Dmitry Adamushko's avatar
Dmitry Adamushko committed
176
		return NULL;
177
178
	}

179
	total_size = (unsigned long) (section_hdr[4] + (section_hdr[5] << 8));
180

Dmitry Adamushko's avatar
Dmitry Adamushko committed
181
	if (total_size > size || total_size > UCODE_MAX_SIZE) {
182
		pr_err("error: size mismatch\n");
Dmitry Adamushko's avatar
Dmitry Adamushko committed
183
		return NULL;
184
185
	}

Dmitry Adamushko's avatar
Dmitry Adamushko committed
186
187
188
	mc = vmalloc(UCODE_MAX_SIZE);
	if (mc) {
		memset(mc, 0, UCODE_MAX_SIZE);
189
190
		if (get_ucode_data(mc, buf + UCODE_CONTAINER_SECTION_HDR,
				   total_size)) {
Dmitry Adamushko's avatar
Dmitry Adamushko committed
191
192
193
			vfree(mc);
			mc = NULL;
		} else
194
			*mc_size = total_size + UCODE_CONTAINER_SECTION_HDR;
195
	}
Dmitry Adamushko's avatar
Dmitry Adamushko committed
196
	return mc;
197
198
}

199
static int install_equiv_cpu_table(const u8 *buf)
200
{
201
202
	u8 *container_hdr[UCODE_CONTAINER_HEADER_SIZE];
	unsigned int *buf_pos = (unsigned int *)container_hdr;
Dmitry Adamushko's avatar
Dmitry Adamushko committed
203
	unsigned long size;
204

205
	if (get_ucode_data(&container_hdr, buf, UCODE_CONTAINER_HEADER_SIZE))
206
207
		return 0;

Dmitry Adamushko's avatar
Dmitry Adamushko committed
208
	size = buf_pos[2];
209

Dmitry Adamushko's avatar
Dmitry Adamushko committed
210
	if (buf_pos[1] != UCODE_EQUIV_CPU_TABLE_TYPE || !size) {
211
		pr_err("error: invalid type field in container file section header\n");
212
213
214
215
216
		return 0;
	}

	equiv_cpu_table = (struct equiv_cpu_entry *) vmalloc(size);
	if (!equiv_cpu_table) {
217
		pr_err("failed to allocate equivalent CPU table\n");
218
219
220
		return 0;
	}

221
	buf += UCODE_CONTAINER_HEADER_SIZE;
Dmitry Adamushko's avatar
Dmitry Adamushko committed
222
223
224
225
	if (get_ucode_data(equiv_cpu_table, buf, size)) {
		vfree(equiv_cpu_table);
		return 0;
	}
226

227
	return size + UCODE_CONTAINER_HEADER_SIZE; /* add header length */
228
229
}

Dmitry Adamushko's avatar
Dmitry Adamushko committed
230
static void free_equiv_cpu_table(void)
231
{
232
233
	vfree(equiv_cpu_table);
	equiv_cpu_table = NULL;
Dmitry Adamushko's avatar
Dmitry Adamushko committed
234
}
235

236
237
static enum ucode_state
generic_load_microcode(int cpu, const u8 *data, size_t size)
Dmitry Adamushko's avatar
Dmitry Adamushko committed
238
239
{
	struct ucode_cpu_info *uci = ucode_cpu_info + cpu;
240
241
242
	const u8 *ucode_ptr = data;
	void *new_mc = NULL;
	void *mc;
Dmitry Adamushko's avatar
Dmitry Adamushko committed
243
244
245
	int new_rev = uci->cpu_sig.rev;
	unsigned int leftover;
	unsigned long offset;
246
	enum ucode_state state = UCODE_OK;
247

248
	offset = install_equiv_cpu_table(ucode_ptr);
249
	if (!offset) {
250
		pr_err("failed to create equivalent cpu table\n");
251
		return UCODE_ERROR;
252
253
	}

Dmitry Adamushko's avatar
Dmitry Adamushko committed
254
255
256
257
	ucode_ptr += offset;
	leftover = size - offset;

	while (leftover) {
258
		unsigned int uninitialized_var(mc_size);
Dmitry Adamushko's avatar
Dmitry Adamushko committed
259
260
		struct microcode_header_amd *mc_header;

261
		mc = get_next_ucode(ucode_ptr, leftover, &mc_size);
Dmitry Adamushko's avatar
Dmitry Adamushko committed
262
		if (!mc)
263
			break;
Dmitry Adamushko's avatar
Dmitry Adamushko committed
264
265
266

		mc_header = (struct microcode_header_amd *)mc;
		if (get_matching_microcode(cpu, mc, new_rev)) {
267
			vfree(new_mc);
Dmitry Adamushko's avatar
Dmitry Adamushko committed
268
269
			new_rev = mc_header->patch_id;
			new_mc  = mc;
270
		} else
Dmitry Adamushko's avatar
Dmitry Adamushko committed
271
272
273
274
			vfree(mc);

		ucode_ptr += mc_size;
		leftover  -= mc_size;
275
	}
Dmitry Adamushko's avatar
Dmitry Adamushko committed
276
277
278

	if (new_mc) {
		if (!leftover) {
279
			vfree(uci->mc);
280
			uci->mc = new_mc;
281
			pr_debug("CPU%d found a matching microcode update with version 0x%x (current=0x%x)\n",
282
				 cpu, new_rev, uci->cpu_sig.rev);
283
		} else {
Dmitry Adamushko's avatar
Dmitry Adamushko committed
284
			vfree(new_mc);
285
286
287
288
			state = UCODE_ERROR;
		}
	} else
		state = UCODE_NFOUND;
Dmitry Adamushko's avatar
Dmitry Adamushko committed
289
290
291

	free_equiv_cpu_table();

292
	return state;
Dmitry Adamushko's avatar
Dmitry Adamushko committed
293
294
}

295
static enum ucode_state request_microcode_fw(int cpu, struct device *device)
Dmitry Adamushko's avatar
Dmitry Adamushko committed
296
{
297
	enum ucode_state ret;
Dmitry Adamushko's avatar
Dmitry Adamushko committed
298

299
	if (firmware == NULL)
300
		return UCODE_NFOUND;
Dmitry Adamushko's avatar
Dmitry Adamushko committed
301

302
	if (*(u32 *)firmware->data != UCODE_MAGIC) {
303
		pr_err("invalid UCODE_MAGIC (0x%08x)\n",
304
305
306
307
		       *(u32 *)firmware->data);
		return UCODE_ERROR;
	}

308
	ret = generic_load_microcode(cpu, firmware->data, firmware->size);
Dmitry Adamushko's avatar
Dmitry Adamushko committed
309
310
311
312

	return ret;
}

313
314
static enum ucode_state
request_microcode_user(int cpu, const void __user *buf, size_t size)
Dmitry Adamushko's avatar
Dmitry Adamushko committed
315
{
316
	pr_info("AMD microcode update via /dev/cpu/microcode not supported\n");
317
	return UCODE_ERROR;
318
319
320
321
322
323
}

static void microcode_fini_cpu_amd(int cpu)
{
	struct ucode_cpu_info *uci = ucode_cpu_info + cpu;

324
325
	vfree(uci->mc);
	uci->mc = NULL;
326
327
}

328
329
330
void init_microcode_amd(struct device *device)
{
	const char *fw_name = "amd-ucode/microcode_amd.bin";
331
332
333
334
335
	struct cpuinfo_x86 *c = &boot_cpu_data;

	WARN_ON(c->x86_vendor != X86_VENDOR_AMD);

	if (c->x86 < 0x10) {
336
		pr_warning("AMD CPU family 0x%x not supported\n", c->x86);
337
338
339
340
		return;
	}
	supported_cpu = 1;

341
	if (request_firmware(&firmware, fw_name, device))
342
		pr_err("failed to load file %s\n", fw_name);
343
344
345
346
347
348
349
}

void fini_microcode_amd(void)
{
	release_firmware(firmware);
}

350
static struct microcode_ops microcode_amd_ops = {
351
352
	.init				  = init_microcode_amd,
	.fini				  = fini_microcode_amd,
Dmitry Adamushko's avatar
Dmitry Adamushko committed
353
354
	.request_microcode_user           = request_microcode_user,
	.request_microcode_fw             = request_microcode_fw,
355
356
357
358
359
	.collect_cpu_info                 = collect_cpu_info_amd,
	.apply_microcode                  = apply_microcode_amd,
	.microcode_fini_cpu               = microcode_fini_cpu_amd,
};

360
struct microcode_ops * __init init_amd_microcode(void)
361
{
362
	return &microcode_amd_ops;
363
}