exceptions-64s.S 42.6 KB
Newer Older
1 2 3 4 5 6 7
/*
 * This file contains the 64-bit "server" PowerPC variant
 * of the low level exception handling including exception
 * vectors, exception return, part of the slb and stab
 * handling and other fixed offset specific things.
 *
 * This file is meant to be #included from head_64.S due to
L
Lucas De Marchi 已提交
8
 * position dependent assembly.
9 10 11 12 13 14
 *
 * Most of this originates from head_64.S and thus has the same
 * copyright history.
 *
 */

15
#include <asm/hw_irq.h>
16
#include <asm/exception-64s.h>
17
#include <asm/ptrace.h>
18
#include <asm/cpuidle.h>
19

20 21 22
/*
 * We layout physical memory as follows:
 * 0x0000 - 0x00ff : Secondary processor spin code
23 24 25 26
 * 0x0100 - 0x17ff : pSeries Interrupt prologs
 * 0x1800 - 0x4000 : interrupt support common interrupt prologs
 * 0x4000 - 0x5fff : pSeries interrupts with IR=1,DR=1
 * 0x6000 - 0x6fff : more interrupt support including for IR=1,DR=1
27
 * 0x7000 - 0x7fff : FWNMI data area
28 29
 * 0x8000 - 0x8fff : Initial (CPU0) segment table
 * 0x9000 -        : Early init and support code
30
 */
31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59
	/* Syscall routine is used twice, in reloc-off and reloc-on paths */
#define SYSCALL_PSERIES_1 					\
BEGIN_FTR_SECTION						\
	cmpdi	r0,0x1ebe ; 					\
	beq-	1f ;						\
END_FTR_SECTION_IFSET(CPU_FTR_REAL_LE)				\
	mr	r9,r13 ;					\
	GET_PACA(r13) ;						\
	mfspr	r11,SPRN_SRR0 ;					\
0:

#define SYSCALL_PSERIES_2_RFID 					\
	mfspr	r12,SPRN_SRR1 ;					\
	ld	r10,PACAKBASE(r13) ; 				\
	LOAD_HANDLER(r10, system_call_entry) ; 			\
	mtspr	SPRN_SRR0,r10 ; 				\
	ld	r10,PACAKMSR(r13) ;				\
	mtspr	SPRN_SRR1,r10 ; 				\
	rfid ; 							\
	b	. ;	/* prevent speculative execution */

#define SYSCALL_PSERIES_3					\
	/* Fast LE/BE switch system call */			\
1:	mfspr	r12,SPRN_SRR1 ;					\
	xori	r12,r12,MSR_LE ;				\
	mtspr	SPRN_SRR1,r12 ;					\
	rfid ;		/* return to userspace */		\
	b	. ;	/* prevent speculative execution */

60 61
#if defined(CONFIG_RELOCATABLE)
	/*
62 63
	 * We can't branch directly so we do it via the CTR which
	 * is volatile across system calls.
64 65 66 67
	 */
#define SYSCALL_PSERIES_2_DIRECT				\
	mflr	r10 ;						\
	ld	r12,PACAKBASE(r13) ; 				\
68
	LOAD_HANDLER(r12, system_call_entry) ;			\
69
	mtctr	r12 ;						\
70 71 72 73 74
	mfspr	r12,SPRN_SRR1 ;					\
	/* Re-use of r13... No spare regs to do this */	\
	li	r13,MSR_RI ;					\
	mtmsrd 	r13,1 ;						\
	GET_PACA(r13) ;	/* get r13 back */			\
75
	bctr ;
76 77 78 79 80 81
#else
	/* We can branch directly */
#define SYSCALL_PSERIES_2_DIRECT				\
	mfspr	r12,SPRN_SRR1 ;					\
	li	r10,MSR_RI ;					\
	mtmsrd 	r10,1 ;			/* Set RI (EE=0) */	\
82
	b	system_call_common ;
83
#endif
84 85 86 87 88 89 90 91 92 93 94 95 96

/*
 * This is the start of the interrupt handlers for pSeries
 * This code runs with relocation off.
 * Code from here to __end_interrupts gets copied down to real
 * address 0x100 when we are running a relocatable kernel.
 * Therefore any relative branches in this section must only
 * branch to labels in this section.
 */
	. = 0x100
	.globl __start_interrupts
__start_interrupts:

97 98 99 100 101 102
	.globl system_reset_pSeries;
system_reset_pSeries:
	SET_SCRATCH0(r13)
#ifdef CONFIG_PPC_P7_NAP
BEGIN_FTR_SECTION
	/* Running native on arch 2.06 or later, check if we are
103
	 * waking up from nap/sleep/winkle.
104 105
	 */
	mfspr	r13,SPRN_SRR1
106 107 108
	rlwinm.	r13,r13,47-31,30,31
	beq	9f

109
	cmpwi	cr3,r13,2
110
	GET_PACA(r13)
111
	bl	pnv_restore_hyp_resource
112

113 114
	li	r0,PNV_THREAD_RUNNING
	stb	r0,PACA_THREAD_IDLE_STATE(r13)	/* Clear thread state */
115

116
#ifdef CONFIG_KVM_BOOK3S_HV_POSSIBLE
117 118 119 120 121 122 123
	li	r0,KVM_HWTHREAD_IN_KERNEL
	stb	r0,HSTATE_HWTHREAD_STATE(r13)
	/* Order setting hwthread_state vs. testing hwthread_req */
	sync
	lbz	r0,HSTATE_HWTHREAD_REQ(r13)
	cmpwi	r0,0
	beq	1f
124 125 126 127
	b	kvm_start_guest
1:
#endif

128 129
	/* Return SRR1 from power7_nap() */
	mfspr	r3,SPRN_SRR1
130
	blt	cr3,2f
131 132
	b	pnv_wakeup_loss
2:	b	pnv_wakeup_noloss
133

134
9:
135
END_FTR_SECTION_IFSET(CPU_FTR_HVMODE | CPU_FTR_ARCH_206)
136
#endif /* CONFIG_PPC_P7_NAP */
137 138
	EXCEPTION_PROLOG_PSERIES(PACA_EXGEN, system_reset_common, EXC_STD,
				 NOTEST, 0x100)
139 140

	. = 0x200
141 142 143 144 145
machine_check_pSeries_1:
	/* This is moved out of line as it can be patched by FW, but
	 * some code path might still want to branch into the original
	 * vector
	 */
146
	SET_SCRATCH0(r13)		/* save r13 */
147 148 149 150 151 152 153 154 155
#ifdef CONFIG_PPC_P7_NAP
BEGIN_FTR_SECTION
	/* Running native on arch 2.06 or later, check if we are
	 * waking up from nap. We only handle no state loss and
	 * supervisor state loss. We do -not- handle hypervisor
	 * state loss at this time.
	 */
	mfspr	r13,SPRN_SRR1
	rlwinm.	r13,r13,47-31,30,31
156
	OPT_GET_SPR(r13, SPRN_CFAR, CPU_FTR_CFAR)
157 158
	beq	9f

159 160
	mfspr	r13,SPRN_SRR1
	rlwinm.	r13,r13,47-31,30,31
161 162 163
	/* waking up from powersave (nap) state */
	cmpwi	cr1,r13,2
	/* Total loss of HV state is fatal. let's just stay stuck here */
164
	OPT_GET_SPR(r13, SPRN_CFAR, CPU_FTR_CFAR)
165 166
	bgt	cr1,.
9:
167
	OPT_SET_SPR(r13, SPRN_CFAR, CPU_FTR_CFAR)
168 169
END_FTR_SECTION_IFSET(CPU_FTR_HVMODE | CPU_FTR_ARCH_206)
#endif /* CONFIG_PPC_P7_NAP */
170
	EXCEPTION_PROLOG_0(PACA_EXMC)
171
BEGIN_FTR_SECTION
172
	b	machine_check_powernv_early
173
FTR_SECTION_ELSE
174
	b	machine_check_pSeries_0
175
ALT_FTR_SECTION_END_IFSET(CPU_FTR_HVMODE)
176 177 178 179

	. = 0x300
	.globl data_access_pSeries
data_access_pSeries:
180
	SET_SCRATCH0(r13)
181
	EXCEPTION_PROLOG_PSERIES(PACA_EXGEN, data_access_common, EXC_STD,
182
				 KVMTEST, 0x300)
183 184 185 186

	. = 0x380
	.globl data_access_slb_pSeries
data_access_slb_pSeries:
187
	SET_SCRATCH0(r13)
188
	EXCEPTION_PROLOG_0(PACA_EXSLB)
189
	EXCEPTION_PROLOG_1(PACA_EXSLB, KVMTEST, 0x380)
190 191
	std	r3,PACA_EXSLB+EX_R3(r13)
	mfspr	r3,SPRN_DAR
192
	mfspr	r12,SPRN_SRR1
193
#ifndef CONFIG_RELOCATABLE
194
	b	slb_miss_realmode
195 196
#else
	/*
197
	 * We can't just use a direct branch to slb_miss_realmode
198 199 200 201 202
	 * because the distance from here to there depends on where
	 * the kernel ends up being put.
	 */
	mfctr	r11
	ld	r10,PACAKBASE(r13)
