12191d657SAlexander Graf /*
22191d657SAlexander Graf  * This program is free software; you can redistribute it and/or modify
32191d657SAlexander Graf  * it under the terms of the GNU General Public License, version 2, as
42191d657SAlexander Graf  * published by the Free Software Foundation.
52191d657SAlexander Graf  *
62191d657SAlexander Graf  * This program is distributed in the hope that it will be useful,
72191d657SAlexander Graf  * but WITHOUT ANY WARRANTY; without even the implied warranty of
82191d657SAlexander Graf  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
92191d657SAlexander Graf  * GNU General Public License for more details.
102191d657SAlexander Graf  *
112191d657SAlexander Graf  * You should have received a copy of the GNU General Public License
122191d657SAlexander Graf  * along with this program; if not, write to the Free Software
132191d657SAlexander Graf  * Foundation, 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
142191d657SAlexander Graf  *
152191d657SAlexander Graf  * Copyright SUSE Linux Products GmbH 2009
162191d657SAlexander Graf  *
172191d657SAlexander Graf  * Authors: Alexander Graf <agraf@suse.de>
182191d657SAlexander Graf  */
192191d657SAlexander Graf 
202191d657SAlexander Graf #include <asm/kvm_ppc.h>
212191d657SAlexander Graf #include <asm/disassemble.h>
222191d657SAlexander Graf #include <asm/kvm_book3s.h>
232191d657SAlexander Graf #include <asm/reg.h>
2495327d08SBenjamin Herrenschmidt #include <asm/switch_to.h>
25b0a94d4eSPaul Mackerras #include <asm/time.h>
265358a963SThomas Huth #include "book3s.h"
272191d657SAlexander Graf 
282191d657SAlexander Graf #define OP_19_XOP_RFID		18
292191d657SAlexander Graf #define OP_19_XOP_RFI		50
302191d657SAlexander Graf 
312191d657SAlexander Graf #define OP_31_XOP_MFMSR		83
322191d657SAlexander Graf #define OP_31_XOP_MTMSR		146
332191d657SAlexander Graf #define OP_31_XOP_MTMSRD	178
342191d657SAlexander Graf #define OP_31_XOP_MTSR		210
352191d657SAlexander Graf #define OP_31_XOP_MTSRIN	242
362191d657SAlexander Graf #define OP_31_XOP_TLBIEL	274
372191d657SAlexander Graf #define OP_31_XOP_TLBIE		306
3850c7bb80SAlexander Graf /* Opcode is officially reserved, reuse it as sc 1 when sc 1 doesn't trap */
3950c7bb80SAlexander Graf #define OP_31_XOP_FAKE_SC1	308
402191d657SAlexander Graf #define OP_31_XOP_SLBMTE	402
412191d657SAlexander Graf #define OP_31_XOP_SLBIE		434
422191d657SAlexander Graf #define OP_31_XOP_SLBIA		498
432191d657SAlexander Graf #define OP_31_XOP_MFSR		595
442191d657SAlexander Graf #define OP_31_XOP_MFSRIN	659
452191d657SAlexander Graf #define OP_31_XOP_DCBA		758
462191d657SAlexander Graf #define OP_31_XOP_SLBMFEV	851
472191d657SAlexander Graf #define OP_31_XOP_EIOIO		854
482191d657SAlexander Graf #define OP_31_XOP_SLBMFEE	915
492191d657SAlexander Graf 
502191d657SAlexander Graf /* DCBZ is actually 1014, but we patch it to 1010 so we get a trap */
512191d657SAlexander Graf #define OP_31_XOP_DCBZ		1010
522191d657SAlexander Graf 
532191d657SAlexander Graf #define OP_LFS			48
542191d657SAlexander Graf #define OP_LFD			50
552191d657SAlexander Graf #define OP_STFS			52
562191d657SAlexander Graf #define OP_STFD			54
572191d657SAlexander Graf 
582191d657SAlexander Graf #define SPRN_GQR0		912
592191d657SAlexander Graf #define SPRN_GQR1		913
602191d657SAlexander Graf #define SPRN_GQR2		914
612191d657SAlexander Graf #define SPRN_GQR3		915
622191d657SAlexander Graf #define SPRN_GQR4		916
632191d657SAlexander Graf #define SPRN_GQR5		917
642191d657SAlexander Graf #define SPRN_GQR6		918
652191d657SAlexander Graf #define SPRN_GQR7		919
662191d657SAlexander Graf 
6707b0907dSAlexander Graf /* Book3S_32 defines mfsrin(v) - but that messes up our abstract
6807b0907dSAlexander Graf  * function pointers, so let's just disable the define. */
6907b0907dSAlexander Graf #undef mfsrin
7007b0907dSAlexander Graf 
71317a8fa3SAlexander Graf enum priv_level {
72317a8fa3SAlexander Graf 	PRIV_PROBLEM = 0,
73317a8fa3SAlexander Graf 	PRIV_SUPER = 1,
74317a8fa3SAlexander Graf 	PRIV_HYPER = 2,
75317a8fa3SAlexander Graf };
76317a8fa3SAlexander Graf 
77317a8fa3SAlexander Graf static bool spr_allowed(struct kvm_vcpu *vcpu, enum priv_level level)
78317a8fa3SAlexander Graf {
79317a8fa3SAlexander Graf 	/* PAPR VMs only access supervisor SPRs */
80317a8fa3SAlexander Graf 	if (vcpu->arch.papr_enabled && (level > PRIV_SUPER))
81317a8fa3SAlexander Graf 		return false;
82317a8fa3SAlexander Graf 
83317a8fa3SAlexander Graf 	/* Limit user space to its own small SPR set */
845deb8e7aSAlexander Graf 	if ((kvmppc_get_msr(vcpu) & MSR_PR) && level > PRIV_PROBLEM)
85317a8fa3SAlexander Graf 		return false;
86317a8fa3SAlexander Graf 
87317a8fa3SAlexander Graf 	return true;
88317a8fa3SAlexander Graf }
89317a8fa3SAlexander Graf 
903a167beaSAneesh Kumar K.V int kvmppc_core_emulate_op_pr(struct kvm_run *run, struct kvm_vcpu *vcpu,
912191d657SAlexander Graf 			      unsigned int inst, int *advance)
922191d657SAlexander Graf {
932191d657SAlexander Graf 	int emulated = EMULATE_DONE;
94c46dc9a8SAlexander Graf 	int rt = get_rt(inst);
95c46dc9a8SAlexander Graf 	int rs = get_rs(inst);
96c46dc9a8SAlexander Graf 	int ra = get_ra(inst);
97c46dc9a8SAlexander Graf 	int rb = get_rb(inst);
9842188365SAlexander Graf 	u32 inst_sc = 0x44000002;
992191d657SAlexander Graf 
1002191d657SAlexander Graf 	switch (get_op(inst)) {
10142188365SAlexander Graf 	case 0:
10242188365SAlexander Graf 		emulated = EMULATE_FAIL;
10342188365SAlexander Graf 		if ((kvmppc_get_msr(vcpu) & MSR_LE) &&
10442188365SAlexander Graf 		    (inst == swab32(inst_sc))) {
10542188365SAlexander Graf 			/*
10642188365SAlexander Graf 			 * This is the byte reversed syscall instruction of our
10742188365SAlexander Graf 			 * hypercall handler. Early versions of LE Linux didn't
10842188365SAlexander Graf 			 * swap the instructions correctly and ended up in
10942188365SAlexander Graf 			 * illegal instructions.
11042188365SAlexander Graf 			 * Just always fail hypercalls on these broken systems.
11142188365SAlexander Graf 			 */
11242188365SAlexander Graf 			kvmppc_set_gpr(vcpu, 3, EV_UNIMPLEMENTED);
11342188365SAlexander Graf 			kvmppc_set_pc(vcpu, kvmppc_get_pc(vcpu) + 4);
11442188365SAlexander Graf 			emulated = EMULATE_DONE;
11542188365SAlexander Graf 		}
11642188365SAlexander Graf 		break;
1172191d657SAlexander Graf 	case 19:
1182191d657SAlexander Graf 		switch (get_xop(inst)) {
1192191d657SAlexander Graf 		case OP_19_XOP_RFID:
120401a89e9SSimon Guo 		case OP_19_XOP_RFI: {
121401a89e9SSimon Guo 			unsigned long srr1 = kvmppc_get_srr1(vcpu);
122401a89e9SSimon Guo #ifdef CONFIG_PPC_TRANSACTIONAL_MEM
123401a89e9SSimon Guo 			unsigned long cur_msr = kvmppc_get_msr(vcpu);
124401a89e9SSimon Guo 
125401a89e9SSimon Guo 			/*
126401a89e9SSimon Guo 			 * add rules to fit in ISA specification regarding TM
127401a89e9SSimon Guo 			 * state transistion in TM disable/Suspended state,
128401a89e9SSimon Guo 			 * and target TM state is TM inactive(00) state. (the
129401a89e9SSimon Guo 			 * change should be suppressed).
130401a89e9SSimon Guo 			 */
131401a89e9SSimon Guo 			if (((cur_msr & MSR_TM) == 0) &&
132401a89e9SSimon Guo 				((srr1 & MSR_TM) == 0) &&
133401a89e9SSimon Guo 				MSR_TM_SUSPENDED(cur_msr) &&
134401a89e9SSimon Guo 				!MSR_TM_ACTIVE(srr1))
135401a89e9SSimon Guo 				srr1 |= MSR_TS_S;
136401a89e9SSimon Guo #endif
1375deb8e7aSAlexander Graf 			kvmppc_set_pc(vcpu, kvmppc_get_srr0(vcpu));
138401a89e9SSimon Guo 			kvmppc_set_msr(vcpu, srr1);
1392191d657SAlexander Graf 			*advance = 0;
1402191d657SAlexander Graf 			break;
141401a89e9SSimon Guo 		}
1422191d657SAlexander Graf 
1432191d657SAlexander Graf 		default:
1442191d657SAlexander Graf 			emulated = EMULATE_FAIL;
1452191d657SAlexander Graf 			break;
1462191d657SAlexander Graf 		}
1472191d657SAlexander Graf 		break;
1482191d657SAlexander Graf 	case 31:
1492191d657SAlexander Graf 		switch (get_xop(inst)) {
1502191d657SAlexander Graf 		case OP_31_XOP_MFMSR:
1515deb8e7aSAlexander Graf 			kvmppc_set_gpr(vcpu, rt, kvmppc_get_msr(vcpu));
1522191d657SAlexander Graf 			break;
1532191d657SAlexander Graf 		case OP_31_XOP_MTMSRD:
1542191d657SAlexander Graf 		{
155c46dc9a8SAlexander Graf 			ulong rs_val = kvmppc_get_gpr(vcpu, rs);
1562191d657SAlexander Graf 			if (inst & 0x10000) {
1575deb8e7aSAlexander Graf 				ulong new_msr = kvmppc_get_msr(vcpu);
158c46dc9a8SAlexander Graf 				new_msr &= ~(MSR_RI | MSR_EE);
159c46dc9a8SAlexander Graf 				new_msr |= rs_val & (MSR_RI | MSR_EE);
1605deb8e7aSAlexander Graf 				kvmppc_set_msr_fast(vcpu, new_msr);
1612191d657SAlexander Graf 			} else
162c46dc9a8SAlexander Graf 				kvmppc_set_msr(vcpu, rs_val);
1632191d657SAlexander Graf 			break;
1642191d657SAlexander Graf 		}
1652191d657SAlexander Graf 		case OP_31_XOP_MTMSR:
166c46dc9a8SAlexander Graf 			kvmppc_set_msr(vcpu, kvmppc_get_gpr(vcpu, rs));
1672191d657SAlexander Graf 			break;
1682191d657SAlexander Graf 		case OP_31_XOP_MFSR:
1692191d657SAlexander Graf 		{
1702191d657SAlexander Graf 			int srnum;
1712191d657SAlexander Graf 
1722191d657SAlexander Graf 			srnum = kvmppc_get_field(inst, 12 + 32, 15 + 32);
1732191d657SAlexander Graf 			if (vcpu->arch.mmu.mfsrin) {
1742191d657SAlexander Graf 				u32 sr;
1752191d657SAlexander Graf 				sr = vcpu->arch.mmu.mfsrin(vcpu, srnum);
176c46dc9a8SAlexander Graf 				kvmppc_set_gpr(vcpu, rt, sr);
1772191d657SAlexander Graf 			}
1782191d657SAlexander Graf 			break;
1792191d657SAlexander Graf 		}
1802191d657SAlexander Graf 		case OP_31_XOP_MFSRIN:
1812191d657SAlexander Graf 		{
1822191d657SAlexander Graf 			int srnum;
1832191d657SAlexander Graf 
184c46dc9a8SAlexander Graf 			srnum = (kvmppc_get_gpr(vcpu, rb) >> 28) & 0xf;
1852191d657SAlexander Graf 			if (vcpu->arch.mmu.mfsrin) {
1862191d657SAlexander Graf 				u32 sr;
1872191d657SAlexander Graf 				sr = vcpu->arch.mmu.mfsrin(vcpu, srnum);
188c46dc9a8SAlexander Graf 				kvmppc_set_gpr(vcpu, rt, sr);
1892191d657SAlexander Graf 			}
1902191d657SAlexander Graf 			break;
1912191d657SAlexander Graf 		}
1922191d657SAlexander Graf 		case OP_31_XOP_MTSR:
1932191d657SAlexander Graf 			vcpu->arch.mmu.mtsrin(vcpu,
1942191d657SAlexander Graf 				(inst >> 16) & 0xf,
195c46dc9a8SAlexander Graf 				kvmppc_get_gpr(vcpu, rs));
1962191d657SAlexander Graf 			break;
1972191d657SAlexander Graf 		case OP_31_XOP_MTSRIN:
1982191d657SAlexander Graf 			vcpu->arch.mmu.mtsrin(vcpu,
199c46dc9a8SAlexander Graf 				(kvmppc_get_gpr(vcpu, rb) >> 28) & 0xf,
200c46dc9a8SAlexander Graf 				kvmppc_get_gpr(vcpu, rs));
2012191d657SAlexander Graf 			break;
2022191d657SAlexander Graf 		case OP_31_XOP_TLBIE:
2032191d657SAlexander Graf 		case OP_31_XOP_TLBIEL:
2042191d657SAlexander Graf 		{
2052191d657SAlexander Graf 			bool large = (inst & 0x00200000) ? true : false;
206c46dc9a8SAlexander Graf 			ulong addr = kvmppc_get_gpr(vcpu, rb);
2072191d657SAlexander Graf 			vcpu->arch.mmu.tlbie(vcpu, addr, large);
2082191d657SAlexander Graf 			break;
2092191d657SAlexander Graf 		}
2102ba9f0d8SAneesh Kumar K.V #ifdef CONFIG_PPC_BOOK3S_64
21150c7bb80SAlexander Graf 		case OP_31_XOP_FAKE_SC1:
21250c7bb80SAlexander Graf 		{
21350c7bb80SAlexander Graf 			/* SC 1 papr hypercalls */
21450c7bb80SAlexander Graf 			ulong cmd = kvmppc_get_gpr(vcpu, 3);
21550c7bb80SAlexander Graf 			int i;
21650c7bb80SAlexander Graf 
2175deb8e7aSAlexander Graf 		        if ((kvmppc_get_msr(vcpu) & MSR_PR) ||
21850c7bb80SAlexander Graf 			    !vcpu->arch.papr_enabled) {
21950c7bb80SAlexander Graf 				emulated = EMULATE_FAIL;
22050c7bb80SAlexander Graf 				break;
22150c7bb80SAlexander Graf 			}
22250c7bb80SAlexander Graf 
22350c7bb80SAlexander Graf 			if (kvmppc_h_pr(vcpu, cmd) == EMULATE_DONE)
22450c7bb80SAlexander Graf 				break;
22550c7bb80SAlexander Graf 
22650c7bb80SAlexander Graf 			run->papr_hcall.nr = cmd;
22750c7bb80SAlexander Graf 			for (i = 0; i < 9; ++i) {
22850c7bb80SAlexander Graf 				ulong gpr = kvmppc_get_gpr(vcpu, 4 + i);
22950c7bb80SAlexander Graf 				run->papr_hcall.args[i] = gpr;
23050c7bb80SAlexander Graf 			}
23150c7bb80SAlexander Graf 
2320f47f9b5SBharat Bhushan 			run->exit_reason = KVM_EXIT_PAPR_HCALL;
2330f47f9b5SBharat Bhushan 			vcpu->arch.hcall_needed = 1;
234c402a3f4SBharat Bhushan 			emulated = EMULATE_EXIT_USER;
23550c7bb80SAlexander Graf 			break;
23650c7bb80SAlexander Graf 		}
23750c7bb80SAlexander Graf #endif
2382191d657SAlexander Graf 		case OP_31_XOP_EIOIO:
2392191d657SAlexander Graf 			break;
2402191d657SAlexander Graf 		case OP_31_XOP_SLBMTE:
2412191d657SAlexander Graf 			if (!vcpu->arch.mmu.slbmte)
2422191d657SAlexander Graf 				return EMULATE_FAIL;
2432191d657SAlexander Graf 
2442191d657SAlexander Graf 			vcpu->arch.mmu.slbmte(vcpu,
245c46dc9a8SAlexander Graf 					kvmppc_get_gpr(vcpu, rs),
246c46dc9a8SAlexander Graf 					kvmppc_get_gpr(vcpu, rb));
2472191d657SAlexander Graf 			break;
2482191d657SAlexander Graf 		case OP_31_XOP_SLBIE:
2492191d657SAlexander Graf 			if (!vcpu->arch.mmu.slbie)
2502191d657SAlexander Graf 				return EMULATE_FAIL;
2512191d657SAlexander Graf 
2522191d657SAlexander Graf 			vcpu->arch.mmu.slbie(vcpu,
253c46dc9a8SAlexander Graf 					kvmppc_get_gpr(vcpu, rb));
2542191d657SAlexander Graf 			break;
2552191d657SAlexander Graf 		case OP_31_XOP_SLBIA:
2562191d657SAlexander Graf 			if (!vcpu->arch.mmu.slbia)
2572191d657SAlexander Graf 				return EMULATE_FAIL;
2582191d657SAlexander Graf 
2592191d657SAlexander Graf 			vcpu->arch.mmu.slbia(vcpu);
2602191d657SAlexander Graf 			break;
2612191d657SAlexander Graf 		case OP_31_XOP_SLBMFEE:
2622191d657SAlexander Graf 			if (!vcpu->arch.mmu.slbmfee) {
2632191d657SAlexander Graf 				emulated = EMULATE_FAIL;
2642191d657SAlexander Graf 			} else {
265c46dc9a8SAlexander Graf 				ulong t, rb_val;
2662191d657SAlexander Graf 
267c46dc9a8SAlexander Graf 				rb_val = kvmppc_get_gpr(vcpu, rb);
268c46dc9a8SAlexander Graf 				t = vcpu->arch.mmu.slbmfee(vcpu, rb_val);
269c46dc9a8SAlexander Graf 				kvmppc_set_gpr(vcpu, rt, t);
2702191d657SAlexander Graf 			}
2712191d657SAlexander Graf 			break;
2722191d657SAlexander Graf 		case OP_31_XOP_SLBMFEV:
2732191d657SAlexander Graf 			if (!vcpu->arch.mmu.slbmfev) {
2742191d657SAlexander Graf 				emulated = EMULATE_FAIL;
2752191d657SAlexander Graf 			} else {
276c46dc9a8SAlexander Graf 				ulong t, rb_val;
2772191d657SAlexander Graf 
278c46dc9a8SAlexander Graf 				rb_val = kvmppc_get_gpr(vcpu, rb);
279c46dc9a8SAlexander Graf 				t = vcpu->arch.mmu.slbmfev(vcpu, rb_val);
280c46dc9a8SAlexander Graf 				kvmppc_set_gpr(vcpu, rt, t);
2812191d657SAlexander Graf 			}
2822191d657SAlexander Graf 			break;
2832191d657SAlexander Graf 		case OP_31_XOP_DCBA:
2842191d657SAlexander Graf 			/* Gets treated as NOP */
2852191d657SAlexander Graf 			break;
2862191d657SAlexander Graf 		case OP_31_XOP_DCBZ:
2872191d657SAlexander Graf 		{
288c46dc9a8SAlexander Graf 			ulong rb_val = kvmppc_get_gpr(vcpu, rb);
289c46dc9a8SAlexander Graf 			ulong ra_val = 0;
2902191d657SAlexander Graf 			ulong addr, vaddr;
2912191d657SAlexander Graf 			u32 zeros[8] = { 0, 0, 0, 0, 0, 0, 0, 0 };
2922191d657SAlexander Graf 			u32 dsisr;
2932191d657SAlexander Graf 			int r;
2942191d657SAlexander Graf 
295c46dc9a8SAlexander Graf 			if (ra)
296c46dc9a8SAlexander Graf 				ra_val = kvmppc_get_gpr(vcpu, ra);
2972191d657SAlexander Graf 
298c46dc9a8SAlexander Graf 			addr = (ra_val + rb_val) & ~31ULL;
2995deb8e7aSAlexander Graf 			if (!(kvmppc_get_msr(vcpu) & MSR_SF))
3002191d657SAlexander Graf 				addr &= 0xffffffff;
3012191d657SAlexander Graf 			vaddr = addr;
3022191d657SAlexander Graf 
3032191d657SAlexander Graf 			r = kvmppc_st(vcpu, &addr, 32, zeros, true);
3042191d657SAlexander Graf 			if ((r == -ENOENT) || (r == -EPERM)) {
3052191d657SAlexander Graf 				*advance = 0;
3065deb8e7aSAlexander Graf 				kvmppc_set_dar(vcpu, vaddr);
307a2d56020SPaul Mackerras 				vcpu->arch.fault_dar = vaddr;
3082191d657SAlexander Graf 
3092191d657SAlexander Graf 				dsisr = DSISR_ISSTORE;
3102191d657SAlexander Graf 				if (r == -ENOENT)
3112191d657SAlexander Graf 					dsisr |= DSISR_NOHPTE;
3122191d657SAlexander Graf 				else if (r == -EPERM)
3132191d657SAlexander Graf 					dsisr |= DSISR_PROTFAULT;
3142191d657SAlexander Graf 
3155deb8e7aSAlexander Graf 				kvmppc_set_dsisr(vcpu, dsisr);
316a2d56020SPaul Mackerras 				vcpu->arch.fault_dsisr = dsisr;
3172191d657SAlexander Graf 
3182191d657SAlexander Graf 				kvmppc_book3s_queue_irqprio(vcpu,
3192191d657SAlexander Graf 					BOOK3S_INTERRUPT_DATA_STORAGE);
3202191d657SAlexander Graf 			}
3212191d657SAlexander Graf 
3222191d657SAlexander Graf 			break;
3232191d657SAlexander Graf 		}
3242191d657SAlexander Graf 		default:
3252191d657SAlexander Graf 			emulated = EMULATE_FAIL;
3262191d657SAlexander Graf 		}
3272191d657SAlexander Graf 		break;
3282191d657SAlexander Graf 	default:
3292191d657SAlexander Graf 		emulated = EMULATE_FAIL;
3302191d657SAlexander Graf 	}
3312191d657SAlexander Graf 
3322191d657SAlexander Graf 	if (emulated == EMULATE_FAIL)
3332191d657SAlexander Graf 		emulated = kvmppc_emulate_paired_single(run, vcpu);
3342191d657SAlexander Graf 
3352191d657SAlexander Graf 	return emulated;
3362191d657SAlexander Graf }
3372191d657SAlexander Graf 
3382191d657SAlexander Graf void kvmppc_set_bat(struct kvm_vcpu *vcpu, struct kvmppc_bat *bat, bool upper,
3392191d657SAlexander Graf                     u32 val)
3402191d657SAlexander Graf {
3412191d657SAlexander Graf 	if (upper) {
3422191d657SAlexander Graf 		/* Upper BAT */
3432191d657SAlexander Graf 		u32 bl = (val >> 2) & 0x7ff;
3442191d657SAlexander Graf 		bat->bepi_mask = (~bl << 17);
3452191d657SAlexander Graf 		bat->bepi = val & 0xfffe0000;
3462191d657SAlexander Graf 		bat->vs = (val & 2) ? 1 : 0;
3472191d657SAlexander Graf 		bat->vp = (val & 1) ? 1 : 0;
3482191d657SAlexander Graf 		bat->raw = (bat->raw & 0xffffffff00000000ULL) | val;
3492191d657SAlexander Graf 	} else {
3502191d657SAlexander Graf 		/* Lower BAT */
3512191d657SAlexander Graf 		bat->brpn = val & 0xfffe0000;
3522191d657SAlexander Graf 		bat->wimg = (val >> 3) & 0xf;
3532191d657SAlexander Graf 		bat->pp = val & 3;
3542191d657SAlexander Graf 		bat->raw = (bat->raw & 0x00000000ffffffffULL) | ((u64)val << 32);
3552191d657SAlexander Graf 	}
3562191d657SAlexander Graf }
3572191d657SAlexander Graf 
358c1c88e2fSAlexander Graf static struct kvmppc_bat *kvmppc_find_bat(struct kvm_vcpu *vcpu, int sprn)
3592191d657SAlexander Graf {
3602191d657SAlexander Graf 	struct kvmppc_vcpu_book3s *vcpu_book3s = to_book3s(vcpu);
3612191d657SAlexander Graf 	struct kvmppc_bat *bat;
3622191d657SAlexander Graf 
3632191d657SAlexander Graf 	switch (sprn) {
3642191d657SAlexander Graf 	case SPRN_IBAT0U ... SPRN_IBAT3L:
3652191d657SAlexander Graf 		bat = &vcpu_book3s->ibat[(sprn - SPRN_IBAT0U) / 2];
3662191d657SAlexander Graf 		break;
3672191d657SAlexander Graf 	case SPRN_IBAT4U ... SPRN_IBAT7L:
3682191d657SAlexander Graf 		bat = &vcpu_book3s->ibat[4 + ((sprn - SPRN_IBAT4U) / 2)];
3692191d657SAlexander Graf 		break;
3702191d657SAlexander Graf 	case SPRN_DBAT0U ... SPRN_DBAT3L:
3712191d657SAlexander Graf 		bat = &vcpu_book3s->dbat[(sprn - SPRN_DBAT0U) / 2];
3722191d657SAlexander Graf 		break;
3732191d657SAlexander Graf 	case SPRN_DBAT4U ... SPRN_DBAT7L:
3742191d657SAlexander Graf 		bat = &vcpu_book3s->dbat[4 + ((sprn - SPRN_DBAT4U) / 2)];
3752191d657SAlexander Graf 		break;
3762191d657SAlexander Graf 	default:
3772191d657SAlexander Graf 		BUG();
3782191d657SAlexander Graf 	}
3792191d657SAlexander Graf 
380c1c88e2fSAlexander Graf 	return bat;
3812191d657SAlexander Graf }
3822191d657SAlexander Graf 
3833a167beaSAneesh Kumar K.V int kvmppc_core_emulate_mtspr_pr(struct kvm_vcpu *vcpu, int sprn, ulong spr_val)
3842191d657SAlexander Graf {
3852191d657SAlexander Graf 	int emulated = EMULATE_DONE;
3862191d657SAlexander Graf 
3872191d657SAlexander Graf 	switch (sprn) {
3882191d657SAlexander Graf 	case SPRN_SDR1:
389317a8fa3SAlexander Graf 		if (!spr_allowed(vcpu, PRIV_HYPER))
390317a8fa3SAlexander Graf 			goto unprivileged;
3912191d657SAlexander Graf 		to_book3s(vcpu)->sdr1 = spr_val;
3922191d657SAlexander Graf 		break;
3932191d657SAlexander Graf 	case SPRN_DSISR:
3945deb8e7aSAlexander Graf 		kvmppc_set_dsisr(vcpu, spr_val);
3952191d657SAlexander Graf 		break;
3962191d657SAlexander Graf 	case SPRN_DAR:
3975deb8e7aSAlexander Graf 		kvmppc_set_dar(vcpu, spr_val);
3982191d657SAlexander Graf 		break;
3992191d657SAlexander Graf 	case SPRN_HIOR:
4002191d657SAlexander Graf 		to_book3s(vcpu)->hior = spr_val;
4012191d657SAlexander Graf 		break;
4022191d657SAlexander Graf 	case SPRN_IBAT0U ... SPRN_IBAT3L:
4032191d657SAlexander Graf 	case SPRN_IBAT4U ... SPRN_IBAT7L:
4042191d657SAlexander Graf 	case SPRN_DBAT0U ... SPRN_DBAT3L:
4052191d657SAlexander Graf 	case SPRN_DBAT4U ... SPRN_DBAT7L:
406c1c88e2fSAlexander Graf 	{
407c1c88e2fSAlexander Graf 		struct kvmppc_bat *bat = kvmppc_find_bat(vcpu, sprn);
408c1c88e2fSAlexander Graf 
409c1c88e2fSAlexander Graf 		kvmppc_set_bat(vcpu, bat, !(sprn % 2), (u32)spr_val);
4102191d657SAlexander Graf 		/* BAT writes happen so rarely that we're ok to flush
4112191d657SAlexander Graf 		 * everything here */
4122191d657SAlexander Graf 		kvmppc_mmu_pte_flush(vcpu, 0, 0);
4132191d657SAlexander Graf 		kvmppc_mmu_flush_segments(vcpu);
4142191d657SAlexander Graf 		break;
415c1c88e2fSAlexander Graf 	}
4162191d657SAlexander Graf 	case SPRN_HID0:
4172191d657SAlexander Graf 		to_book3s(vcpu)->hid[0] = spr_val;
4182191d657SAlexander Graf 		break;
4192191d657SAlexander Graf 	case SPRN_HID1:
4202191d657SAlexander Graf 		to_book3s(vcpu)->hid[1] = spr_val;
4212191d657SAlexander Graf 		break;
4222191d657SAlexander Graf 	case SPRN_HID2:
4232191d657SAlexander Graf 		to_book3s(vcpu)->hid[2] = spr_val;
4242191d657SAlexander Graf 		break;
4252191d657SAlexander Graf 	case SPRN_HID2_GEKKO:
4262191d657SAlexander Graf 		to_book3s(vcpu)->hid[2] = spr_val;
4272191d657SAlexander Graf 		/* HID2.PSE controls paired single on gekko */
4282191d657SAlexander Graf 		switch (vcpu->arch.pvr) {
4292191d657SAlexander Graf 		case 0x00080200:	/* lonestar 2.0 */
4302191d657SAlexander Graf 		case 0x00088202:	/* lonestar 2.2 */
4312191d657SAlexander Graf 		case 0x70000100:	/* gekko 1.0 */
4322191d657SAlexander Graf 		case 0x00080100:	/* gekko 2.0 */
4332191d657SAlexander Graf 		case 0x00083203:	/* gekko 2.3a */
4342191d657SAlexander Graf 		case 0x00083213:	/* gekko 2.3b */
4352191d657SAlexander Graf 		case 0x00083204:	/* gekko 2.4 */
4362191d657SAlexander Graf 		case 0x00083214:	/* gekko 2.4e (8SE) - retail HW2 */
437b83d4a9cSAlexander Graf 		case 0x00087200:	/* broadway */
438b83d4a9cSAlexander Graf 			if (vcpu->arch.hflags & BOOK3S_HFLAG_NATIVE_PS) {
439b83d4a9cSAlexander Graf 				/* Native paired singles */
440b83d4a9cSAlexander Graf 			} else if (spr_val & (1 << 29)) { /* HID2.PSE */
4412191d657SAlexander Graf 				vcpu->arch.hflags |= BOOK3S_HFLAG_PAIRED_SINGLE;
4422191d657SAlexander Graf 				kvmppc_giveup_ext(vcpu, MSR_FP);
4432191d657SAlexander Graf 			} else {
4442191d657SAlexander Graf 				vcpu->arch.hflags &= ~BOOK3S_HFLAG_PAIRED_SINGLE;
4452191d657SAlexander Graf 			}
4462191d657SAlexander Graf 			break;
4472191d657SAlexander Graf 		}
4482191d657SAlexander Graf 		break;
4492191d657SAlexander Graf 	case SPRN_HID4:
4502191d657SAlexander Graf 	case SPRN_HID4_GEKKO:
4512191d657SAlexander Graf 		to_book3s(vcpu)->hid[4] = spr_val;
4522191d657SAlexander Graf 		break;
4532191d657SAlexander Graf 	case SPRN_HID5:
4542191d657SAlexander Graf 		to_book3s(vcpu)->hid[5] = spr_val;
4552191d657SAlexander Graf 		/* guest HID5 set can change is_dcbz32 */
4562191d657SAlexander Graf 		if (vcpu->arch.mmu.is_dcbz32(vcpu) &&
4572191d657SAlexander Graf 		    (mfmsr() & MSR_HV))
4582191d657SAlexander Graf 			vcpu->arch.hflags |= BOOK3S_HFLAG_DCBZ32;
4592191d657SAlexander Graf 		break;
4602191d657SAlexander Graf 	case SPRN_GQR0:
4612191d657SAlexander Graf 	case SPRN_GQR1:
4622191d657SAlexander Graf 	case SPRN_GQR2:
4632191d657SAlexander Graf 	case SPRN_GQR3:
4642191d657SAlexander Graf 	case SPRN_GQR4:
4652191d657SAlexander Graf 	case SPRN_GQR5:
4662191d657SAlexander Graf 	case SPRN_GQR6:
4672191d657SAlexander Graf 	case SPRN_GQR7:
4682191d657SAlexander Graf 		to_book3s(vcpu)->gqr[sprn - SPRN_GQR0] = spr_val;
4692191d657SAlexander Graf 		break;
4702e23f544SAlexander Graf #ifdef CONFIG_PPC_BOOK3S_64
4718e6afa36SAlexander Graf 	case SPRN_FSCR:
4728e6afa36SAlexander Graf 		kvmppc_set_fscr(vcpu, spr_val);
4738e6afa36SAlexander Graf 		break;
4742e23f544SAlexander Graf 	case SPRN_BESCR:
4752e23f544SAlexander Graf 		vcpu->arch.bescr = spr_val;
4762e23f544SAlexander Graf 		break;
4772e23f544SAlexander Graf 	case SPRN_EBBHR:
4782e23f544SAlexander Graf 		vcpu->arch.ebbhr = spr_val;
4792e23f544SAlexander Graf 		break;
4802e23f544SAlexander Graf 	case SPRN_EBBRR:
4812e23f544SAlexander Graf 		vcpu->arch.ebbrr = spr_val;
4822e23f544SAlexander Graf 		break;
4839916d57eSAlexander Graf #ifdef CONFIG_PPC_TRANSACTIONAL_MEM
4849916d57eSAlexander Graf 	case SPRN_TFHAR:
4859916d57eSAlexander Graf 		vcpu->arch.tfhar = spr_val;
4869916d57eSAlexander Graf 		break;
4879916d57eSAlexander Graf 	case SPRN_TEXASR:
4889916d57eSAlexander Graf 		vcpu->arch.texasr = spr_val;
4899916d57eSAlexander Graf 		break;
4909916d57eSAlexander Graf 	case SPRN_TFIAR:
4919916d57eSAlexander Graf 		vcpu->arch.tfiar = spr_val;
4929916d57eSAlexander Graf 		break;
4939916d57eSAlexander Graf #endif
4942e23f544SAlexander Graf #endif
4952191d657SAlexander Graf 	case SPRN_ICTC:
4962191d657SAlexander Graf 	case SPRN_THRM1:
4972191d657SAlexander Graf 	case SPRN_THRM2:
4982191d657SAlexander Graf 	case SPRN_THRM3:
4992191d657SAlexander Graf 	case SPRN_CTRLF:
5002191d657SAlexander Graf 	case SPRN_CTRLT:
5012191d657SAlexander Graf 	case SPRN_L2CR:
502b0a94d4eSPaul Mackerras 	case SPRN_DSCR:
5032191d657SAlexander Graf 	case SPRN_MMCR0_GEKKO:
5042191d657SAlexander Graf 	case SPRN_MMCR1_GEKKO:
5052191d657SAlexander Graf 	case SPRN_PMC1_GEKKO:
5062191d657SAlexander Graf 	case SPRN_PMC2_GEKKO:
5072191d657SAlexander Graf 	case SPRN_PMC3_GEKKO:
5082191d657SAlexander Graf 	case SPRN_PMC4_GEKKO:
5092191d657SAlexander Graf 	case SPRN_WPAR_GEKKO:
510f2be6550SMihai Caraman 	case SPRN_MSSSR0:
511f3532028SAlexander Graf 	case SPRN_DABR:
512f8f6eb0dSAlexander Graf #ifdef CONFIG_PPC_BOOK3S_64
513f8f6eb0dSAlexander Graf 	case SPRN_MMCRS:
514f8f6eb0dSAlexander Graf 	case SPRN_MMCRA:
515f8f6eb0dSAlexander Graf 	case SPRN_MMCR0:
516f8f6eb0dSAlexander Graf 	case SPRN_MMCR1:
517f8f6eb0dSAlexander Graf 	case SPRN_MMCR2:
518fa73c3b2SThomas Huth 	case SPRN_UMMCR2:
519f8f6eb0dSAlexander Graf #endif
5202191d657SAlexander Graf 		break;
521317a8fa3SAlexander Graf unprivileged:
5222191d657SAlexander Graf 	default:
523feafd13cSThomas Huth 		pr_info_ratelimited("KVM: invalid SPR write: %d\n", sprn);
524feafd13cSThomas Huth 		if (sprn & 0x10) {
525feafd13cSThomas Huth 			if (kvmppc_get_msr(vcpu) & MSR_PR) {
526feafd13cSThomas Huth 				kvmppc_core_queue_program(vcpu, SRR1_PROGPRIV);
527feafd13cSThomas Huth 				emulated = EMULATE_AGAIN;
528feafd13cSThomas Huth 			}
529feafd13cSThomas Huth 		} else {
530feafd13cSThomas Huth 			if ((kvmppc_get_msr(vcpu) & MSR_PR) || sprn == 0) {
531feafd13cSThomas Huth 				kvmppc_core_queue_program(vcpu, SRR1_PROGILL);
532feafd13cSThomas Huth 				emulated = EMULATE_AGAIN;
533feafd13cSThomas Huth 			}
534feafd13cSThomas Huth 		}
5352191d657SAlexander Graf 		break;
5362191d657SAlexander Graf 	}
5372191d657SAlexander Graf 
5382191d657SAlexander Graf 	return emulated;
5392191d657SAlexander Graf }
5402191d657SAlexander Graf 
5413a167beaSAneesh Kumar K.V int kvmppc_core_emulate_mfspr_pr(struct kvm_vcpu *vcpu, int sprn, ulong *spr_val)
5422191d657SAlexander Graf {
5432191d657SAlexander Graf 	int emulated = EMULATE_DONE;
5442191d657SAlexander Graf 
5452191d657SAlexander Graf 	switch (sprn) {
5462191d657SAlexander Graf 	case SPRN_IBAT0U ... SPRN_IBAT3L:
5472191d657SAlexander Graf 	case SPRN_IBAT4U ... SPRN_IBAT7L:
5482191d657SAlexander Graf 	case SPRN_DBAT0U ... SPRN_DBAT3L:
5492191d657SAlexander Graf 	case SPRN_DBAT4U ... SPRN_DBAT7L:
550c1c88e2fSAlexander Graf 	{
551c1c88e2fSAlexander Graf 		struct kvmppc_bat *bat = kvmppc_find_bat(vcpu, sprn);
552c1c88e2fSAlexander Graf 
553c1c88e2fSAlexander Graf 		if (sprn % 2)
55454771e62SAlexander Graf 			*spr_val = bat->raw >> 32;
555c1c88e2fSAlexander Graf 		else
55654771e62SAlexander Graf 			*spr_val = bat->raw;
557c1c88e2fSAlexander Graf 
5582191d657SAlexander Graf 		break;
559c1c88e2fSAlexander Graf 	}
5602191d657SAlexander Graf 	case SPRN_SDR1:
561317a8fa3SAlexander Graf 		if (!spr_allowed(vcpu, PRIV_HYPER))
562317a8fa3SAlexander Graf 			goto unprivileged;
56354771e62SAlexander Graf 		*spr_val = to_book3s(vcpu)->sdr1;
5642191d657SAlexander Graf 		break;
5652191d657SAlexander Graf 	case SPRN_DSISR:
5665deb8e7aSAlexander Graf 		*spr_val = kvmppc_get_dsisr(vcpu);
5672191d657SAlexander Graf 		break;
5682191d657SAlexander Graf 	case SPRN_DAR:
5695deb8e7aSAlexander Graf 		*spr_val = kvmppc_get_dar(vcpu);
5702191d657SAlexander Graf 		break;
5712191d657SAlexander Graf 	case SPRN_HIOR:
57254771e62SAlexander Graf 		*spr_val = to_book3s(vcpu)->hior;
5732191d657SAlexander Graf 		break;
5742191d657SAlexander Graf 	case SPRN_HID0:
57554771e62SAlexander Graf 		*spr_val = to_book3s(vcpu)->hid[0];
5762191d657SAlexander Graf 		break;
5772191d657SAlexander Graf 	case SPRN_HID1:
57854771e62SAlexander Graf 		*spr_val = to_book3s(vcpu)->hid[1];
5792191d657SAlexander Graf 		break;
5802191d657SAlexander Graf 	case SPRN_HID2:
5812191d657SAlexander Graf 	case SPRN_HID2_GEKKO:
58254771e62SAlexander Graf 		*spr_val = to_book3s(vcpu)->hid[2];
5832191d657SAlexander Graf 		break;
5842191d657SAlexander Graf 	case SPRN_HID4:
5852191d657SAlexander Graf 	case SPRN_HID4_GEKKO:
58654771e62SAlexander Graf 		*spr_val = to_book3s(vcpu)->hid[4];
5872191d657SAlexander Graf 		break;
5882191d657SAlexander Graf 	case SPRN_HID5:
58954771e62SAlexander Graf 		*spr_val = to_book3s(vcpu)->hid[5];
5902191d657SAlexander Graf 		break;
591aacf9aa3SAlexander Graf 	case SPRN_CFAR:
592b0a94d4eSPaul Mackerras 	case SPRN_DSCR:
59354771e62SAlexander Graf 		*spr_val = 0;
594aacf9aa3SAlexander Graf 		break;
595b0a94d4eSPaul Mackerras 	case SPRN_PURR:
5963cd60e31SAneesh Kumar K.V 		/*
5973cd60e31SAneesh Kumar K.V 		 * On exit we would have updated purr
5983cd60e31SAneesh Kumar K.V 		 */
5993cd60e31SAneesh Kumar K.V 		*spr_val = vcpu->arch.purr;
600b0a94d4eSPaul Mackerras 		break;
601b0a94d4eSPaul Mackerras 	case SPRN_SPURR:
6023cd60e31SAneesh Kumar K.V 		/*
6033cd60e31SAneesh Kumar K.V 		 * On exit we would have updated spurr
6043cd60e31SAneesh Kumar K.V 		 */
6053cd60e31SAneesh Kumar K.V 		*spr_val = vcpu->arch.spurr;
606b0a94d4eSPaul Mackerras 		break;
6078f42ab27SAneesh Kumar K.V 	case SPRN_VTB:
60888b02cf9SPaul Mackerras 		*spr_val = to_book3s(vcpu)->vtb;
6098f42ab27SAneesh Kumar K.V 		break;
61006da28e7SAneesh Kumar K.V 	case SPRN_IC:
61106da28e7SAneesh Kumar K.V 		*spr_val = vcpu->arch.ic;
61206da28e7SAneesh Kumar K.V 		break;
6132191d657SAlexander Graf 	case SPRN_GQR0:
6142191d657SAlexander Graf 	case SPRN_GQR1:
6152191d657SAlexander Graf 	case SPRN_GQR2:
6162191d657SAlexander Graf 	case SPRN_GQR3:
6172191d657SAlexander Graf 	case SPRN_GQR4:
6182191d657SAlexander Graf 	case SPRN_GQR5:
6192191d657SAlexander Graf 	case SPRN_GQR6:
6202191d657SAlexander Graf 	case SPRN_GQR7:
62154771e62SAlexander Graf 		*spr_val = to_book3s(vcpu)->gqr[sprn - SPRN_GQR0];
6222191d657SAlexander Graf 		break;
6238e6afa36SAlexander Graf #ifdef CONFIG_PPC_BOOK3S_64
624616dff86SAlexander Graf 	case SPRN_FSCR:
625616dff86SAlexander Graf 		*spr_val = vcpu->arch.fscr;
626616dff86SAlexander Graf 		break;
6272e23f544SAlexander Graf 	case SPRN_BESCR:
6282e23f544SAlexander Graf 		*spr_val = vcpu->arch.bescr;
6292e23f544SAlexander Graf 		break;
6302e23f544SAlexander Graf 	case SPRN_EBBHR:
6312e23f544SAlexander Graf 		*spr_val = vcpu->arch.ebbhr;
6322e23f544SAlexander Graf 		break;
6332e23f544SAlexander Graf 	case SPRN_EBBRR:
6342e23f544SAlexander Graf 		*spr_val = vcpu->arch.ebbrr;
6352e23f544SAlexander Graf 		break;
6369916d57eSAlexander Graf #ifdef CONFIG_PPC_TRANSACTIONAL_MEM
6379916d57eSAlexander Graf 	case SPRN_TFHAR:
6389916d57eSAlexander Graf 		*spr_val = vcpu->arch.tfhar;
6399916d57eSAlexander Graf 		break;
6409916d57eSAlexander Graf 	case SPRN_TEXASR:
6419916d57eSAlexander Graf 		*spr_val = vcpu->arch.texasr;
6429916d57eSAlexander Graf 		break;
6439916d57eSAlexander Graf 	case SPRN_TFIAR:
6449916d57eSAlexander Graf 		*spr_val = vcpu->arch.tfiar;
6459916d57eSAlexander Graf 		break;
6469916d57eSAlexander Graf #endif
6472e23f544SAlexander Graf #endif
6482191d657SAlexander Graf 	case SPRN_THRM1:
6492191d657SAlexander Graf 	case SPRN_THRM2:
6502191d657SAlexander Graf 	case SPRN_THRM3:
6512191d657SAlexander Graf 	case SPRN_CTRLF:
6522191d657SAlexander Graf 	case SPRN_CTRLT:
6532191d657SAlexander Graf 	case SPRN_L2CR:
6542191d657SAlexander Graf 	case SPRN_MMCR0_GEKKO:
6552191d657SAlexander Graf 	case SPRN_MMCR1_GEKKO:
6562191d657SAlexander Graf 	case SPRN_PMC1_GEKKO:
6572191d657SAlexander Graf 	case SPRN_PMC2_GEKKO:
6582191d657SAlexander Graf 	case SPRN_PMC3_GEKKO:
6592191d657SAlexander Graf 	case SPRN_PMC4_GEKKO:
6602191d657SAlexander Graf 	case SPRN_WPAR_GEKKO:
661f2be6550SMihai Caraman 	case SPRN_MSSSR0:
662f3532028SAlexander Graf 	case SPRN_DABR:
663f8f6eb0dSAlexander Graf #ifdef CONFIG_PPC_BOOK3S_64
664f8f6eb0dSAlexander Graf 	case SPRN_MMCRS:
665f8f6eb0dSAlexander Graf 	case SPRN_MMCRA:
666f8f6eb0dSAlexander Graf 	case SPRN_MMCR0:
667f8f6eb0dSAlexander Graf 	case SPRN_MMCR1:
668f8f6eb0dSAlexander Graf 	case SPRN_MMCR2:
669fa73c3b2SThomas Huth 	case SPRN_UMMCR2:
670a5948fa0SAlexander Graf 	case SPRN_TIR:
671f8f6eb0dSAlexander Graf #endif
67254771e62SAlexander Graf 		*spr_val = 0;
6732191d657SAlexander Graf 		break;
6742191d657SAlexander Graf 	default:
675317a8fa3SAlexander Graf unprivileged:
676feafd13cSThomas Huth 		pr_info_ratelimited("KVM: invalid SPR read: %d\n", sprn);
677feafd13cSThomas Huth 		if (sprn & 0x10) {
678feafd13cSThomas Huth 			if (kvmppc_get_msr(vcpu) & MSR_PR) {
679feafd13cSThomas Huth 				kvmppc_core_queue_program(vcpu, SRR1_PROGPRIV);
680feafd13cSThomas Huth 				emulated = EMULATE_AGAIN;
681feafd13cSThomas Huth 			}
682feafd13cSThomas Huth 		} else {
683feafd13cSThomas Huth 			if ((kvmppc_get_msr(vcpu) & MSR_PR) || sprn == 0 ||
684feafd13cSThomas Huth 			    sprn == 4 || sprn == 5 || sprn == 6) {
685feafd13cSThomas Huth 				kvmppc_core_queue_program(vcpu, SRR1_PROGILL);
686feafd13cSThomas Huth 				emulated = EMULATE_AGAIN;
687feafd13cSThomas Huth 			}
688feafd13cSThomas Huth 		}
689feafd13cSThomas Huth 
6902191d657SAlexander Graf 		break;
6912191d657SAlexander Graf 	}
6922191d657SAlexander Graf 
6932191d657SAlexander Graf 	return emulated;
6942191d657SAlexander Graf }
6952191d657SAlexander Graf 
6962191d657SAlexander Graf u32 kvmppc_alignment_dsisr(struct kvm_vcpu *vcpu, unsigned int inst)
6972191d657SAlexander Graf {
698ddca156aSAneesh Kumar K.V 	return make_dsisr(inst);
6992191d657SAlexander Graf }
7002191d657SAlexander Graf 
7012191d657SAlexander Graf ulong kvmppc_alignment_dar(struct kvm_vcpu *vcpu, unsigned int inst)
7022191d657SAlexander Graf {
7037310f3a5SAneesh Kumar K.V #ifdef CONFIG_PPC_BOOK3S_64
7047310f3a5SAneesh Kumar K.V 	/*
7057310f3a5SAneesh Kumar K.V 	 * Linux's fix_alignment() assumes that DAR is valid, so can we
7067310f3a5SAneesh Kumar K.V 	 */
7077310f3a5SAneesh Kumar K.V 	return vcpu->arch.fault_dar;
7087310f3a5SAneesh Kumar K.V #else
7092191d657SAlexander Graf 	ulong dar = 0;
710c46dc9a8SAlexander Graf 	ulong ra = get_ra(inst);
711c46dc9a8SAlexander Graf 	ulong rb = get_rb(inst);
7122191d657SAlexander Graf 
7132191d657SAlexander Graf 	switch (get_op(inst)) {
7142191d657SAlexander Graf 	case OP_LFS:
7152191d657SAlexander Graf 	case OP_LFD:
7162191d657SAlexander Graf 	case OP_STFD:
7172191d657SAlexander Graf 	case OP_STFS:
7182191d657SAlexander Graf 		if (ra)
7192191d657SAlexander Graf 			dar = kvmppc_get_gpr(vcpu, ra);
7202191d657SAlexander Graf 		dar += (s32)((s16)inst);
7212191d657SAlexander Graf 		break;
7222191d657SAlexander Graf 	case 31:
7232191d657SAlexander Graf 		if (ra)
7242191d657SAlexander Graf 			dar = kvmppc_get_gpr(vcpu, ra);
725c46dc9a8SAlexander Graf 		dar += kvmppc_get_gpr(vcpu, rb);
7262191d657SAlexander Graf 		break;
7272191d657SAlexander Graf 	default:
7282191d657SAlexander Graf 		printk(KERN_INFO "KVM: Unaligned instruction 0x%x\n", inst);
7292191d657SAlexander Graf 		break;
7302191d657SAlexander Graf 	}
7312191d657SAlexander Graf 
7322191d657SAlexander Graf 	return dar;
7337310f3a5SAneesh Kumar K.V #endif
7342191d657SAlexander Graf }
735