|  | /* | 
|  | *	Intel CPU Microcode Update Driver for Linux | 
|  | * | 
|  | *	Copyright (C) 2000-2006 Tigran Aivazian <tigran@aivazian.fsnet.co.uk> | 
|  | *		      2006	Shaohua Li <shaohua.li@intel.com> | 
|  | * | 
|  | *	This driver allows to upgrade microcode on Intel processors | 
|  | *	belonging to IA-32 family - PentiumPro, Pentium II, | 
|  | *	Pentium III, Xeon, Pentium 4, etc. | 
|  | * | 
|  | *	Reference: Section 8.11 of Volume 3a, IA-32 Intel? Architecture | 
|  | *	Software Developer's Manual | 
|  | *	Order Number 253668 or free download from: | 
|  | * | 
|  | *	http://developer.intel.com/design/pentium4/manuals/253668.htm | 
|  | * | 
|  | *	For more information, go to http://www.urbanmyth.org/microcode | 
|  | * | 
|  | *	This program is free software; you can redistribute it and/or | 
|  | *	modify it under the terms of the GNU General Public License | 
|  | *	as published by the Free Software Foundation; either version | 
|  | *	2 of the License, or (at your option) any later version. | 
|  | * | 
|  | *	1.0	16 Feb 2000, Tigran Aivazian <tigran@sco.com> | 
|  | *		Initial release. | 
|  | *	1.01	18 Feb 2000, Tigran Aivazian <tigran@sco.com> | 
|  | *		Added read() support + cleanups. | 
|  | *	1.02	21 Feb 2000, Tigran Aivazian <tigran@sco.com> | 
|  | *		Added 'device trimming' support. open(O_WRONLY) zeroes | 
|  | *		and frees the saved copy of applied microcode. | 
|  | *	1.03	29 Feb 2000, Tigran Aivazian <tigran@sco.com> | 
|  | *		Made to use devfs (/dev/cpu/microcode) + cleanups. | 
|  | *	1.04	06 Jun 2000, Simon Trimmer <simon@veritas.com> | 
|  | *		Added misc device support (now uses both devfs and misc). | 
|  | *		Added MICROCODE_IOCFREE ioctl to clear memory. | 
|  | *	1.05	09 Jun 2000, Simon Trimmer <simon@veritas.com> | 
|  | *		Messages for error cases (non Intel & no suitable microcode). | 
|  | *	1.06	03 Aug 2000, Tigran Aivazian <tigran@veritas.com> | 
|  | *		Removed ->release(). Removed exclusive open and status bitmap. | 
|  | *		Added microcode_rwsem to serialize read()/write()/ioctl(). | 
|  | *		Removed global kernel lock usage. | 
|  | *	1.07	07 Sep 2000, Tigran Aivazian <tigran@veritas.com> | 
|  | *		Write 0 to 0x8B msr and then cpuid before reading revision, | 
|  | *		so that it works even if there were no update done by the | 
|  | *		BIOS. Otherwise, reading from 0x8B gives junk (which happened | 
|  | *		to be 0 on my machine which is why it worked even when I | 
|  | *		disabled update by the BIOS) | 
|  | *		Thanks to Eric W. Biederman <ebiederman@lnxi.com> for the fix. | 
|  | *	1.08	11 Dec 2000, Richard Schaal <richard.schaal@intel.com> and | 
|  | *			     Tigran Aivazian <tigran@veritas.com> | 
|  | *		Intel Pentium 4 processor support and bugfixes. | 
|  | *	1.09	30 Oct 2001, Tigran Aivazian <tigran@veritas.com> | 
|  | *		Bugfix for HT (Hyper-Threading) enabled processors | 
|  | *		whereby processor resources are shared by all logical processors | 
|  | *		in a single CPU package. | 
|  | *	1.10	28 Feb 2002 Asit K Mallick <asit.k.mallick@intel.com> and | 
|  | *		Tigran Aivazian <tigran@veritas.com>, | 
|  | *		Serialize updates as required on HT processors due to speculative | 
|  | *		nature of implementation. | 
|  | *	1.11	22 Mar 2002 Tigran Aivazian <tigran@veritas.com> | 
|  | *		Fix the panic when writing zero-length microcode chunk. | 
|  | *	1.12	29 Sep 2003 Nitin Kamble <nitin.a.kamble@intel.com>, | 
|  | *		Jun Nakajima <jun.nakajima@intel.com> | 
|  | *		Support for the microcode updates in the new format. | 
|  | *	1.13	10 Oct 2003 Tigran Aivazian <tigran@veritas.com> | 
|  | *		Removed ->read() method and obsoleted MICROCODE_IOCFREE ioctl | 
|  | *		because we no longer hold a copy of applied microcode | 
|  | *		in kernel memory. | 
|  | *	1.14	25 Jun 2004 Tigran Aivazian <tigran@veritas.com> | 
|  | *		Fix sigmatch() macro to handle old CPUs with pf == 0. | 
|  | *		Thanks to Stuart Swales for pointing out this bug. | 
|  | */ | 
|  |  | 
|  | //#define DEBUG /* pr_debug */ | 
|  | #include <linux/capability.h> | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/init.h> | 
|  | #include <linux/sched.h> | 
|  | #include <linux/smp_lock.h> | 
|  | #include <linux/cpumask.h> | 
|  | #include <linux/module.h> | 
|  | #include <linux/slab.h> | 
|  | #include <linux/vmalloc.h> | 
|  | #include <linux/miscdevice.h> | 
|  | #include <linux/spinlock.h> | 
|  | #include <linux/mm.h> | 
|  | #include <linux/fs.h> | 
|  | #include <linux/mutex.h> | 
|  | #include <linux/cpu.h> | 
|  | #include <linux/firmware.h> | 
|  | #include <linux/platform_device.h> | 
|  |  | 
|  | #include <asm/msr.h> | 
|  | #include <asm/uaccess.h> | 
|  | #include <asm/processor.h> | 
|  |  | 
|  | MODULE_DESCRIPTION("Intel CPU (IA-32) Microcode Update Driver"); | 
|  | MODULE_AUTHOR("Tigran Aivazian <tigran@aivazian.fsnet.co.uk>"); | 
|  | MODULE_LICENSE("GPL"); | 
|  |  | 
|  | #define MICROCODE_VERSION 	"1.14a" | 
|  |  | 
|  | #define DEFAULT_UCODE_DATASIZE 	(2000) 	  /* 2000 bytes */ | 
|  | #define MC_HEADER_SIZE		(sizeof (microcode_header_t))  	  /* 48 bytes */ | 
|  | #define DEFAULT_UCODE_TOTALSIZE (DEFAULT_UCODE_DATASIZE + MC_HEADER_SIZE) /* 2048 bytes */ | 
|  | #define EXT_HEADER_SIZE		(sizeof (struct extended_sigtable)) /* 20 bytes */ | 
|  | #define EXT_SIGNATURE_SIZE	(sizeof (struct extended_signature)) /* 12 bytes */ | 
|  | #define DWSIZE			(sizeof (u32)) | 
|  | #define get_totalsize(mc) \ | 
|  | (((microcode_t *)mc)->hdr.totalsize ? \ | 
|  | ((microcode_t *)mc)->hdr.totalsize : DEFAULT_UCODE_TOTALSIZE) | 
|  | #define get_datasize(mc) \ | 
|  | (((microcode_t *)mc)->hdr.datasize ? \ | 
|  | ((microcode_t *)mc)->hdr.datasize : DEFAULT_UCODE_DATASIZE) | 
|  |  | 
|  | #define sigmatch(s1, s2, p1, p2) \ | 
|  | (((s1) == (s2)) && (((p1) & (p2)) || (((p1) == 0) && ((p2) == 0)))) | 
|  |  | 
|  | #define exttable_size(et) ((et)->count * EXT_SIGNATURE_SIZE + EXT_HEADER_SIZE) | 
|  |  | 
|  | /* serialize access to the physical write to MSR 0x79 */ | 
|  | static DEFINE_SPINLOCK(microcode_update_lock); | 
|  |  | 
|  | /* no concurrent ->write()s are allowed on /dev/cpu/microcode */ | 
|  | static DEFINE_MUTEX(microcode_mutex); | 
|  |  | 
|  | static struct ucode_cpu_info { | 
|  | int valid; | 
|  | unsigned int sig; | 
|  | unsigned int pf; | 
|  | unsigned int rev; | 
|  | microcode_t *mc; | 
|  | } ucode_cpu_info[NR_CPUS]; | 
|  |  | 
|  | static void collect_cpu_info(int cpu_num) | 
|  | { | 
|  | struct cpuinfo_x86 *c = &cpu_data(cpu_num); | 
|  | struct ucode_cpu_info *uci = ucode_cpu_info + cpu_num; | 
|  | unsigned int val[2]; | 
|  |  | 
|  | /* We should bind the task to the CPU */ | 
|  | BUG_ON(raw_smp_processor_id() != cpu_num); | 
|  | uci->pf = uci->rev = 0; | 
|  | uci->mc = NULL; | 
|  | uci->valid = 1; | 
|  |  | 
|  | if (c->x86_vendor != X86_VENDOR_INTEL || c->x86 < 6 || | 
|  | cpu_has(c, X86_FEATURE_IA64)) { | 
|  | printk(KERN_ERR "microcode: CPU%d not a capable Intel " | 
|  | "processor\n", cpu_num); | 
|  | uci->valid = 0; | 
|  | return; | 
|  | } | 
|  |  | 
|  | uci->sig = cpuid_eax(0x00000001); | 
|  |  | 
|  | if ((c->x86_model >= 5) || (c->x86 > 6)) { | 
|  | /* get processor flags from MSR 0x17 */ | 
|  | rdmsr(MSR_IA32_PLATFORM_ID, val[0], val[1]); | 
|  | uci->pf = 1 << ((val[1] >> 18) & 7); | 
|  | } | 
|  |  | 
|  | wrmsr(MSR_IA32_UCODE_REV, 0, 0); | 
|  | /* see notes above for revision 1.07.  Apparent chip bug */ | 
|  | sync_core(); | 
|  | /* get the current revision from MSR 0x8B */ | 
|  | rdmsr(MSR_IA32_UCODE_REV, val[0], uci->rev); | 
|  | pr_debug("microcode: collect_cpu_info : sig=0x%x, pf=0x%x, rev=0x%x\n", | 
|  | uci->sig, uci->pf, uci->rev); | 
|  | } | 
|  |  | 
|  | static inline int microcode_update_match(int cpu_num, | 
|  | microcode_header_t *mc_header, int sig, int pf) | 
|  | { | 
|  | struct ucode_cpu_info *uci = ucode_cpu_info + cpu_num; | 
|  |  | 
|  | if (!sigmatch(sig, uci->sig, pf, uci->pf) | 
|  | || mc_header->rev <= uci->rev) | 
|  | return 0; | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | static int microcode_sanity_check(void *mc) | 
|  | { | 
|  | microcode_header_t *mc_header = mc; | 
|  | struct extended_sigtable *ext_header = NULL; | 
|  | struct extended_signature *ext_sig; | 
|  | unsigned long total_size, data_size, ext_table_size; | 
|  | int sum, orig_sum, ext_sigcount = 0, i; | 
|  |  | 
|  | total_size = get_totalsize(mc_header); | 
|  | data_size = get_datasize(mc_header); | 
|  | if (data_size + MC_HEADER_SIZE > total_size) { | 
|  | printk(KERN_ERR "microcode: error! " | 
|  | "Bad data size in microcode data file\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | if (mc_header->ldrver != 1 || mc_header->hdrver != 1) { | 
|  | printk(KERN_ERR "microcode: error! " | 
|  | "Unknown microcode update format\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  | ext_table_size = total_size - (MC_HEADER_SIZE + data_size); | 
|  | if (ext_table_size) { | 
|  | if ((ext_table_size < EXT_HEADER_SIZE) | 
|  | || ((ext_table_size - EXT_HEADER_SIZE) % EXT_SIGNATURE_SIZE)) { | 
|  | printk(KERN_ERR "microcode: error! " | 
|  | "Small exttable size in microcode data file\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  | ext_header = mc + MC_HEADER_SIZE + data_size; | 
|  | if (ext_table_size != exttable_size(ext_header)) { | 
|  | printk(KERN_ERR "microcode: error! " | 
|  | "Bad exttable size in microcode data file\n"); | 
|  | return -EFAULT; | 
|  | } | 
|  | ext_sigcount = ext_header->count; | 
|  | } | 
|  |  | 
|  | /* check extended table checksum */ | 
|  | if (ext_table_size) { | 
|  | int ext_table_sum = 0; | 
|  | int *ext_tablep = (int *)ext_header; | 
|  |  | 
|  | i = ext_table_size / DWSIZE; | 
|  | while (i--) | 
|  | ext_table_sum += ext_tablep[i]; | 
|  | if (ext_table_sum) { | 
|  | printk(KERN_WARNING "microcode: aborting, " | 
|  | "bad extended signature table checksum\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  | } | 
|  |  | 
|  | /* calculate the checksum */ | 
|  | orig_sum = 0; | 
|  | i = (MC_HEADER_SIZE + data_size) / DWSIZE; | 
|  | while (i--) | 
|  | orig_sum += ((int *)mc)[i]; | 
|  | if (orig_sum) { | 
|  | printk(KERN_ERR "microcode: aborting, bad checksum\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  | if (!ext_table_size) | 
|  | return 0; | 
|  | /* check extended signature checksum */ | 
|  | for (i = 0; i < ext_sigcount; i++) { | 
|  | ext_sig = (void *)ext_header + EXT_HEADER_SIZE + | 
|  | EXT_SIGNATURE_SIZE * i; | 
|  | sum = orig_sum | 
|  | - (mc_header->sig + mc_header->pf + mc_header->cksum) | 
|  | + (ext_sig->sig + ext_sig->pf + ext_sig->cksum); | 
|  | if (sum) { | 
|  | printk(KERN_ERR "microcode: aborting, bad checksum\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  | } | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * return 0 - no update found | 
|  | * return 1 - found update | 
|  | * return < 0 - error | 
|  | */ | 
|  | static int get_maching_microcode(void *mc, int cpu) | 
|  | { | 
|  | struct ucode_cpu_info *uci = ucode_cpu_info + cpu; | 
|  | microcode_header_t *mc_header = mc; | 
|  | struct extended_sigtable *ext_header; | 
|  | unsigned long total_size = get_totalsize(mc_header); | 
|  | int ext_sigcount, i; | 
|  | struct extended_signature *ext_sig; | 
|  | void *new_mc; | 
|  |  | 
|  | if (microcode_update_match(cpu, mc_header, | 
|  | mc_header->sig, mc_header->pf)) | 
|  | goto find; | 
|  |  | 
|  | if (total_size <= get_datasize(mc_header) + MC_HEADER_SIZE) | 
|  | return 0; | 
|  |  | 
|  | ext_header = mc + get_datasize(mc_header) + MC_HEADER_SIZE; | 
|  | ext_sigcount = ext_header->count; | 
|  | ext_sig = (void *)ext_header + EXT_HEADER_SIZE; | 
|  | for (i = 0; i < ext_sigcount; i++) { | 
|  | if (microcode_update_match(cpu, mc_header, | 
|  | ext_sig->sig, ext_sig->pf)) | 
|  | goto find; | 
|  | ext_sig++; | 
|  | } | 
|  | return 0; | 
|  | find: | 
|  | pr_debug("microcode: CPU%d found a matching microcode update with" | 
|  | " version 0x%x (current=0x%x)\n", cpu, mc_header->rev,uci->rev); | 
|  | new_mc = vmalloc(total_size); | 
|  | if (!new_mc) { | 
|  | printk(KERN_ERR "microcode: error! Can not allocate memory\n"); | 
|  | return -ENOMEM; | 
|  | } | 
|  |  | 
|  | /* free previous update file */ | 
|  | vfree(uci->mc); | 
|  |  | 
|  | memcpy(new_mc, mc, total_size); | 
|  | uci->mc = new_mc; | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | static void apply_microcode(int cpu) | 
|  | { | 
|  | unsigned long flags; | 
|  | unsigned int val[2]; | 
|  | int cpu_num = raw_smp_processor_id(); | 
|  | struct ucode_cpu_info *uci = ucode_cpu_info + cpu_num; | 
|  |  | 
|  | /* We should bind the task to the CPU */ | 
|  | BUG_ON(cpu_num != cpu); | 
|  |  | 
|  | if (uci->mc == NULL) | 
|  | return; | 
|  |  | 
|  | /* serialize access to the physical write to MSR 0x79 */ | 
|  | spin_lock_irqsave(µcode_update_lock, flags); | 
|  |  | 
|  | /* write microcode via MSR 0x79 */ | 
|  | wrmsr(MSR_IA32_UCODE_WRITE, | 
|  | (unsigned long) uci->mc->bits, | 
|  | (unsigned long) uci->mc->bits >> 16 >> 16); | 
|  | wrmsr(MSR_IA32_UCODE_REV, 0, 0); | 
|  |  | 
|  | /* see notes above for revision 1.07.  Apparent chip bug */ | 
|  | sync_core(); | 
|  |  | 
|  | /* get the current revision from MSR 0x8B */ | 
|  | rdmsr(MSR_IA32_UCODE_REV, val[0], val[1]); | 
|  |  | 
|  | spin_unlock_irqrestore(µcode_update_lock, flags); | 
|  | if (val[1] != uci->mc->hdr.rev) { | 
|  | printk(KERN_ERR "microcode: CPU%d update from revision " | 
|  | "0x%x to 0x%x failed\n", cpu_num, uci->rev, val[1]); | 
|  | return; | 
|  | } | 
|  | printk(KERN_INFO "microcode: CPU%d updated from revision " | 
|  | "0x%x to 0x%x, date = %08x \n", | 
|  | cpu_num, uci->rev, val[1], uci->mc->hdr.date); | 
|  | uci->rev = val[1]; | 
|  | } | 
|  |  | 
|  | #ifdef CONFIG_MICROCODE_OLD_INTERFACE | 
|  | static void __user *user_buffer;	/* user area microcode data buffer */ | 
|  | static unsigned int user_buffer_size;	/* it's size */ | 
|  |  | 
|  | static long get_next_ucode(void **mc, long offset) | 
|  | { | 
|  | microcode_header_t mc_header; | 
|  | unsigned long total_size; | 
|  |  | 
|  | /* No more data */ | 
|  | if (offset >= user_buffer_size) | 
|  | return 0; | 
|  | if (copy_from_user(&mc_header, user_buffer + offset, MC_HEADER_SIZE)) { | 
|  | printk(KERN_ERR "microcode: error! Can not read user data\n"); | 
|  | return -EFAULT; | 
|  | } | 
|  | total_size = get_totalsize(&mc_header); | 
|  | if (offset + total_size > user_buffer_size) { | 
|  | printk(KERN_ERR "microcode: error! Bad total size in microcode " | 
|  | "data file\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  | *mc = vmalloc(total_size); | 
|  | if (!*mc) | 
|  | return -ENOMEM; | 
|  | if (copy_from_user(*mc, user_buffer + offset, total_size)) { | 
|  | printk(KERN_ERR "microcode: error! Can not read user data\n"); | 
|  | vfree(*mc); | 
|  | return -EFAULT; | 
|  | } | 
|  | return offset + total_size; | 
|  | } | 
|  |  | 
|  | static int do_microcode_update (void) | 
|  | { | 
|  | long cursor = 0; | 
|  | int error = 0; | 
|  | void *new_mc = NULL; | 
|  | int cpu; | 
|  | cpumask_t old; | 
|  |  | 
|  | old = current->cpus_allowed; | 
|  |  | 
|  | while ((cursor = get_next_ucode(&new_mc, cursor)) > 0) { | 
|  | error = microcode_sanity_check(new_mc); | 
|  | if (error) | 
|  | goto out; | 
|  | /* | 
|  | * It's possible the data file has multiple matching ucode, | 
|  | * lets keep searching till the latest version | 
|  | */ | 
|  | for_each_online_cpu(cpu) { | 
|  | struct ucode_cpu_info *uci = ucode_cpu_info + cpu; | 
|  |  | 
|  | if (!uci->valid) | 
|  | continue; | 
|  | set_cpus_allowed_ptr(current, &cpumask_of_cpu(cpu)); | 
|  | error = get_maching_microcode(new_mc, cpu); | 
|  | if (error < 0) | 
|  | goto out; | 
|  | if (error == 1) | 
|  | apply_microcode(cpu); | 
|  | } | 
|  | vfree(new_mc); | 
|  | } | 
|  | out: | 
|  | if (cursor > 0) | 
|  | vfree(new_mc); | 
|  | if (cursor < 0) | 
|  | error = cursor; | 
|  | set_cpus_allowed_ptr(current, &old); | 
|  | return error; | 
|  | } | 
|  |  | 
|  | static int microcode_open (struct inode *unused1, struct file *unused2) | 
|  | { | 
|  | cycle_kernel_lock(); | 
|  | return capable(CAP_SYS_RAWIO) ? 0 : -EPERM; | 
|  | } | 
|  |  | 
|  | static ssize_t microcode_write (struct file *file, const char __user *buf, size_t len, loff_t *ppos) | 
|  | { | 
|  | ssize_t ret; | 
|  |  | 
|  | if ((len >> PAGE_SHIFT) > num_physpages) { | 
|  | printk(KERN_ERR "microcode: too much data (max %ld pages)\n", num_physpages); | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | get_online_cpus(); | 
|  | mutex_lock(µcode_mutex); | 
|  |  | 
|  | user_buffer = (void __user *) buf; | 
|  | user_buffer_size = (int) len; | 
|  |  | 
|  | ret = do_microcode_update(); | 
|  | if (!ret) | 
|  | ret = (ssize_t)len; | 
|  |  | 
|  | mutex_unlock(µcode_mutex); | 
|  | put_online_cpus(); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static const struct file_operations microcode_fops = { | 
|  | .owner		= THIS_MODULE, | 
|  | .write		= microcode_write, | 
|  | .open		= microcode_open, | 
|  | }; | 
|  |  | 
|  | static struct miscdevice microcode_dev = { | 
|  | .minor		= MICROCODE_MINOR, | 
|  | .name		= "microcode", | 
|  | .fops		= µcode_fops, | 
|  | }; | 
|  |  | 
|  | static int __init microcode_dev_init (void) | 
|  | { | 
|  | int error; | 
|  |  | 
|  | error = misc_register(µcode_dev); | 
|  | if (error) { | 
|  | printk(KERN_ERR | 
|  | "microcode: can't misc_register on minor=%d\n", | 
|  | MICROCODE_MINOR); | 
|  | return error; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static void microcode_dev_exit (void) | 
|  | { | 
|  | misc_deregister(µcode_dev); | 
|  | } | 
|  |  | 
|  | MODULE_ALIAS_MISCDEV(MICROCODE_MINOR); | 
|  | #else | 
|  | #define microcode_dev_init() 0 | 
|  | #define microcode_dev_exit() do { } while(0) | 
|  | #endif | 
|  |  | 
|  | static long get_next_ucode_from_buffer(void **mc, const u8 *buf, | 
|  | unsigned long size, long offset) | 
|  | { | 
|  | microcode_header_t *mc_header; | 
|  | unsigned long total_size; | 
|  |  | 
|  | /* No more data */ | 
|  | if (offset >= size) | 
|  | return 0; | 
|  | mc_header = (microcode_header_t *)(buf + offset); | 
|  | total_size = get_totalsize(mc_header); | 
|  |  | 
|  | if (offset + total_size > size) { | 
|  | printk(KERN_ERR "microcode: error! Bad data in microcode data file\n"); | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | *mc = vmalloc(total_size); | 
|  | if (!*mc) { | 
|  | printk(KERN_ERR "microcode: error! Can not allocate memory\n"); | 
|  | return -ENOMEM; | 
|  | } | 
|  | memcpy(*mc, buf + offset, total_size); | 
|  | return offset + total_size; | 
|  | } | 
|  |  | 
|  | /* fake device for request_firmware */ | 
|  | static struct platform_device *microcode_pdev; | 
|  |  | 
|  | static int cpu_request_microcode(int cpu) | 
|  | { | 
|  | char name[30]; | 
|  | struct cpuinfo_x86 *c = &cpu_data(cpu); | 
|  | const struct firmware *firmware; | 
|  | const u8 *buf; | 
|  | unsigned long size; | 
|  | long offset = 0; | 
|  | int error; | 
|  | void *mc; | 
|  |  | 
|  | /* We should bind the task to the CPU */ | 
|  | BUG_ON(cpu != raw_smp_processor_id()); | 
|  | sprintf(name,"intel-ucode/%02x-%02x-%02x", | 
|  | c->x86, c->x86_model, c->x86_mask); | 
|  | error = request_firmware(&firmware, name, µcode_pdev->dev); | 
|  | if (error) { | 
|  | pr_debug("microcode: data file %s load failed\n", name); | 
|  | return error; | 
|  | } | 
|  | buf = firmware->data; | 
|  | size = firmware->size; | 
|  | while ((offset = get_next_ucode_from_buffer(&mc, buf, size, offset)) | 
|  | > 0) { | 
|  | error = microcode_sanity_check(mc); | 
|  | if (error) | 
|  | break; | 
|  | error = get_maching_microcode(mc, cpu); | 
|  | if (error < 0) | 
|  | break; | 
|  | /* | 
|  | * It's possible the data file has multiple matching ucode, | 
|  | * lets keep searching till the latest version | 
|  | */ | 
|  | if (error == 1) { | 
|  | apply_microcode(cpu); | 
|  | error = 0; | 
|  | } | 
|  | vfree(mc); | 
|  | } | 
|  | if (offset > 0) | 
|  | vfree(mc); | 
|  | if (offset < 0) | 
|  | error = offset; | 
|  | release_firmware(firmware); | 
|  |  | 
|  | return error; | 
|  | } | 
|  |  | 
|  | static int apply_microcode_check_cpu(int cpu) | 
|  | { | 
|  | struct cpuinfo_x86 *c = &cpu_data(cpu); | 
|  | struct ucode_cpu_info *uci = ucode_cpu_info + cpu; | 
|  | cpumask_t old; | 
|  | unsigned int val[2]; | 
|  | int err = 0; | 
|  |  | 
|  | /* Check if the microcode is available */ | 
|  | if (!uci->mc) | 
|  | return 0; | 
|  |  | 
|  | old = current->cpus_allowed; | 
|  | set_cpus_allowed_ptr(current, &cpumask_of_cpu(cpu)); | 
|  |  | 
|  | /* Check if the microcode we have in memory matches the CPU */ | 
|  | if (c->x86_vendor != X86_VENDOR_INTEL || c->x86 < 6 || | 
|  | cpu_has(c, X86_FEATURE_IA64) || uci->sig != cpuid_eax(0x00000001)) | 
|  | err = -EINVAL; | 
|  |  | 
|  | if (!err && ((c->x86_model >= 5) || (c->x86 > 6))) { | 
|  | /* get processor flags from MSR 0x17 */ | 
|  | rdmsr(MSR_IA32_PLATFORM_ID, val[0], val[1]); | 
|  | if (uci->pf != (1 << ((val[1] >> 18) & 7))) | 
|  | err = -EINVAL; | 
|  | } | 
|  |  | 
|  | if (!err) { | 
|  | wrmsr(MSR_IA32_UCODE_REV, 0, 0); | 
|  | /* see notes above for revision 1.07.  Apparent chip bug */ | 
|  | sync_core(); | 
|  | /* get the current revision from MSR 0x8B */ | 
|  | rdmsr(MSR_IA32_UCODE_REV, val[0], val[1]); | 
|  | if (uci->rev != val[1]) | 
|  | err = -EINVAL; | 
|  | } | 
|  |  | 
|  | if (!err) | 
|  | apply_microcode(cpu); | 
|  | else | 
|  | printk(KERN_ERR "microcode: Could not apply microcode to CPU%d:" | 
|  | " sig=0x%x, pf=0x%x, rev=0x%x\n", | 
|  | cpu, uci->sig, uci->pf, uci->rev); | 
|  |  | 
|  | set_cpus_allowed_ptr(current, &old); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | static void microcode_init_cpu(int cpu, int resume) | 
|  | { | 
|  | cpumask_t old; | 
|  | struct ucode_cpu_info *uci = ucode_cpu_info + cpu; | 
|  |  | 
|  | old = current->cpus_allowed; | 
|  |  | 
|  | set_cpus_allowed_ptr(current, &cpumask_of_cpu(cpu)); | 
|  | mutex_lock(µcode_mutex); | 
|  | collect_cpu_info(cpu); | 
|  | if (uci->valid && system_state == SYSTEM_RUNNING && !resume) | 
|  | cpu_request_microcode(cpu); | 
|  | mutex_unlock(µcode_mutex); | 
|  | set_cpus_allowed_ptr(current, &old); | 
|  | } | 
|  |  | 
|  | static void microcode_fini_cpu(int cpu) | 
|  | { | 
|  | struct ucode_cpu_info *uci = ucode_cpu_info + cpu; | 
|  |  | 
|  | mutex_lock(µcode_mutex); | 
|  | uci->valid = 0; | 
|  | vfree(uci->mc); | 
|  | uci->mc = NULL; | 
|  | mutex_unlock(µcode_mutex); | 
|  | } | 
|  |  | 
|  | static ssize_t reload_store(struct sys_device *dev, | 
|  | struct sysdev_attribute *attr, | 
|  | const char *buf, size_t sz) | 
|  | { | 
|  | struct ucode_cpu_info *uci = ucode_cpu_info + dev->id; | 
|  | char *end; | 
|  | unsigned long val = simple_strtoul(buf, &end, 0); | 
|  | int err = 0; | 
|  | int cpu = dev->id; | 
|  |  | 
|  | if (end == buf) | 
|  | return -EINVAL; | 
|  | if (val == 1) { | 
|  | cpumask_t old = current->cpus_allowed; | 
|  |  | 
|  | get_online_cpus(); | 
|  | set_cpus_allowed_ptr(current, &cpumask_of_cpu(cpu)); | 
|  |  | 
|  | mutex_lock(µcode_mutex); | 
|  | if (uci->valid) | 
|  | err = cpu_request_microcode(cpu); | 
|  | mutex_unlock(µcode_mutex); | 
|  | put_online_cpus(); | 
|  | set_cpus_allowed_ptr(current, &old); | 
|  | } | 
|  | if (err) | 
|  | return err; | 
|  | return sz; | 
|  | } | 
|  |  | 
|  | static ssize_t version_show(struct sys_device *dev, | 
|  | struct sysdev_attribute *attr, char *buf) | 
|  | { | 
|  | struct ucode_cpu_info *uci = ucode_cpu_info + dev->id; | 
|  |  | 
|  | return sprintf(buf, "0x%x\n", uci->rev); | 
|  | } | 
|  |  | 
|  | static ssize_t pf_show(struct sys_device *dev, | 
|  | struct sysdev_attribute *attr, char *buf) | 
|  | { | 
|  | struct ucode_cpu_info *uci = ucode_cpu_info + dev->id; | 
|  |  | 
|  | return sprintf(buf, "0x%x\n", uci->pf); | 
|  | } | 
|  |  | 
|  | static SYSDEV_ATTR(reload, 0200, NULL, reload_store); | 
|  | static SYSDEV_ATTR(version, 0400, version_show, NULL); | 
|  | static SYSDEV_ATTR(processor_flags, 0400, pf_show, NULL); | 
|  |  | 
|  | static struct attribute *mc_default_attrs[] = { | 
|  | &attr_reload.attr, | 
|  | &attr_version.attr, | 
|  | &attr_processor_flags.attr, | 
|  | NULL | 
|  | }; | 
|  |  | 
|  | static struct attribute_group mc_attr_group = { | 
|  | .attrs = mc_default_attrs, | 
|  | .name = "microcode", | 
|  | }; | 
|  |  | 
|  | static int __mc_sysdev_add(struct sys_device *sys_dev, int resume) | 
|  | { | 
|  | int err, cpu = sys_dev->id; | 
|  | struct ucode_cpu_info *uci = ucode_cpu_info + cpu; | 
|  |  | 
|  | if (!cpu_online(cpu)) | 
|  | return 0; | 
|  |  | 
|  | pr_debug("microcode: CPU%d added\n", cpu); | 
|  | memset(uci, 0, sizeof(*uci)); | 
|  |  | 
|  | err = sysfs_create_group(&sys_dev->kobj, &mc_attr_group); | 
|  | if (err) | 
|  | return err; | 
|  |  | 
|  | microcode_init_cpu(cpu, resume); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int mc_sysdev_add(struct sys_device *sys_dev) | 
|  | { | 
|  | return __mc_sysdev_add(sys_dev, 0); | 
|  | } | 
|  |  | 
|  | static int mc_sysdev_remove(struct sys_device *sys_dev) | 
|  | { | 
|  | int cpu = sys_dev->id; | 
|  |  | 
|  | if (!cpu_online(cpu)) | 
|  | return 0; | 
|  |  | 
|  | pr_debug("microcode: CPU%d removed\n", cpu); | 
|  | microcode_fini_cpu(cpu); | 
|  | sysfs_remove_group(&sys_dev->kobj, &mc_attr_group); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int mc_sysdev_resume(struct sys_device *dev) | 
|  | { | 
|  | int cpu = dev->id; | 
|  |  | 
|  | if (!cpu_online(cpu)) | 
|  | return 0; | 
|  | pr_debug("microcode: CPU%d resumed\n", cpu); | 
|  | /* only CPU 0 will apply ucode here */ | 
|  | apply_microcode(0); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static struct sysdev_driver mc_sysdev_driver = { | 
|  | .add = mc_sysdev_add, | 
|  | .remove = mc_sysdev_remove, | 
|  | .resume = mc_sysdev_resume, | 
|  | }; | 
|  |  | 
|  | static __cpuinit int | 
|  | mc_cpu_callback(struct notifier_block *nb, 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_UP_CANCELED_FROZEN: | 
|  | /* The CPU refused to come up during a system resume */ | 
|  | microcode_fini_cpu(cpu); | 
|  | break; | 
|  | case CPU_ONLINE: | 
|  | case CPU_DOWN_FAILED: | 
|  | mc_sysdev_add(sys_dev); | 
|  | break; | 
|  | case CPU_ONLINE_FROZEN: | 
|  | /* System-wide resume is in progress, try to apply microcode */ | 
|  | if (apply_microcode_check_cpu(cpu)) { | 
|  | /* The application of microcode failed */ | 
|  | microcode_fini_cpu(cpu); | 
|  | __mc_sysdev_add(sys_dev, 1); | 
|  | break; | 
|  | } | 
|  | case CPU_DOWN_FAILED_FROZEN: | 
|  | if (sysfs_create_group(&sys_dev->kobj, &mc_attr_group)) | 
|  | printk(KERN_ERR "microcode: Failed to create the sysfs " | 
|  | "group for CPU%d\n", cpu); | 
|  | break; | 
|  | case CPU_DOWN_PREPARE: | 
|  | mc_sysdev_remove(sys_dev); | 
|  | break; | 
|  | case CPU_DOWN_PREPARE_FROZEN: | 
|  | /* Suspend is in progress, only remove the interface */ | 
|  | sysfs_remove_group(&sys_dev->kobj, &mc_attr_group); | 
|  | break; | 
|  | } | 
|  | return NOTIFY_OK; | 
|  | } | 
|  |  | 
|  | static struct notifier_block __refdata mc_cpu_notifier = { | 
|  | .notifier_call = mc_cpu_callback, | 
|  | }; | 
|  |  | 
|  | static int __init microcode_init (void) | 
|  | { | 
|  | int error; | 
|  |  | 
|  | printk(KERN_INFO | 
|  | "IA-32 Microcode Update Driver: v" MICROCODE_VERSION " <tigran@aivazian.fsnet.co.uk>\n"); | 
|  |  | 
|  | error = microcode_dev_init(); | 
|  | if (error) | 
|  | return error; | 
|  | microcode_pdev = platform_device_register_simple("microcode", -1, | 
|  | NULL, 0); | 
|  | if (IS_ERR(microcode_pdev)) { | 
|  | microcode_dev_exit(); | 
|  | return PTR_ERR(microcode_pdev); | 
|  | } | 
|  |  | 
|  | get_online_cpus(); | 
|  | error = sysdev_driver_register(&cpu_sysdev_class, &mc_sysdev_driver); | 
|  | put_online_cpus(); | 
|  | if (error) { | 
|  | microcode_dev_exit(); | 
|  | platform_device_unregister(microcode_pdev); | 
|  | return error; | 
|  | } | 
|  |  | 
|  | register_hotcpu_notifier(&mc_cpu_notifier); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static void __exit microcode_exit (void) | 
|  | { | 
|  | microcode_dev_exit(); | 
|  |  | 
|  | unregister_hotcpu_notifier(&mc_cpu_notifier); | 
|  |  | 
|  | get_online_cpus(); | 
|  | sysdev_driver_unregister(&cpu_sysdev_class, &mc_sysdev_driver); | 
|  | put_online_cpus(); | 
|  |  | 
|  | platform_device_unregister(microcode_pdev); | 
|  | } | 
|  |  | 
|  | module_init(microcode_init) | 
|  | module_exit(microcode_exit) |