203
	LOAD_HANDLER(r10, slb_miss_realmode)
204 205 206 207
	mtctr	r10
	bctr
#endif

208
	STD_EXCEPTION_PSERIES(0x400, instruction_access)
209 210 211 212

	. = 0x480
	.globl instruction_access_slb_pSeries
instruction_access_slb_pSeries:
213
	SET_SCRATCH0(r13)
214
	EXCEPTION_PROLOG_0(PACA_EXSLB)
215
	EXCEPTION_PROLOG_1(PACA_EXSLB, KVMTEST, 0x480)
216 217
	std	r3,PACA_EXSLB+EX_R3(r13)
	mfspr	r3,SPRN_SRR0		/* SRR0 is faulting address */
218
	mfspr	r12,SPRN_SRR1
219
#ifndef CONFIG_RELOCATABLE
220
	b	slb_miss_realmode
221 222 223
#else
	mfctr	r11
	ld	r10,PACAKBASE(r13)
224
	LOAD_HANDLER(r10, slb_miss_realmode)
225 226 227 228
	mtctr	r10
	bctr
#endif

229 230 231
	/* We open code these as we can't have a ". = x" (even with
	 * x = "." within a feature section
	 */
232
	. = 0x500;
233 234
	.globl hardware_interrupt_pSeries;
	.globl hardware_interrupt_hv;
235
hardware_interrupt_pSeries:
236
hardware_interrupt_hv:
237
	BEGIN_FTR_SECTION
238 239 240
		_MASKABLE_EXCEPTION_PSERIES(0x502, hardware_interrupt,
					    EXC_HV, SOFTEN_TEST_HV)
		KVM_HANDLER(PACA_EXGEN, EXC_HV, 0x502)
241 242
	FTR_SECTION_ELSE
		_MASKABLE_EXCEPTION_PSERIES(0x500, hardware_interrupt,
243
					    EXC_STD, SOFTEN_TEST_PR)
244
		KVM_HANDLER(PACA_EXGEN, EXC_STD, 0x500)
245
	ALT_FTR_SECTION_END_IFSET(CPU_FTR_HVMODE | CPU_FTR_ARCH_206)
246

247
	STD_EXCEPTION_PSERIES(0x600, alignment)
248
	KVM_HANDLER(PACA_EXGEN, EXC_STD, 0x600)
249

250
	STD_EXCEPTION_PSERIES(0x700, program_check)
251
	KVM_HANDLER(PACA_EXGEN, EXC_STD, 0x700)
252

253
	STD_EXCEPTION_PSERIES(0x800, fp_unavailable)
254
	KVM_HANDLER(PACA_EXGEN, EXC_STD, 0x800)
255

256 257 258 259 260
	. = 0x900
	.globl decrementer_pSeries
decrementer_pSeries:
	_MASKABLE_EXCEPTION_PSERIES(0x900, decrementer, EXC_STD, SOFTEN_TEST_PR)

261
	STD_EXCEPTION_HV(0x980, 0x982, hdecrementer)
262

263
	MASKABLE_EXCEPTION_PSERIES(0xa00, 0xa00, doorbell_super)
264
	KVM_HANDLER(PACA_EXGEN, EXC_STD, 0xa00)
265

266
	STD_EXCEPTION_PSERIES(0xb00, trap_0b)
267
	KVM_HANDLER(PACA_EXGEN, EXC_STD, 0xb00)
268 269 270 271

	. = 0xc00
	.globl	system_call_pSeries
system_call_pSeries:
272 273 274 275 276 277 278
	 /*
	  * If CONFIG_KVM_BOOK3S_64_HANDLER is set, save the PPR (on systems
	  * that support it) before changing to HMT_MEDIUM. That allows the KVM
	  * code to save that value into the guest state (it is the guest's PPR
	  * value). Otherwise just change to HMT_MEDIUM as userspace has
	  * already saved the PPR.
	  */
279 280 281 282
#ifdef CONFIG_KVM_BOOK3S_64_HANDLER
	SET_SCRATCH0(r13)
	GET_PACA(r13)
	std	r9,PACA_EXGEN+EX_R9(r13)
283 284
	OPT_GET_SPR(r9, SPRN_PPR, CPU_FTR_HAS_PPR);
	HMT_MEDIUM;
285
	std	r10,PACA_EXGEN+EX_R10(r13)
286
	OPT_SAVE_REG_TO_PACA(PACA_EXGEN+EX_PPR, r9, CPU_FTR_HAS_PPR);
287 288 289
	mfcr	r9
	KVMTEST(0xc00)
	GET_SCRATCH0(r13)
290 291
#else
	HMT_MEDIUM;
292
#endif
293 294 295
	SYSCALL_PSERIES_1
	SYSCALL_PSERIES_2_RFID
	SYSCALL_PSERIES_3
296 297
	KVM_HANDLER(PACA_EXGEN, EXC_STD, 0xc00)

298
	STD_EXCEPTION_PSERIES(0xd00, single_step)
299
	KVM_HANDLER(PACA_EXGEN, EXC_STD, 0xd00)
300 301 302 303 304

	/* At 0xe??? we have a bunch of hypervisor exceptions, we branch
	 * out of line to handle them
	 */
	. = 0xe00
305
hv_data_storage_trampoline:
306 307
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
308
	b	h_data_storage_hv
309

310
	. = 0xe20
311
hv_instr_storage_trampoline:
312 313
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
314
	b	h_instr_storage_hv
315

316
	. = 0xe40
317
emulation_assist_trampoline:
318 319
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
320
	b	emulation_assist_hv
321

322
	. = 0xe60
323
hv_exception_trampoline:
324 325
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
326
	b	hmi_exception_early
327

328
	. = 0xe80
329
hv_doorbell_trampoline:
330 331
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
332
	b	h_doorbell_hv
333 334 335 336 337 338 339

	/* We need to deal with the Altivec unavailable exception
	 * here which is at 0xf20, thus in the middle of the
	 * prolog code of the PerformanceMonitor one. A little
	 * trickery is thus necessary
	 */
	. = 0xf00
340
performance_monitor_pseries_trampoline:
341 342
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
343 344 345
	b	performance_monitor_pSeries

	. = 0xf20
346
altivec_unavailable_pseries_trampoline:
347 348
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
349 350 351
	b	altivec_unavailable_pSeries

	. = 0xf40
352
vsx_unavailable_pseries_trampoline:
353 354
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
355 356
	b	vsx_unavailable_pSeries

357
	. = 0xf60
358
facility_unavailable_trampoline:
359 360
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
361
	b	facility_unavailable_pSeries
362

363
	. = 0xf80
364
hv_facility_unavailable_trampoline:
365 366 367 368
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
	b	facility_unavailable_hv

369
#ifdef CONFIG_CBE_RAS
370
	STD_EXCEPTION_HV(0x1200, 0x1202, cbe_system_error)
371
	KVM_HANDLER_SKIP(PACA_EXGEN, EXC_HV, 0x1202)
372
#endif /* CONFIG_CBE_RAS */
373

374
	STD_EXCEPTION_PSERIES(0x1300, instruction_breakpoint)
375
	KVM_HANDLER_SKIP(PACA_EXGEN, EXC_STD, 0x1300)
376

377
	. = 0x1500
M
Michael Neuling 已提交
378
	.global denorm_exception_hv
379 380
denorm_exception_hv:
	mtspr	SPRN_SPRG_HSCRATCH0,r13
381
	EXCEPTION_PROLOG_0(PACA_EXGEN)
382
	EXCEPTION_PROLOG_1(PACA_EXGEN, NOTEST, 0x1500)
383 384 385 386 387 388 389 390 391

#ifdef CONFIG_PPC_DENORMALISATION
	mfspr	r10,SPRN_HSRR1
	mfspr	r11,SPRN_HSRR0		/* save HSRR0 */
	andis.	r10,r10,(HSRR1_DENORM)@h /* denorm? */
	addi	r11,r11,-4		/* HSRR0 is next instruction */
	bne+	denorm_assist
#endif

392
	KVMTEST(0x1500)
393 394 395
	EXCEPTION_PROLOG_PSERIES_1(denorm_common, EXC_HV)
	KVM_HANDLER_SKIP(PACA_EXGEN, EXC_STD, 0x1500)

396
#ifdef CONFIG_CBE_RAS
397
	STD_EXCEPTION_HV(0x1600, 0x1602, cbe_maintenance)
398
	KVM_HANDLER_SKIP(PACA_EXGEN, EXC_HV, 0x1602)
399
#endif /* CONFIG_CBE_RAS */
400

401
	STD_EXCEPTION_PSERIES(0x1700, altivec_assist)
402
	KVM_HANDLER(PACA_EXGEN, EXC_STD, 0x1700)
403

404
#ifdef CONFIG_CBE_RAS
405
	STD_EXCEPTION_HV(0x1800, 0x1802, cbe_thermal)
406
	KVM_HANDLER_SKIP(PACA_EXGEN, EXC_HV, 0x1802)
407 408
#else
	. = 0x1800
409 410 411
#endif /* CONFIG_CBE_RAS */


