| Alexey Dobriyan | b077ffb | 2007-02-16 01:48:11 -0800 | [diff] [blame] | 1 | #include <linux/module.h> | 
|  | 2 | #include <linux/preempt.h> | 
|  | 3 | #include <linux/smp.h> | 
|  | 4 | #include <asm/msr.h> | 
|  | 5 |  | 
| Alexey Dobriyan | b077ffb | 2007-02-16 01:48:11 -0800 | [diff] [blame] | 6 | struct msr_info { | 
|  | 7 | u32 msr_no; | 
|  | 8 | u32 l, h; | 
| Rudolf Marek | 4e9baad | 2007-05-08 17:22:01 +0200 | [diff] [blame] | 9 | int err; | 
| Alexey Dobriyan | b077ffb | 2007-02-16 01:48:11 -0800 | [diff] [blame] | 10 | }; | 
|  | 11 |  | 
|  | 12 | static void __rdmsr_on_cpu(void *info) | 
|  | 13 | { | 
|  | 14 | struct msr_info *rv = info; | 
|  | 15 |  | 
|  | 16 | rdmsr(rv->msr_no, rv->l, rv->h); | 
|  | 17 | } | 
|  | 18 |  | 
| H. Peter Anvin | bdd3146 | 2008-08-25 17:44:03 -0700 | [diff] [blame] | 19 | static void __wrmsr_on_cpu(void *info) | 
| Alexey Dobriyan | b077ffb | 2007-02-16 01:48:11 -0800 | [diff] [blame] | 20 | { | 
| Rudolf Marek | 4e9baad | 2007-05-08 17:22:01 +0200 | [diff] [blame] | 21 | struct msr_info *rv = info; | 
|  | 22 |  | 
| H. Peter Anvin | bdd3146 | 2008-08-25 17:44:03 -0700 | [diff] [blame] | 23 | wrmsr(rv->msr_no, rv->l, rv->h); | 
| Rudolf Marek | 4e9baad | 2007-05-08 17:22:01 +0200 | [diff] [blame] | 24 | } | 
|  | 25 |  | 
| H. Peter Anvin | bdd3146 | 2008-08-25 17:44:03 -0700 | [diff] [blame] | 26 | int rdmsr_on_cpu(unsigned int cpu, u32 msr_no, u32 *l, u32 *h) | 
| Rudolf Marek | 4e9baad | 2007-05-08 17:22:01 +0200 | [diff] [blame] | 27 | { | 
| H. Peter Anvin | bdd3146 | 2008-08-25 17:44:03 -0700 | [diff] [blame] | 28 | int err; | 
| Avi Kivity | 5f1f935 | 2007-10-17 18:04:38 +0200 | [diff] [blame] | 29 | struct msr_info rv; | 
| Alexey Dobriyan | b077ffb | 2007-02-16 01:48:11 -0800 | [diff] [blame] | 30 |  | 
| Avi Kivity | 5f1f935 | 2007-10-17 18:04:38 +0200 | [diff] [blame] | 31 | rv.msr_no = msr_no; | 
| H. Peter Anvin | bdd3146 | 2008-08-25 17:44:03 -0700 | [diff] [blame] | 32 | err = smp_call_function_single(cpu, __rdmsr_on_cpu, &rv, 1); | 
| Avi Kivity | 5f1f935 | 2007-10-17 18:04:38 +0200 | [diff] [blame] | 33 | *l = rv.l; | 
|  | 34 | *h = rv.h; | 
|  | 35 |  | 
| Rudolf Marek | 4e9baad | 2007-05-08 17:22:01 +0200 | [diff] [blame] | 36 | return err; | 
| Alexey Dobriyan | b077ffb | 2007-02-16 01:48:11 -0800 | [diff] [blame] | 37 | } | 
|  | 38 |  | 
| H. Peter Anvin | bdd3146 | 2008-08-25 17:44:03 -0700 | [diff] [blame] | 39 | int wrmsr_on_cpu(unsigned int cpu, u32 msr_no, u32 l, u32 h) | 
|  | 40 | { | 
|  | 41 | int err; | 
|  | 42 | struct msr_info rv; | 
|  | 43 |  | 
|  | 44 | rv.msr_no = msr_no; | 
|  | 45 | rv.l = l; | 
|  | 46 | rv.h = h; | 
|  | 47 | err = smp_call_function_single(cpu, __wrmsr_on_cpu, &rv, 1); | 
|  | 48 |  | 
|  | 49 | return err; | 
|  | 50 | } | 
|  | 51 |  | 
|  | 52 | /* These "safe" variants are slower and should be used when the target MSR | 
|  | 53 | may not actually exist. */ | 
|  | 54 | static void __rdmsr_safe_on_cpu(void *info) | 
| Alexey Dobriyan | b077ffb | 2007-02-16 01:48:11 -0800 | [diff] [blame] | 55 | { | 
|  | 56 | struct msr_info *rv = info; | 
|  | 57 |  | 
| H. Peter Anvin | bdd3146 | 2008-08-25 17:44:03 -0700 | [diff] [blame] | 58 | rv->err = rdmsr_safe(rv->msr_no, &rv->l, &rv->h); | 
| Alexey Dobriyan | b077ffb | 2007-02-16 01:48:11 -0800 | [diff] [blame] | 59 | } | 
|  | 60 |  | 
| Rudolf Marek | 4e9baad | 2007-05-08 17:22:01 +0200 | [diff] [blame] | 61 | static void __wrmsr_safe_on_cpu(void *info) | 
| Alexey Dobriyan | b077ffb | 2007-02-16 01:48:11 -0800 | [diff] [blame] | 62 | { | 
| Rudolf Marek | 4e9baad | 2007-05-08 17:22:01 +0200 | [diff] [blame] | 63 | struct msr_info *rv = info; | 
|  | 64 |  | 
|  | 65 | rv->err = wrmsr_safe(rv->msr_no, rv->l, rv->h); | 
|  | 66 | } | 
|  | 67 |  | 
| H. Peter Anvin | bdd3146 | 2008-08-25 17:44:03 -0700 | [diff] [blame] | 68 | int rdmsr_safe_on_cpu(unsigned int cpu, u32 msr_no, u32 *l, u32 *h) | 
| Rudolf Marek | 4e9baad | 2007-05-08 17:22:01 +0200 | [diff] [blame] | 69 | { | 
| H. Peter Anvin | bdd3146 | 2008-08-25 17:44:03 -0700 | [diff] [blame] | 70 | int err; | 
|  | 71 | struct msr_info rv; | 
|  | 72 |  | 
|  | 73 | rv.msr_no = msr_no; | 
|  | 74 | err = smp_call_function_single(cpu, __rdmsr_safe_on_cpu, &rv, 1); | 
|  | 75 | *l = rv.l; | 
|  | 76 | *h = rv.h; | 
|  | 77 |  | 
|  | 78 | return err ? err : rv.err; | 
|  | 79 | } | 
|  | 80 |  | 
|  | 81 | int wrmsr_safe_on_cpu(unsigned int cpu, u32 msr_no, u32 l, u32 h) | 
|  | 82 | { | 
|  | 83 | int err; | 
| Avi Kivity | 5f1f935 | 2007-10-17 18:04:38 +0200 | [diff] [blame] | 84 | struct msr_info rv; | 
| Alexey Dobriyan | b077ffb | 2007-02-16 01:48:11 -0800 | [diff] [blame] | 85 |  | 
| Avi Kivity | 5f1f935 | 2007-10-17 18:04:38 +0200 | [diff] [blame] | 86 | rv.msr_no = msr_no; | 
|  | 87 | rv.l = l; | 
|  | 88 | rv.h = h; | 
| H. Peter Anvin | bdd3146 | 2008-08-25 17:44:03 -0700 | [diff] [blame] | 89 | err = smp_call_function_single(cpu, __wrmsr_safe_on_cpu, &rv, 1); | 
| Avi Kivity | 5f1f935 | 2007-10-17 18:04:38 +0200 | [diff] [blame] | 90 |  | 
| H. Peter Anvin | bdd3146 | 2008-08-25 17:44:03 -0700 | [diff] [blame] | 91 | return err ? err : rv.err; | 
| Alexey Dobriyan | b077ffb | 2007-02-16 01:48:11 -0800 | [diff] [blame] | 92 | } | 
| Alexey Dobriyan | b077ffb | 2007-02-16 01:48:11 -0800 | [diff] [blame] | 93 |  | 
|  | 94 | EXPORT_SYMBOL(rdmsr_on_cpu); | 
|  | 95 | EXPORT_SYMBOL(wrmsr_on_cpu); | 
| Rudolf Marek | 4e9baad | 2007-05-08 17:22:01 +0200 | [diff] [blame] | 96 | EXPORT_SYMBOL(rdmsr_safe_on_cpu); | 
|  | 97 | EXPORT_SYMBOL(wrmsr_safe_on_cpu); |