[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / x86 / lib / msr-on-cpu.c

#include <linux/module.h>
#include <linux/preempt.h>
#include <linux/smp.h>
#include <asm/msr.h>

struct msr_info {
	u32 msr_no;
	u32 l, h;
	int err;
};

static void __rdmsr_on_cpu(void *info)
{
	struct msr_info *rv = info;

	rdmsr(rv->msr_no, rv->l, rv->h);
}

static void __rdmsr_safe_on_cpu(void *info)
{
	struct msr_info *rv = info;

	rv->err = rdmsr_safe(rv->msr_no, &rv->l, &rv->h);
}

static int _rdmsr_on_cpu(unsigned int cpu, u32 msr_no, u32 *l, u32 *h, int safe)
{
	int err = 0;
	struct msr_info rv;

	rv.msr_no = msr_no;
	if (safe) {
		smp_call_function_single(cpu, __rdmsr_safe_on_cpu, &rv, 0, 1);
		err = rv.err;
	} else {
		smp_call_function_single(cpu, __rdmsr_on_cpu, &rv, 0, 1);
	}
	*l = rv.l;
	*h = rv.h;

	return err;
}

static void __wrmsr_on_cpu(void *info)
{
	struct msr_info *rv = info;

	wrmsr(rv->msr_no, rv->l, rv->h);
}

static void __wrmsr_safe_on_cpu(void *info)
{
	struct msr_info *rv = info;

	rv->err = wrmsr_safe(rv->msr_no, rv->l, rv->h);
}

static int _wrmsr_on_cpu(unsigned int cpu, u32 msr_no, u32 l, u32 h, int safe)
{
	int err = 0;
	struct msr_info rv;

	rv.msr_no = msr_no;
	rv.l = l;
	rv.h = h;
	if (safe) {
		smp_call_function_single(cpu, __wrmsr_safe_on_cpu, &rv, 0, 1);
		err = rv.err;
	} else {
		smp_call_function_single(cpu, __wrmsr_on_cpu, &rv, 0, 1);
	}

	return err;
}

void wrmsr_on_cpu(unsigned int cpu, u32 msr_no, u32 l, u32 h)
{
	_wrmsr_on_cpu(cpu, msr_no, l, h, 0);
}

void rdmsr_on_cpu(unsigned int cpu, u32 msr_no, u32 *l, u32 *h)
{
	_rdmsr_on_cpu(cpu, msr_no, l, h, 0);
}

/* These "safe" variants are slower and should be used when the target MSR
   may not actually exist. */
int wrmsr_safe_on_cpu(unsigned int cpu, u32 msr_no, u32 l, u32 h)
{
	return _wrmsr_on_cpu(cpu, msr_no, l, h, 1);
}

int rdmsr_safe_on_cpu(unsigned int cpu, u32 msr_no, u32 *l, u32 *h)
{
	return _rdmsr_on_cpu(cpu, msr_no, l, h, 1);
}

EXPORT_SYMBOL(rdmsr_on_cpu);
EXPORT_SYMBOL(wrmsr_on_cpu);
EXPORT_SYMBOL(rdmsr_safe_on_cpu);
EXPORT_SYMBOL(wrmsr_safe_on_cpu);
Commit	Line	Data
b077ffb3 AD	1	#include <linux/module.h>
	2	#include <linux/preempt.h>
	3	#include <linux/smp.h>
	4	#include <asm/msr.h>
	5
b077ffb3 AD	6	struct msr_info {
	7	u32 msr_no;
	8	u32 l, h;
4e9baad8	9	int err;
b077ffb3 AD	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
4e9baad8	19	static void __rdmsr_safe_on_cpu(void *info)
b077ffb3	20	{
4e9baad8 RM	21	struct msr_info *rv = info;
	22
	23	rv->err = rdmsr_safe(rv->msr_no, &rv->l, &rv->h);
	24	}
	25
	26	static int _rdmsr_on_cpu(unsigned int cpu, u32 msr_no, u32 l, u32 h, int safe)
	27	{
	28	int err = 0;
5f1f935c AK	29	struct msr_info rv;
	30
	31	rv.msr_no = msr_no;
	32	if (safe) {
	33	smp_call_function_single(cpu, __rdmsr_safe_on_cpu, &rv, 0, 1);
	34	err = rv.err;
	35	} else {
	36	smp_call_function_single(cpu, __rdmsr_on_cpu, &rv, 0, 1);
b077ffb3	37	}
5f1f935c AK	38	*l = rv.l;
	39	*h = rv.h;
	40
4e9baad8	41	return err;
b077ffb3 AD	42	}
	43
	44	static void __wrmsr_on_cpu(void *info)
	45	{
	46	struct msr_info *rv = info;
	47
	48	wrmsr(rv->msr_no, rv->l, rv->h);
	49	}
	50
4e9baad8	51	static void __wrmsr_safe_on_cpu(void *info)
b077ffb3	52	{
4e9baad8 RM	53	struct msr_info *rv = info;
	54
	55	rv->err = wrmsr_safe(rv->msr_no, rv->l, rv->h);
	56	}
	57
	58	static int _wrmsr_on_cpu(unsigned int cpu, u32 msr_no, u32 l, u32 h, int safe)
	59	{
	60	int err = 0;
5f1f935c AK	61	struct msr_info rv;
	62
	63	rv.msr_no = msr_no;
	64	rv.l = l;
	65	rv.h = h;
	66	if (safe) {
	67	smp_call_function_single(cpu, __wrmsr_safe_on_cpu, &rv, 0, 1);
	68	err = rv.err;
	69	} else {
	70	smp_call_function_single(cpu, __wrmsr_on_cpu, &rv, 0, 1);
b077ffb3	71	}
5f1f935c	72
4e9baad8 RM	73	return err;
	74	}
	75
	76	void wrmsr_on_cpu(unsigned int cpu, u32 msr_no, u32 l, u32 h)
	77	{
	78	_wrmsr_on_cpu(cpu, msr_no, l, h, 0);
	79	}
	80
	81	void rdmsr_on_cpu(unsigned int cpu, u32 msr_no, u32 l, u32 h)
	82	{
	83	_rdmsr_on_cpu(cpu, msr_no, l, h, 0);
	84	}
	85
	86	/* These "safe" variants are slower and should be used when the target MSR
	87	may not actually exist. */
	88	int wrmsr_safe_on_cpu(unsigned int cpu, u32 msr_no, u32 l, u32 h)
	89	{
	90	return _wrmsr_on_cpu(cpu, msr_no, l, h, 1);
	91	}
	92
	93	int rdmsr_safe_on_cpu(unsigned int cpu, u32 msr_no, u32 l, u32 h)
	94	{
	95	return _rdmsr_on_cpu(cpu, msr_no, l, h, 1);
b077ffb3	96	}
b077ffb3 AD	97
	98	EXPORT_SYMBOL(rdmsr_on_cpu);
	99	EXPORT_SYMBOL(wrmsr_on_cpu);
4e9baad8 RM	100	EXPORT_SYMBOL(rdmsr_safe_on_cpu);
4e9baad8 RM	101	EXPORT_SYMBOL(wrmsr_safe_on_cpu);