412 413
/*** Out of line interrupts support ***/

414
	.align	7
415
	/* moved from 0x200 */
416
machine_check_powernv_early:
417 418 419 420 421 422 423 424
BEGIN_FTR_SECTION
	EXCEPTION_PROLOG_1(PACA_EXMC, NOTEST, 0x200)
	/*
	 * Register contents:
	 * R13		= PACA
	 * R9		= CR
	 * Original R9 to R13 is saved on PACA_EXMC
	 *
425 426 427
	 * Switch to mc_emergency stack and handle re-entrancy (we limit
	 * the nested MCE upto level 4 to avoid stack overflow).
	 * Save MCE registers srr1, srr0, dar and dsisr and then set ME=1
428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449
	 *
	 * We use paca->in_mce to check whether this is the first entry or
	 * nested machine check. We increment paca->in_mce to track nested
	 * machine checks.
	 *
	 * If this is the first entry then set stack pointer to
	 * paca->mc_emergency_sp, otherwise r1 is already pointing to
	 * stack frame on mc_emergency stack.
	 *
	 * NOTE: We are here with MSR_ME=0 (off), which means we risk a
	 * checkstop if we get another machine check exception before we do
	 * rfid with MSR_ME=1.
	 */
	mr	r11,r1			/* Save r1 */
	lhz	r10,PACA_IN_MCE(r13)
	cmpwi	r10,0			/* Are we in nested machine check */
	bne	0f			/* Yes, we are. */
	/* First machine check entry */
	ld	r1,PACAMCEMERGSP(r13)	/* Use MC emergency stack */
0:	subi	r1,r1,INT_FRAME_SIZE	/* alloc stack frame */
	addi	r10,r10,1		/* increment paca->in_mce */
	sth	r10,PACA_IN_MCE(r13)
450 451 452
	/* Limit nested MCE to level 4 to avoid stack overflow */
	cmpwi	r10,4
	bgt	2f			/* Check if we hit limit of 4 */
453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470
	std	r11,GPR1(r1)		/* Save r1 on the stack. */
	std	r11,0(r1)		/* make stack chain pointer */
	mfspr	r11,SPRN_SRR0		/* Save SRR0 */
	std	r11,_NIP(r1)
	mfspr	r11,SPRN_SRR1		/* Save SRR1 */
	std	r11,_MSR(r1)
	mfspr	r11,SPRN_DAR		/* Save DAR */
	std	r11,_DAR(r1)
	mfspr	r11,SPRN_DSISR		/* Save DSISR */
	std	r11,_DSISR(r1)
	std	r9,_CCR(r1)		/* Save CR in stackframe */
	/* Save r9 through r13 from EXMC save area to stack frame. */
	EXCEPTION_PROLOG_COMMON_2(PACA_EXMC)
	mfmsr	r11			/* get MSR value */
	ori	r11,r11,MSR_ME		/* turn on ME bit */
	ori	r11,r11,MSR_RI		/* turn on RI bit */
	ld	r12,PACAKBASE(r13)	/* get high part of &label */
	LOAD_HANDLER(r12, machine_check_handle_early)
471
1:	mtspr	SPRN_SRR0,r12
472 473 474
	mtspr	SPRN_SRR1,r11
	rfid
	b	.	/* prevent speculative execution */
475 476 477 478 479 480 481 482 483 484 485 486 487
2:
	/* Stack overflow. Stay on emergency stack and panic.
	 * Keep the ME bit off while panic-ing, so that if we hit
	 * another machine check we checkstop.
	 */
	addi	r1,r1,INT_FRAME_SIZE	/* go back to previous stack frame */
	ld	r11,PACAKMSR(r13)
	ld	r12,PACAKBASE(r13)
	LOAD_HANDLER(r12, unrecover_mce)
	li	r10,MSR_ME
	andc	r11,r11,r10		/* Turn off MSR_ME */
	b	1b
	b	.	/* prevent speculative execution */
488 489
END_FTR_SECTION_IFSET(CPU_FTR_HVMODE)

490 491 492 493
machine_check_pSeries:
	.globl machine_check_fwnmi
machine_check_fwnmi:
	SET_SCRATCH0(r13)		/* save r13 */
494 495 496 497
	EXCEPTION_PROLOG_0(PACA_EXMC)
machine_check_pSeries_0:
	EXCEPTION_PROLOG_1(PACA_EXMC, KVMTEST, 0x200)
	EXCEPTION_PROLOG_PSERIES_1(machine_check_common, EXC_STD)
498
	KVM_HANDLER_SKIP(PACA_EXMC, EXC_STD, 0x200)
499 500
	KVM_HANDLER_SKIP(PACA_EXGEN, EXC_STD, 0x300)
	KVM_HANDLER_SKIP(PACA_EXSLB, EXC_STD, 0x380)
501 502 503
	KVM_HANDLER(PACA_EXGEN, EXC_STD, 0x400)
	KVM_HANDLER(PACA_EXSLB, EXC_STD, 0x480)
	KVM_HANDLER(PACA_EXGEN, EXC_STD, 0x900)
504 505
	KVM_HANDLER(PACA_EXGEN, EXC_HV, 0x982)

506 507 508 509 510 511 512 513 514 515 516 517
#ifdef CONFIG_PPC_DENORMALISATION
denorm_assist:
BEGIN_FTR_SECTION
/*
 * To denormalise we need to move a copy of the register to itself.
 * For POWER6 do that here for all FP regs.
 */
	mfmsr	r10
	ori	r10,r10,(MSR_FP|MSR_FE0|MSR_FE1)
	xori	r10,r10,(MSR_FE0|MSR_FE1)
	mtmsrd	r10
	sync
518 519 520 521 522 523 524 525

#define FMR2(n)  fmr (n), (n) ; fmr n+1, n+1
#define FMR4(n)  FMR2(n) ; FMR2(n+2)
#define FMR8(n)  FMR4(n) ; FMR4(n+4)
#define FMR16(n) FMR8(n) ; FMR8(n+8)
#define FMR32(n) FMR16(n) ; FMR16(n+16)
	FMR32(0)

526 527 528 529 530 531 532 533 534
FTR_SECTION_ELSE
/*
 * To denormalise we need to move a copy of the register to itself.
 * For POWER7 do that here for the first 32 VSX registers only.
 */
	mfmsr	r10
	oris	r10,r10,MSR_VSX@h
	mtmsrd	r10
	sync
535 536 537 538 539 540 541 542

#define XVCPSGNDP2(n) XVCPSGNDP(n,n,n) ; XVCPSGNDP(n+1,n+1,n+1)
#define XVCPSGNDP4(n) XVCPSGNDP2(n) ; XVCPSGNDP2(n+2)
#define XVCPSGNDP8(n) XVCPSGNDP4(n) ; XVCPSGNDP4(n+4)
#define XVCPSGNDP16(n) XVCPSGNDP8(n) ; XVCPSGNDP8(n+8)
#define XVCPSGNDP32(n) XVCPSGNDP16(n) ; XVCPSGNDP16(n+16)
	XVCPSGNDP32(0)

543
ALT_FTR_SECTION_END_IFCLR(CPU_FTR_ARCH_206)
544 545 546 547 548 549 550 551 552 553

BEGIN_FTR_SECTION
	b	denorm_done
END_FTR_SECTION_IFCLR(CPU_FTR_ARCH_207S)
/*
 * To denormalise we need to move a copy of the register to itself.
 * For POWER8 we need to do that for all 64 VSX registers
 */
	XVCPSGNDP32(32)
denorm_done:
554 555 556
	mtspr	SPRN_HSRR0,r11
	mtcrf	0x80,r9
	ld	r9,PACA_EXGEN+EX_R9(r13)
557
	RESTORE_PPR_PACA(PACA_EXGEN, r10)
558 559 560 561
BEGIN_FTR_SECTION
	ld	r10,PACA_EXGEN+EX_CFAR(r13)
	mtspr	SPRN_CFAR,r10
END_FTR_SECTION_IFSET(CPU_FTR_CFAR)
562 563 564 565 566 567 568 569
	ld	r10,PACA_EXGEN+EX_R10(r13)
	ld	r11,PACA_EXGEN+EX_R11(r13)
	ld	r12,PACA_EXGEN+EX_R12(r13)
	ld	r13,PACA_EXGEN+EX_R13(r13)
	HRFID
	b	.
#endif

570
	.align	7
571
	/* moved from 0xe00 */
572
	STD_EXCEPTION_HV_OOL(0xe02, h_data_storage)
573
	KVM_HANDLER_SKIP(PACA_EXGEN, EXC_HV, 0xe02)
574
	STD_EXCEPTION_HV_OOL(0xe22, h_instr_storage)
575
	KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xe22)
576
	STD_EXCEPTION_HV_OOL(0xe42, emulation_assist)
577
	KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xe42)
578
	MASKABLE_EXCEPTION_HV_OOL(0xe62, hmi_exception)
579
	KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xe62)
580

581
	MASKABLE_EXCEPTION_HV_OOL(0xe82, h_doorbell)
582
	KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xe82)
583 584

	/* moved from 0xf00 */
585
	STD_EXCEPTION_PSERIES_OOL(0xf00, performance_monitor)
586
	KVM_HANDLER(PACA_EXGEN, EXC_STD, 0xf00)
587
	STD_EXCEPTION_PSERIES_OOL(0xf20, altivec_unavailable)
588
	KVM_HANDLER(PACA_EXGEN, EXC_STD, 0xf20)
589
	STD_EXCEPTION_PSERIES_OOL(0xf40, vsx_unavailable)
590
	KVM_HANDLER(PACA_EXGEN, EXC_STD, 0xf40)
591
	STD_EXCEPTION_PSERIES_OOL(0xf60, facility_unavailable)
592
	KVM_HANDLER(PACA_EXGEN, EXC_STD, 0xf60)
593 594
	STD_EXCEPTION_HV_OOL(0xf82, facility_unavailable)
	KVM_HANDLER(PACA_EXGEN, EXC_HV, 0xf82)
595 596

/*
597 598 599 600
 * An interrupt came in while soft-disabled. We set paca->irq_happened, then:
 * - If it was a decrementer interrupt, we bump the dec to max and and return.
 * - If it was a doorbell we return immediately since doorbells are edge
 *   triggered and won't automatically refire.
601 602
 * - If it was a HMI we return immediately since we handled it in realmode
 *   and it won't refire.
603 604
 * - else we hard disable and return.
 * This is called with r10 containing the value to OR to the paca field.
605
 */
606 607 608 609 610 611
#define MASKED_INTERRUPT(_H)				\
masked_##_H##interrupt:					\
	std	r11,PACA_EXGEN+EX_R11(r13);		\
	lbz	r11,PACAIRQHAPPENED(r13);		\
	or	r11,r11,r10;				\
	stb	r11,PACAIRQHAPPENED(r13);		\
612 613
	cmpwi	r10,PACA_IRQ_DEC;			\
	bne	1f;					\
614 615 616 617
	lis	r10,0x7fff;				\
	ori	r10,r10,0xffff;				\
	mtspr	SPRN_DEC,r10;				\
	b	2f;					\
618
1:	cmpwi	r10,PACA_IRQ_DBELL;			\
619 620
	beq	2f;					\
	cmpwi	r10,PACA_IRQ_HMI;			\
621 622
	beq	2f;					\
	mfspr	r10,SPRN_##_H##SRR1;			\
623 624 625 626 627 628 629 630 631
	rldicl	r10,r10,48,1; /* clear MSR_EE */	\
	rotldi	r10,r10,16;				\
	mtspr	SPRN_##_H##SRR1,r10;			\
2:	mtcrf	0x80,r9;				\
	ld	r9,PACA_EXGEN+EX_R9(r13);		\
	ld	r10,PACA_EXGEN+EX_R10(r13);		\
	ld	r11,PACA_EXGEN+EX_R11(r13);		\
	GET_SCRATCH0(r13);				\
	##_H##rfid;					\
632
	b	.
633 634 635
	
	MASKED_INTERRUPT()
	MASKED_INTERRUPT(H)
636

637 638
/*
 * Called from arch_local_irq_enable when an interrupt needs
639 640
 * to be resent. r3 contains 0x500, 0x900, 0xa00 or 0xe80 to indicate
 * which kind of interrupt. MSR:EE is already off. We generate a
641 642 643 644 645 646 647 648 649 650 651 652 653 654 655
 * stackframe like if a real interrupt had happened.
 *
 * Note: While MSR:EE is off, we need to make sure that _MSR
 * in the generated frame has EE set to 1 or the exception
 * handler will not properly re-enable them.
 */
_GLOBAL(__replay_interrupt)
	/* We are going to jump to the exception common code which
	 * will retrieve various register values from the PACA which
	 * we don't give a damn about, so we don't bother storing them.
	 */
	mfmsr	r12
	mflr	r11
	mfcr	r9
	ori	r12,r12,MSR_EE
656 657 658 659 660 661 662 663 664 665 666 667
	cmpwi	r3,0x900
	beq	decrementer_common
	cmpwi	r3,0x500
	beq	hardware_interrupt_common
BEGIN_FTR_SECTION
	cmpwi	r3,0xe80
	beq	h_doorbell_common
FTR_SECTION_ELSE
	cmpwi	r3,0xa00
	beq	doorbell_super_common
ALT_FTR_SECTION_END_IFSET(CPU_FTR_HVMODE)
	blr
668

669 670 671 672 673 674 675
#ifdef CONFIG_PPC_PSERIES
/*
 * Vectors for the FWNMI option.  Share common code.
 */
	.globl system_reset_fwnmi
      .align 7
system_reset_fwnmi:
676
	SET_SCRATCH0(r13)		/* save r13 */
677 678
	EXCEPTION_PROLOG_PSERIES(PACA_EXGEN, system_reset_common, EXC_STD,
				 NOTEST, 0x100)
679 680 681

#endif /* CONFIG_PPC_PSERIES */

682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707
#ifdef CONFIG_KVM_BOOK3S_64_HANDLER
kvmppc_skip_interrupt:
	/*
	 * Here all GPRs are unchanged from when the interrupt happened
	 * except for r13, which is saved in SPRG_SCRATCH0.
	 */
	mfspr	r13, SPRN_SRR0
	addi	r13, r13, 4
	mtspr	SPRN_SRR0, r13
	GET_SCRATCH0(r13)
	rfid
	b	.

kvmppc_skip_Hinterrupt:
	/*
	 * Here all GPRs are unchanged from when the interrupt happened
	 * except for r13, which is saved in SPRG_SCRATCH0.
	 */
	mfspr	r13, SPRN_HSRR0
	addi	r13, r13, 4
	mtspr	SPRN_HSRR0, r13
	GET_SCRATCH0(r13)
	hrfid
	b	.
#endif

708
/*
709 710 711 712
 * Ensure that any handlers that get invoked from the exception prologs
 * above are below the first 64KB (0x10000) of the kernel image because
 * the prologs assemble the addresses of these handlers using the
 * LOAD_HANDLER macro, which uses an ori instruction.
713 714 715 716
 */

/*** Common interrupt handlers ***/

717
	STD_EXCEPTION_COMMON(0x100, system_reset, system_reset_exception)
718

719
	STD_EXCEPTION_COMMON_ASYNC(0x500, hardware_interrupt, do_IRQ)
720 721
	STD_EXCEPTION_COMMON_ASYNC(0x900, decrementer, timer_interrupt)
	STD_EXCEPTION_COMMON(0x980, hdecrementer, hdec_interrupt)
722
#ifdef CONFIG_PPC_DOORBELL
723
	STD_EXCEPTION_COMMON_ASYNC(0xa00, doorbell_super, doorbell_exception)
724
#else
725
	STD_EXCEPTION_COMMON_ASYNC(0xa00, doorbell_super, unknown_exception)
726
#endif
727 728 729 730
	STD_EXCEPTION_COMMON(0xb00, trap_0b, unknown_exception)
	STD_EXCEPTION_COMMON(0xd00, single_step, single_step_exception)
	STD_EXCEPTION_COMMON(0xe00, trap_0e, unknown_exception)
	STD_EXCEPTION_COMMON(0xe40, emulation_assist, emulation_assist_interrupt)
731
	STD_EXCEPTION_COMMON_ASYNC(0xe60, hmi_exception, handle_hmi_exception)
732
#ifdef CONFIG_PPC_DOORBELL
733
	STD_EXCEPTION_COMMON_ASYNC(0xe80, h_doorbell, doorbell_exception)
734
#else
735
	STD_EXCEPTION_COMMON_ASYNC(0xe80, h_doorbell, unknown_exception)
736
#endif
737 738 739
	STD_EXCEPTION_COMMON_ASYNC(0xf00, performance_monitor, performance_monitor_exception)
	STD_EXCEPTION_COMMON(0x1300, instruction_breakpoint, instruction_breakpoint_exception)
	STD_EXCEPTION_COMMON(0x1502, denorm, unknown_exception)
740
#ifdef CONFIG_ALTIVEC
741
	STD_EXCEPTION_COMMON(0x1700, altivec_assist, altivec_assist_exception)
742
#else
743
	STD_EXCEPTION_COMMON(0x1700, altivec_assist, unknown_exception)
744 745
#endif
#ifdef CONFIG_CBE_RAS
746 747 748
	STD_EXCEPTION_COMMON(0x1200, cbe_system_error, cbe_system_error_exception)
	STD_EXCEPTION_COMMON(0x1600, cbe_maintenance, cbe_maintenance_exception)
	STD_EXCEPTION_COMMON(0x1800, cbe_thermal, cbe_thermal_exception)
749 750
#endif /* CONFIG_CBE_RAS */

751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770
	/*
	 * Relocation-on interrupts: A subset of the interrupts can be delivered
	 * with IR=1/DR=1, if AIL==2 and MSR.HV won't be changed by delivering
	 * it.  Addresses are the same as the original interrupt addresses, but
	 * offset by 0xc000000000004000.
	 * It's impossible to receive interrupts below 0x300 via this mechanism.
	 * KVM: None of these traps are from the guest ; anything that escalated
	 * to HV=1 from HV=0 is delivered via real mode handlers.
	 */

	/*
	 * This uses the standard macro, since the original 0x300 vector
	 * only has extra guff for STAB-based processors -- which never
	 * come here.
	 */
	STD_RELON_EXCEPTION_PSERIES(0x4300, 0x300, data_access)
	. = 0x4380
	.globl data_access_slb_relon_pSeries
data_access_slb_relon_pSeries:
	SET_SCRATCH0(r13)
771
	EXCEPTION_PROLOG_0(PACA_EXSLB)
772 773 774 775 776
	EXCEPTION_PROLOG_1(PACA_EXSLB, NOTEST, 0x380)
	std	r3,PACA_EXSLB+EX_R3(r13)
	mfspr	r3,SPRN_DAR
	mfspr	r12,SPRN_SRR1
#ifndef CONFIG_RELOCATABLE
777
	b	slb_miss_realmode
778 779
#else
	/*
780
	 * We can't just use a direct branch to slb_miss_realmode
781 782 783 784 785
	 * because the distance from here to there depends on where
	 * the kernel ends up being put.
	 */
	mfctr	r11
	ld	r10,PACAKBASE(r13)
786
	LOAD_HANDLER(r10, slb_miss_realmode)
787 788 789 790 791 792 793 794 795
	mtctr	r10
	bctr
#endif

	STD_RELON_EXCEPTION_PSERIES(0x4400, 0x400, instruction_access)
	. = 0x4480
	.globl instruction_access_slb_relon_pSeries
instruction_access_slb_relon_pSeries:
	SET_SCRATCH0(r13)
796
	EXCEPTION_PROLOG_0(PACA_EXSLB)
797 798 799 800 801
	EXCEPTION_PROLOG_1(PACA_EXSLB, NOTEST, 0x480)
	std	r3,PACA_EXSLB+EX_R3(r13)
	mfspr	r3,SPRN_SRR0		/* SRR0 is faulting address */
	mfspr	r12,SPRN_SRR1
#ifndef CONFIG_RELOCATABLE
802
	b	slb_miss_realmode
803 804 805
#else
	mfctr	r11
	ld	r10,PACAKBASE(r13)
806
	LOAD_HANDLER(r10, slb_miss_realmode)
807 808 809 810 811 812 813 814 815 816 817 818 819
	mtctr	r10
	bctr
#endif

	. = 0x4500
	.globl hardware_interrupt_relon_pSeries;
	.globl hardware_interrupt_relon_hv;
hardware_interrupt_relon_pSeries:
hardware_interrupt_relon_hv:
	BEGIN_FTR_SECTION
		_MASKABLE_RELON_EXCEPTION_PSERIES(0x502, hardware_interrupt, EXC_HV, SOFTEN_TEST_HV)
	FTR_SECTION_ELSE
		_MASKABLE_RELON_EXCEPTION_PSERIES(0x500, hardware_interrupt, EXC_STD, SOFTEN_TEST_PR)
820
	ALT_FTR_SECTION_END_IFSET(CPU_FTR_HVMODE)
821 822 823 824 825
	STD_RELON_EXCEPTION_PSERIES(0x4600, 0x600, alignment)
	STD_RELON_EXCEPTION_PSERIES(0x4700, 0x700, program_check)
	STD_RELON_EXCEPTION_PSERIES(0x4800, 0x800, fp_unavailable)
	MASKABLE_RELON_EXCEPTION_PSERIES(0x4900, 0x900, decrementer)
	STD_RELON_EXCEPTION_HV(0x4980, 0x982, hdecrementer)
826
	MASKABLE_RELON_EXCEPTION_PSERIES(0x4a00, 0xa00, doorbell_super)
827 828 829 830 831 832 833 834 835 836 837 838 839
	STD_RELON_EXCEPTION_PSERIES(0x4b00, 0xb00, trap_0b)

	. = 0x4c00
	.globl system_call_relon_pSeries
system_call_relon_pSeries:
	HMT_MEDIUM
	SYSCALL_PSERIES_1
	SYSCALL_PSERIES_2_DIRECT
	SYSCALL_PSERIES_3

	STD_RELON_EXCEPTION_PSERIES(0x4d00, 0xd00, single_step)

	. = 0x4e00
840
	b	.	/* Can't happen, see v2.07 Book III-S section 6.5 */
841 842

	. = 0x4e20
843
	b	.	/* Can't happen, see v2.07 Book III-S section 6.5 */
844 845

	. = 0x4e40
846
emulation_assist_relon_trampoline:
847 848
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
849 850 851
	b	emulation_assist_relon_hv

	. = 0x4e60
852
	b	.	/* Can't happen, see v2.07 Book III-S section 6.5 */
853

854
	. = 0x4e80
855
h_doorbell_relon_trampoline:
856 857
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
858
	b	h_doorbell_relon_hv
859 860

	. = 0x4f00
861
performance_monitor_relon_pseries_trampoline:
862 863
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
864 865 866
	b	performance_monitor_relon_pSeries

	. = 0x4f20
867
altivec_unavailable_relon_pseries_trampoline:
868 869
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
870 871 872
	b	altivec_unavailable_relon_pSeries

	. = 0x4f40
873
vsx_unavailable_relon_pseries_trampoline:
874 875
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
876 877
	b	vsx_unavailable_relon_pSeries

878
	. = 0x4f60
879
facility_unavailable_relon_trampoline:
880 881
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
882
	b	facility_unavailable_relon_pSeries
883

884
	. = 0x4f80
885
hv_facility_unavailable_relon_trampoline:
886 887
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
888
	b	hv_facility_unavailable_relon_hv
889

890 891 892 893 894 895 896
	STD_RELON_EXCEPTION_PSERIES(0x5300, 0x1300, instruction_breakpoint)
#ifdef CONFIG_PPC_DENORMALISATION
	. = 0x5500
	b	denorm_exception_hv
#endif
	STD_RELON_EXCEPTION_PSERIES(0x5700, 0x1700, altivec_assist)

897 898 899 900
	.align	7
system_call_entry:
	b	system_call_common

901
ppc64_runlatch_on_trampoline:
902
	b	__ppc64_runlatch_on
903

904 905 906 907 908 909 910 911 912 913 914 915 916
/*
 * Here r13 points to the paca, r9 contains the saved CR,
 * SRR0 and SRR1 are saved in r11 and r12,
 * r9 - r13 are saved in paca->exgen.
 */
	.align	7
	.globl data_access_common
data_access_common:
	mfspr	r10,SPRN_DAR
	std	r10,PACA_EXGEN+EX_DAR(r13)
	mfspr	r10,SPRN_DSISR
	stw	r10,PACA_EXGEN+EX_DSISR(r13)
	EXCEPTION_PROLOG_COMMON(0x300, PACA_EXGEN)
917
	RECONCILE_IRQ_STATE(r10, r11)
918
	ld	r12,_MSR(r1)
919 920 921
	ld	r3,PACA_EXGEN+EX_DAR(r13)
	lwz	r4,PACA_EXGEN+EX_DSISR(r13)
	li	r5,0x300
922 923 924
	std	r3,_DAR(r1)
	std	r4,_DSISR(r1)
BEGIN_MMU_FTR_SECTION
925
	b	do_hash_page		/* Try to handle as hpte fault */
926 927 928
MMU_FTR_SECTION_ELSE
	b	handle_page_fault
ALT_MMU_FTR_SECTION_END_IFCLR(MMU_FTR_RADIX)
929

930
	.align  7
931
	.globl  h_data_storage_common
932
h_data_storage_common:
933 934 935 936 937
	mfspr   r10,SPRN_HDAR
	std     r10,PACA_EXGEN+EX_DAR(r13)
	mfspr   r10,SPRN_HDSISR
	stw     r10,PACA_EXGEN+EX_DSISR(r13)
	EXCEPTION_PROLOG_COMMON(0xe00, PACA_EXGEN)
938
	bl      save_nvgprs
939
	RECONCILE_IRQ_STATE(r10, r11)
940
	addi    r3,r1,STACK_FRAME_OVERHEAD
941 942
	bl      unknown_exception
	b       ret_from_except
943

944 945 946 947
	.align	7
	.globl instruction_access_common
instruction_access_common:
	EXCEPTION_PROLOG_COMMON(0x400, PACA_EXGEN)
948
	RECONCILE_IRQ_STATE(r10, r11)
949
	ld	r12,_MSR(r1)
950 951 952
	ld	r3,_NIP(r1)
	andis.	r4,r12,0x5820
	li	r5,0x400
953 954 955
	std	r3,_DAR(r1)
	std	r4,_DSISR(r1)
BEGIN_MMU_FTR_SECTION
956
	b	do_hash_page		/* Try to handle as hpte fault */
957 958 959
MMU_FTR_SECTION_ELSE
	b	handle_page_fault
ALT_MMU_FTR_SECTION_END_IFCLR(MMU_FTR_RADIX)
960

961
	STD_EXCEPTION_COMMON(0xe20, h_instr_storage, unknown_exception)
962

963 964 965 966 967 968 969 970 971 972 973 974 975 976
	/*
	 * Machine check is different because we use a different
	 * save area: PACA_EXMC instead of PACA_EXGEN.
	 */
	.align	7
	.globl machine_check_common
machine_check_common:

	mfspr	r10,SPRN_DAR
	std	r10,PACA_EXGEN+EX_DAR(r13)
	mfspr	r10,SPRN_DSISR
	stw	r10,PACA_EXGEN+EX_DSISR(r13)
	EXCEPTION_PROLOG_COMMON(0x200, PACA_EXMC)
	FINISH_NAP
977
	RECONCILE_IRQ_STATE(r10, r11)
978 979 980 981
	ld	r3,PACA_EXGEN+EX_DAR(r13)
	lwz	r4,PACA_EXGEN+EX_DSISR(r13)
	std	r3,_DAR(r1)
	std	r4,_DSISR(r1)
982
	bl	save_nvgprs
983
	addi	r3,r1,STACK_FRAME_OVERHEAD
984 985
	bl	machine_check_exception
	b	ret_from_except
986

987 988 989 990 991 992 993 994 995 996 997 998
	.align	7
	.globl alignment_common
alignment_common:
	mfspr	r10,SPRN_DAR
	std	r10,PACA_EXGEN+EX_DAR(r13)
	mfspr	r10,SPRN_DSISR
	stw	r10,PACA_EXGEN+EX_DSISR(r13)
	EXCEPTION_PROLOG_COMMON(0x600, PACA_EXGEN)
	ld	r3,PACA_EXGEN+EX_DAR(r13)
	lwz	r4,PACA_EXGEN+EX_DSISR(r13)
	std	r3,_DAR(r1)
	std	r4,_DSISR(r1)
999
	bl	save_nvgprs
1000
	RECONCILE_IRQ_STATE(r10, r11)
1001
	addi	r3,r1,STACK_FRAME_OVERHEAD
1002 1003
	bl	alignment_exception
	b	ret_from_except
1004 1005 1006 1007 1008

	.align	7
	.globl program_check_common
program_check_common:
	EXCEPTION_PROLOG_COMMON(0x700, PACA_EXGEN)
1009
	bl	save_nvgprs
1010
	RECONCILE_IRQ_STATE(r10, r11)
1011
	addi	r3,r1,STACK_FRAME_OVERHEAD
1012 1013
	bl	program_check_exception
	b	ret_from_except
1014 1015 1016 1017 1018 1019

	.align	7
	.globl fp_unavailable_common
fp_unavailable_common:
	EXCEPTION_PROLOG_COMMON(0x800, PACA_EXGEN)
	bne	1f			/* if from user, just load it up */
1020
	bl	save_nvgprs
1021
	RECONCILE_IRQ_STATE(r10, r11)
1022
	addi	r3,r1,STACK_FRAME_OVERHEAD
1023
	bl	kernel_fp_unavailable_exception
1024
	BUG_OPCODE
1025 1026 1027 1028 1029 1030 1031 1032 1033 1034
1:
#ifdef CONFIG_PPC_TRANSACTIONAL_MEM
BEGIN_FTR_SECTION
	/* Test if 2 TM state bits are zero.  If non-zero (ie. userspace was in
	 * transaction), go do TM stuff
	 */
	rldicl.	r0, r12, (64-MSR_TS_LG), (64-2)
	bne-	2f
END_FTR_SECTION_IFSET(CPU_FTR_TM)
#endif
1035
	bl	load_up_fpu
1036
	b	fast_exception_return
1037 1038
#ifdef CONFIG_PPC_TRANSACTIONAL_MEM
2:	/* User process was in a transaction */
1039
	bl	save_nvgprs
1040
	RECONCILE_IRQ_STATE(r10, r11)
1041
	addi	r3,r1,STACK_FRAME_OVERHEAD
1042 1043
	bl	fp_unavailable_tm
	b	ret_from_except
1044
#endif
1045 1046 1047 1048 1049 1050 1051
	.align	7
	.globl altivec_unavailable_common
altivec_unavailable_common:
	EXCEPTION_PROLOG_COMMON(0xf20, PACA_EXGEN)
#ifdef CONFIG_ALTIVEC
BEGIN_FTR_SECTION
	beq	1f
1052 1053 1054 1055 1056 1057 1058 1059 1060
#ifdef CONFIG_PPC_TRANSACTIONAL_MEM
  BEGIN_FTR_SECTION_NESTED(69)
	/* Test if 2 TM state bits are zero.  If non-zero (ie. userspace was in
	 * transaction), go do TM stuff
	 */
	rldicl.	r0, r12, (64-MSR_TS_LG), (64-2)
	bne-	2f
  END_FTR_SECTION_NESTED(CPU_FTR_TM, CPU_FTR_TM, 69)
#endif
1061
	bl	load_up_altivec
1062
	b	fast_exception_return
1063 1064
#ifdef CONFIG_PPC_TRANSACTIONAL_MEM
2:	/* User process was in a transaction */
1065
	bl	save_nvgprs
1066
	RECONCILE_IRQ_STATE(r10, r11)
1067
	addi	r3,r1,STACK_FRAME_OVERHEAD
1068 1069
	bl	altivec_unavailable_tm
	b	ret_from_except
1070
#endif
1071 1072 1073
1:
END_FTR_SECTION_IFSET(CPU_FTR_ALTIVEC)
#endif
1074
	bl	save_nvgprs
1075
	RECONCILE_IRQ_STATE(r10, r11)
1076
	addi	r3,r1,STACK_FRAME_OVERHEAD
1077 1078
	bl	altivec_unavailable_exception
	b	ret_from_except
1079 1080 1081 1082 1083 1084 1085

	.align	7
	.globl vsx_unavailable_common
vsx_unavailable_common:
	EXCEPTION_PROLOG_COMMON(0xf40, PACA_EXGEN)
#ifdef CONFIG_VSX
BEGIN_FTR_SECTION
1086
	beq	1f
1087 1088 1089 1090 1091 1092 1093 1094 1095
#ifdef CONFIG_PPC_TRANSACTIONAL_MEM
  BEGIN_FTR_SECTION_NESTED(69)
	/* Test if 2 TM state bits are zero.  If non-zero (ie. userspace was in
	 * transaction), go do TM stuff
	 */
	rldicl.	r0, r12, (64-MSR_TS_LG), (64-2)
	bne-	2f
  END_FTR_SECTION_NESTED(CPU_FTR_TM, CPU_FTR_TM, 69)
#endif
1096
	b	load_up_vsx
1097 1098
#ifdef CONFIG_PPC_TRANSACTIONAL_MEM
2:	/* User process was in a transaction */
1099
	bl	save_nvgprs
1100
	RECONCILE_IRQ_STATE(r10, r11)
1101
	addi	r3,r1,STACK_FRAME_OVERHEAD
1102 1103
	bl	vsx_unavailable_tm
	b	ret_from_except
1104
#endif
1105 1106 1107
1:
END_FTR_SECTION_IFSET(CPU_FTR_VSX)
#endif
1108
	bl	save_nvgprs
1109
	RECONCILE_IRQ_STATE(r10, r11)
1110
	addi	r3,r1,STACK_FRAME_OVERHEAD
1111 1112
	bl	vsx_unavailable_exception
	b	ret_from_except
1113

1114 1115
	STD_EXCEPTION_COMMON(0xf60, facility_unavailable, facility_unavailable_exception)
	STD_EXCEPTION_COMMON(0xf80, hv_facility_unavailable, facility_unavailable_exception)
1116

1117
	/* Equivalents to the above handlers for relocation-on interrupt vectors */
1118 1119
	STD_RELON_EXCEPTION_HV_OOL(0xe40, emulation_assist)
	MASKABLE_RELON_EXCEPTION_HV_OOL(0xe80, h_doorbell)
1120

1121 1122 1123
	STD_RELON_EXCEPTION_PSERIES_OOL(0xf00, performance_monitor)
	STD_RELON_EXCEPTION_PSERIES_OOL(0xf20, altivec_unavailable)
	STD_RELON_EXCEPTION_PSERIES_OOL(0xf40, vsx_unavailable)
1124
	STD_RELON_EXCEPTION_PSERIES_OOL(0xf60, facility_unavailable)
1125
	STD_RELON_EXCEPTION_HV_OOL(0xf80, hv_facility_unavailable)
1126

1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137
	/*
	 * The __end_interrupts marker must be past the out-of-line (OOL)
	 * handlers, so that they are copied to real address 0x100 when running
	 * a relocatable kernel. This ensures they can be reached from the short
	 * trampoline handlers (like 0x4f00, 0x4f20, etc.) which branch
	 * directly, without using LOAD_HANDLER().
	 */
	.align	7
	.globl	__end_interrupts
__end_interrupts:

1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152
#if defined(CONFIG_PPC_PSERIES) || defined(CONFIG_PPC_POWERNV)
/*
 * Data area reserved for FWNMI option.
 * This address (0x7000) is fixed by the RPA.
 */
	.= 0x7000
	.globl fwnmi_data_area
fwnmi_data_area:

	/* pseries and powernv need to keep the whole page from
	 * 0x7000 to 0x8000 free for use by the firmware
	 */
	. = 0x8000
#endif /* defined(CONFIG_PPC_PSERIES) || defined(CONFIG_PPC_POWERNV) */

1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202
	.globl hmi_exception_early
hmi_exception_early:
	EXCEPTION_PROLOG_1(PACA_EXGEN, NOTEST, 0xe60)
	mr	r10,r1			/* Save r1			*/
	ld	r1,PACAEMERGSP(r13)	/* Use emergency stack		*/
	subi	r1,r1,INT_FRAME_SIZE	/* alloc stack frame		*/
	std	r9,_CCR(r1)		/* save CR in stackframe	*/
	mfspr	r11,SPRN_HSRR0		/* Save HSRR0 */
	std	r11,_NIP(r1)		/* save HSRR0 in stackframe	*/
	mfspr	r12,SPRN_HSRR1		/* Save SRR1 */
	std	r12,_MSR(r1)		/* save SRR1 in stackframe	*/
	std	r10,0(r1)		/* make stack chain pointer	*/
	std	r0,GPR0(r1)		/* save r0 in stackframe	*/
	std	r10,GPR1(r1)		/* save r1 in stackframe	*/
	EXCEPTION_PROLOG_COMMON_2(PACA_EXGEN)
	EXCEPTION_PROLOG_COMMON_3(0xe60)
	addi	r3,r1,STACK_FRAME_OVERHEAD
	bl	hmi_exception_realmode
	/* Windup the stack. */
	/* Move original HSRR0 and HSRR1 into the respective regs */
	ld	r9,_MSR(r1)
	mtspr	SPRN_HSRR1,r9
	ld	r3,_NIP(r1)
	mtspr	SPRN_HSRR0,r3
	ld	r9,_CTR(r1)
	mtctr	r9
	ld	r9,_XER(r1)
	mtxer	r9
	ld	r9,_LINK(r1)
	mtlr	r9
	REST_GPR(0, r1)
	REST_8GPRS(2, r1)
	REST_GPR(10, r1)
	ld	r11,_CCR(r1)
	mtcr	r11
	REST_GPR(11, r1)
	REST_2GPRS(12, r1)
	/* restore original r1. */
	ld	r1,GPR1(r1)

	/*
	 * Go to virtual mode and pull the HMI event information from
	 * firmware.
	 */
	.globl hmi_exception_after_realmode
hmi_exception_after_realmode:
	SET_SCRATCH0(r13)
	EXCEPTION_PROLOG_0(PACA_EXGEN)
	b	hmi_exception_hv

1203

1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243
#define MACHINE_CHECK_HANDLER_WINDUP			\
	/* Clear MSR_RI before setting SRR0 and SRR1. */\
	li	r0,MSR_RI;				\
	mfmsr	r9;		/* get MSR value */	\
	andc	r9,r9,r0;				\
	mtmsrd	r9,1;		/* Clear MSR_RI */	\
	/* Move original SRR0 and SRR1 into the respective regs */	\
	ld	r9,_MSR(r1);				\
	mtspr	SPRN_SRR1,r9;				\
	ld	r3,_NIP(r1);				\
	mtspr	SPRN_SRR0,r3;				\
	ld	r9,_CTR(r1);				\
	mtctr	r9;					\
	ld	r9,_XER(r1);				\
	mtxer	r9;					\
	ld	r9,_LINK(r1);				\
	mtlr	r9;					\
	REST_GPR(0, r1);				\
	REST_8GPRS(2, r1);				\
	REST_GPR(10, r1);				\
	ld	r11,_CCR(r1);				\
	mtcr	r11;					\
	/* Decrement paca->in_mce. */			\
	lhz	r12,PACA_IN_MCE(r13);			\
	subi	r12,r12,1;				\
	sth	r12,PACA_IN_MCE(r13);			\
	REST_GPR(11, r1);				\
	REST_2GPRS(12, r1);				\
	/* restore original r1. */			\
	ld	r1,GPR1(r1)

	/*
	 * Handle machine check early in real mode. We come here with
	 * ME=1, MMU (IR=0 and DR=0) off and using MC emergency stack.
	 */
	.align	7
	.globl machine_check_handle_early
machine_check_handle_early:
	std	r0,GPR0(r1)	/* Save r0 */
	EXCEPTION_PROLOG_COMMON_3(0x200)
1244
	bl	save_nvgprs
1245
	addi	r3,r1,STACK_FRAME_OVERHEAD
1246
	bl	machine_check_early
1247
	std	r3,RESULT(r1)	/* Save result */
1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266
	ld	r12,_MSR(r1)
#ifdef	CONFIG_PPC_P7_NAP
	/*
	 * Check if thread was in power saving mode. We come here when any
	 * of the following is true:
	 * a. thread wasn't in power saving mode
	 * b. thread was in power saving mode with no state loss or
	 *    supervisor state loss
	 *
	 * Go back to nap again if (b) is true.
	 */
	rlwinm.	r11,r12,47-31,30,31	/* Was it in power saving mode? */
	beq	4f			/* No, it wasn;t */
	/* Thread was in power saving mode. Go back to nap again. */
	cmpwi	r11,2
	bne	3f
	/* Supervisor state loss */
	li	r0,1
	stb	r0,PACA_NAPSTATELOST(r13)
1267
3:	bl	machine_check_queue_event
1268 1269 1270
	MACHINE_CHECK_HANDLER_WINDUP
	GET_PACA(r13)
	ld	r1,PACAR1(r13)
1271
	li	r3,PNV_THREAD_NAP
1272
	b	pnv_enter_arch207_idle_mode
1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284
4:
#endif
	/*
	 * Check if we are coming from hypervisor userspace. If yes then we
	 * continue in host kernel in V mode to deliver the MC event.
	 */
	rldicl.	r11,r12,4,63		/* See if MC hit while in HV mode. */
	beq	5f
	andi.	r11,r12,MSR_PR		/* See if coming from user. */
	bne	9f			/* continue in V mode if we are. */

5:
1285
#ifdef CONFIG_KVM_BOOK3S_64_HANDLER
1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302
	/*
	 * We are coming from kernel context. Check if we are coming from
	 * guest. if yes, then we can continue. We will fall through
	 * do_kvm_200->kvmppc_interrupt to deliver the MC event to guest.
	 */
	lbz	r11,HSTATE_IN_GUEST(r13)
	cmpwi	r11,0			/* Check if coming from guest */
	bne	9f			/* continue if we are. */
#endif
	/*
	 * At this point we are not sure about what context we come from.
	 * Queue up the MCE event and return from the interrupt.
	 * But before that, check if this is an un-recoverable exception.
	 * If yes, then stay on emergency stack and panic.
	 */
	andi.	r11,r12,MSR_RI
	bne	2f
1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319
1:	mfspr	r11,SPRN_SRR0
	ld	r10,PACAKBASE(r13)
	LOAD_HANDLER(r10,unrecover_mce)
	mtspr	SPRN_SRR0,r10
	ld	r10,PACAKMSR(r13)
	/*
	 * We are going down. But there are chances that we might get hit by
	 * another MCE during panic path and we may run into unstable state
	 * with no way out. Hence, turn ME bit off while going down, so that
	 * when another MCE is hit during panic path, system will checkstop
	 * and hypervisor will get restarted cleanly by SP.
	 */
	li	r3,MSR_ME
	andc	r10,r10,r3		/* Turn off MSR_ME */
	mtspr	SPRN_SRR1,r10
	rfid
	b	.
1320
2:
1321 1322 1323 1324 1325 1326 1327 1328
	/*
	 * Check if we have successfully handled/recovered from error, if not
	 * then stay on emergency stack and panic.
	 */
	ld	r3,RESULT(r1)	/* Load result */
	cmpdi	r3,0		/* see if we handled MCE successfully */

	beq	1b		/* if !handled then panic */
1329 1330 1331 1332 1333
	/*
	 * Return from MC interrupt.
	 * Queue up the MCE event so that we can log it later, while
	 * returning from kernel or opal call.
	 */
1334
	bl	machine_check_queue_event
1335 1336 1337 1338 1339 1340 1341
	MACHINE_CHECK_HANDLER_WINDUP
	rfid
9:
	/* Deliver the machine check to host kernel in V mode. */
	MACHINE_CHECK_HANDLER_WINDUP
	b	machine_check_pSeries

1342 1343 1344
unrecover_mce:
	/* Invoke machine_check_exception to print MCE event and panic. */
	addi	r3,r1,STACK_FRAME_OVERHEAD
1345
	bl	machine_check_exception
1346 1347 1348 1349 1350
	/*
	 * We will not reach here. Even if we did, there is no way out. Call
	 * unrecoverable_exception and die.
	 */
1:	addi	r3,r1,STACK_FRAME_OVERHEAD
1351
	bl	unrecoverable_exception
1352
	b	1b
1353 1354 1355 1356 1357 1358 1359 1360
/*
 * r13 points to the PACA, r9 contains the saved CR,
 * r12 contain the saved SRR1, SRR0 is still ready for return
 * r3 has the faulting address
 * r9 - r13 are saved in paca->exslb.
 * r3 is saved in paca->slb_r3
 * We assume we aren't going to take any exceptions during this procedure.
 */
1361
slb_miss_realmode:
1362 1363 1364 1365 1366 1367 1368 1369
	mflr	r10
#ifdef CONFIG_RELOCATABLE
	mtctr	r11
#endif

	stw	r9,PACA_EXSLB+EX_CCR(r13)	/* save CR in exc. frame */
	std	r10,PACA_EXSLB+EX_LR(r13)	/* save LR */

1370 1371
#ifdef CONFIG_PPC_STD_MMU_64
BEGIN_MMU_FTR_SECTION
1372
	bl	slb_allocate_realmode
1373 1374
END_MMU_FTR_SECTION_IFCLR(MMU_FTR_RADIX)
#endif
1375 1376 1377 1378 1379 1380 1381 1382
	/* All done -- return from exception. */

	ld	r10,PACA_EXSLB+EX_LR(r13)
	ld	r3,PACA_EXSLB+EX_R3(r13)
	lwz	r9,PACA_EXSLB+EX_CCR(r13)	/* get saved CR */

	mtlr	r10
	andi.	r10,r12,MSR_RI	/* check for unrecoverable exception */
1383
BEGIN_MMU_FTR_SECTION
1384
	beq-	2f
1385 1386 1387
FTR_SECTION_ELSE
	b	2f
ALT_MMU_FTR_SECTION_END_IFCLR(MMU_FTR_RADIX)
1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414

.machine	push
.machine	"power4"
	mtcrf	0x80,r9
	mtcrf	0x01,r9		/* slb_allocate uses cr0 and cr7 */
.machine	pop

	RESTORE_PPR_PACA(PACA_EXSLB, r9)
	ld	r9,PACA_EXSLB+EX_R9(r13)
	ld	r10,PACA_EXSLB+EX_R10(r13)
	ld	r11,PACA_EXSLB+EX_R11(r13)
	ld	r12,PACA_EXSLB+EX_R12(r13)
	ld	r13,PACA_EXSLB+EX_R13(r13)
	rfid
	b	.	/* prevent speculative execution */

2:	mfspr	r11,SPRN_SRR0
	ld	r10,PACAKBASE(r13)
	LOAD_HANDLER(r10,unrecov_slb)
	mtspr	SPRN_SRR0,r10
	ld	r10,PACAKMSR(r13)
	mtspr	SPRN_SRR1,r10
	rfid
	b	.

unrecov_slb:
	EXCEPTION_PROLOG_COMMON(0x4100, PACA_EXSLB)
1415
	RECONCILE_IRQ_STATE(r10, r11)
1416
	bl	save_nvgprs
1417
1:	addi	r3,r1,STACK_FRAME_OVERHEAD
1418
	bl	unrecoverable_exception
1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430
	b	1b


#ifdef CONFIG_PPC_970_NAP
power4_fixup_nap:
	andc	r9,r9,r10
	std	r9,TI_LOCAL_FLAGS(r11)
	ld	r10,_LINK(r1)		/* make idle task do the */
	std	r10,_NIP(r1)		/* equivalent of a blr */
	blr
#endif

1431 1432 1433 1434
/*
 * Hash table stuff
 */
	.align	7
1435
do_hash_page:
1436
#ifdef CONFIG_PPC_STD_MMU_64
1437
	andis.	r0,r4,0xa410		/* weird error? */
1438
	bne-	handle_page_fault	/* if not, try to insert a HPTE */
1439 1440
	andis.  r0,r4,DSISR_DABRMATCH@h
	bne-    handle_dabr_fault
1441
	CURRENT_THREAD_INFO(r11, r1)
1442 1443 1444
	lwz	r0,TI_PREEMPT(r11)	/* If we're in an "NMI" */
	andis.	r0,r0,NMI_MASK@h	/* (i.e. an irq when soft-disabled) */
	bne	77f			/* then don't call hash_page now */
1445 1446 1447

	/*
	 * r3 contains the faulting address
1448
	 * r4 msr
1449
	 * r5 contains the trap number
1450
	 * r6 contains dsisr
1451
	 *
1452
	 * at return r3 = 0 for success, 1 for page fault, negative for error
1453
	 */
1454
        mr 	r4,r12
1455
	ld      r6,_DSISR(r1)
1456 1457
	bl	__hash_page		/* build HPTE if possible */
        cmpdi	r3,0			/* see if __hash_page succeeded */
1458

1459
	/* Success */
1460 1461
	beq	fast_exc_return_irq	/* Return from exception on success */

1462 1463
	/* Error */
	blt-	13f
1464
#endif /* CONFIG_PPC_STD_MMU_64 */
1465

1466 1467 1468 1469 1470
/* Here we have a page fault that hash_page can't handle. */
handle_page_fault:
11:	ld	r4,_DAR(r1)
	ld	r5,_DSISR(r1)
	addi	r3,r1,STACK_FRAME_OVERHEAD
1471
	bl	do_page_fault
1472
	cmpdi	r3,0
1473
	beq+	12f
1474
	bl	save_nvgprs
1475 1476 1477
	mr	r5,r3
	addi	r3,r1,STACK_FRAME_OVERHEAD
	lwz	r4,_DAR(r1)
1478 1479
	bl	bad_page_fault
	b	ret_from_except
1480

1481 1482
/* We have a data breakpoint exception - handle it */
handle_dabr_fault:
1483
	bl	save_nvgprs
1484 1485 1486
	ld      r4,_DAR(r1)
	ld      r5,_DSISR(r1)
	addi    r3,r1,STACK_FRAME_OVERHEAD
1487 1488
	bl      do_break
12:	b       ret_from_except_lite
1489

1490

1491
#ifdef CONFIG_PPC_STD_MMU_64
1492 1493 1494
/* We have a page fault that hash_page could handle but HV refused
 * the PTE insertion
 */
1495
13:	bl	save_nvgprs
1496 1497 1498
	mr	r5,r3
	addi	r3,r1,STACK_FRAME_OVERHEAD
	ld	r4,_DAR(r1)
1499 1500
	bl	low_hash_fault
	b	ret_from_except
1501
#endif
1502

1503 1504 1505 1506 1507 1508 1509
/*
 * We come here as a result of a DSI at a point where we don't want
 * to call hash_page, such as when we are accessing memory (possibly
 * user memory) inside a PMU interrupt that occurred while interrupts
 * were soft-disabled.  We want to invoke the exception handler for
 * the access, or panic if there isn't a handler.
 */
1510
77:	bl	save_nvgprs
1511 1512 1513
	mr	r4,r3
	addi	r3,r1,STACK_FRAME_OVERHEAD
	li	r5,SIGSEGV
1514 1515
	bl	bad_page_fault
	b	ret_from_except
1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575

/*
 * Here we have detected that the kernel stack pointer is bad.
 * R9 contains the saved CR, r13 points to the paca,
 * r10 contains the (bad) kernel stack pointer,
 * r11 and r12 contain the saved SRR0 and SRR1.
 * We switch to using an emergency stack, save the registers there,
 * and call kernel_bad_stack(), which panics.
 */
bad_stack:
	ld	r1,PACAEMERGSP(r13)
	subi	r1,r1,64+INT_FRAME_SIZE
	std	r9,_CCR(r1)
	std	r10,GPR1(r1)
	std	r11,_NIP(r1)
	std	r12,_MSR(r1)
	mfspr	r11,SPRN_DAR
	mfspr	r12,SPRN_DSISR
	std	r11,_DAR(r1)
	std	r12,_DSISR(r1)
	mflr	r10
	mfctr	r11
	mfxer	r12
	std	r10,_LINK(r1)
	std	r11,_CTR(r1)
	std	r12,_XER(r1)
	SAVE_GPR(0,r1)
	SAVE_GPR(2,r1)
	ld	r10,EX_R3(r3)
	std	r10,GPR3(r1)
	SAVE_GPR(4,r1)
	SAVE_4GPRS(5,r1)
	ld	r9,EX_R9(r3)
	ld	r10,EX_R10(r3)
	SAVE_2GPRS(9,r1)
	ld	r9,EX_R11(r3)
	ld	r10,EX_R12(r3)
	ld	r11,EX_R13(r3)
	std	r9,GPR11(r1)
	std	r10,GPR12(r1)
	std	r11,GPR13(r1)
BEGIN_FTR_SECTION
	ld	r10,EX_CFAR(r3)
	std	r10,ORIG_GPR3(r1)
END_FTR_SECTION_IFSET(CPU_FTR_CFAR)
	SAVE_8GPRS(14,r1)
	SAVE_10GPRS(22,r1)
	lhz	r12,PACA_TRAP_SAVE(r13)
	std	r12,_TRAP(r1)
	addi	r11,r1,INT_FRAME_SIZE
	std	r11,0(r1)
	li	r12,0
	std	r12,0(r11)
	ld	r2,PACATOC(r13)
	ld	r11,exception_marker@toc(r2)
	std	r12,RESULT(r1)
	std	r11,STACK_FRAME_OVERHEAD-16(r1)
1:	addi	r3,r1,STACK_FRAME_OVERHEAD
	bl	kernel_bad_stack
	b	1b