| 
									
										
										
										
											2006-02-04 00:10:01 -08:00
										 |  |  | /* winfixup.S: Handle cases where user stack pointer is found to be bogus. | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  |  * | 
					
						
							| 
									
										
										
										
											2006-02-04 00:10:01 -08:00
										 |  |  |  * Copyright (C) 1997, 2006 David S. Miller (davem@davemloft.net)
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include <asm/asi.h> | 
					
						
							|  |  |  | #include <asm/head.h> | 
					
						
							|  |  |  | #include <asm/page.h> | 
					
						
							|  |  |  | #include <asm/ptrace.h> | 
					
						
							|  |  |  | #include <asm/processor.h> | 
					
						
							|  |  |  | #include <asm/spitfire.h> | 
					
						
							|  |  |  | #include <asm/thread_info.h> | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	.text | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2006-02-04 00:10:01 -08:00
										 |  |  | 	/* It used to be the case that these register window fault | 
					
						
							|  |  |  | 	 * handlers could run via the save and restore instructions | 
					
						
							|  |  |  | 	 * done by the trap entry and exit code.  They now do the | 
					
						
							|  |  |  | 	 * window spill/fill by hand, so that case no longer can occur. | 
					
						
							|  |  |  | 	 */ | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	.align	32
 | 
					
						
							|  |  |  | fill_fixup: | 
					
						
							| 
									
										
										
										
											2006-02-02 21:55:10 -08:00
										 |  |  | 	TRAP_LOAD_THREAD_REG(%g6, %g1) | 
					
						
							| 
									
										
										
										
											2006-02-04 00:10:01 -08:00
										 |  |  | 	rdpr	%tstate, %g1 | 
					
						
							|  |  |  | 	and	%g1, TSTATE_CWP, %g1 | 
					
						
							|  |  |  | 	or	%g4, FAULT_CODE_WINFIXUP, %g4 | 
					
						
							|  |  |  | 	stb	%g4, [%g6 + TI_FAULT_CODE] | 
					
						
							|  |  |  | 	stx	%g5, [%g6 + TI_FAULT_ADDR] | 
					
						
							|  |  |  | 	wrpr	%g1, %cwp | 
					
						
							|  |  |  | 	ba,pt	%xcc, etrap | 
					
						
							|  |  |  | 	 rd	%pc, %g7 | 
					
						
							|  |  |  | 	call	do_sparc64_fault | 
					
						
							|  |  |  | 	 add	%sp, PTREGS_OFF, %o0 | 
					
						
							| 
									
										
										
										
											2008-04-24 03:15:22 -07:00
										 |  |  | 	ba,pt	%xcc, rtrap | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 nop | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2006-02-04 00:10:01 -08:00
										 |  |  | 	/* Be very careful about usage of the trap globals here. | 
					
						
							|  |  |  | 	 * You cannot touch %g5 as that has the fault information. | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	 */ | 
					
						
							|  |  |  | spill_fixup: | 
					
						
							| 
									
										
										
										
											2006-02-04 00:10:01 -08:00
										 |  |  | spill_fixup_mna: | 
					
						
							|  |  |  | spill_fixup_dax: | 
					
						
							| 
									
										
										
										
											2006-02-02 21:55:10 -08:00
										 |  |  | 	TRAP_LOAD_THREAD_REG(%g6, %g1) | 
					
						
							| 
									
										
										
										
											2006-02-04 00:10:01 -08:00
										 |  |  | 	ldx	[%g6 + TI_FLAGS], %g1 | 
					
						
							|  |  |  | 	andcc	%g1, _TIF_32BIT, %g0 | 
					
						
							|  |  |  | 	ldub	[%g6 + TI_WSAVED], %g1 | 
					
						
							|  |  |  | 	sll	%g1, 3, %g3 | 
					
						
							|  |  |  | 	add	%g6, %g3, %g3 | 
					
						
							|  |  |  | 	stx	%sp, [%g3 + TI_RWIN_SPTRS] | 
					
						
							|  |  |  | 	sll	%g1, 7, %g3 | 
					
						
							|  |  |  | 	bne,pt	%xcc, 1f | 
					
						
							|  |  |  | 	 add	%g6, %g3, %g3 | 
					
						
							|  |  |  | 	stx	%l0, [%g3 + TI_REG_WINDOW + 0x00] | 
					
						
							|  |  |  | 	stx	%l1, [%g3 + TI_REG_WINDOW + 0x08] | 
					
						
							|  |  |  | 	stx	%l2, [%g3 + TI_REG_WINDOW + 0x10] | 
					
						
							|  |  |  | 	stx	%l3, [%g3 + TI_REG_WINDOW + 0x18] | 
					
						
							|  |  |  | 	stx	%l4, [%g3 + TI_REG_WINDOW + 0x20] | 
					
						
							|  |  |  | 	stx	%l5, [%g3 + TI_REG_WINDOW + 0x28] | 
					
						
							|  |  |  | 	stx	%l6, [%g3 + TI_REG_WINDOW + 0x30] | 
					
						
							|  |  |  | 	stx	%l7, [%g3 + TI_REG_WINDOW + 0x38] | 
					
						
							|  |  |  | 	stx	%i0, [%g3 + TI_REG_WINDOW + 0x40] | 
					
						
							|  |  |  | 	stx	%i1, [%g3 + TI_REG_WINDOW + 0x48] | 
					
						
							|  |  |  | 	stx	%i2, [%g3 + TI_REG_WINDOW + 0x50] | 
					
						
							|  |  |  | 	stx	%i3, [%g3 + TI_REG_WINDOW + 0x58] | 
					
						
							|  |  |  | 	stx	%i4, [%g3 + TI_REG_WINDOW + 0x60] | 
					
						
							|  |  |  | 	stx	%i5, [%g3 + TI_REG_WINDOW + 0x68] | 
					
						
							|  |  |  | 	stx	%i6, [%g3 + TI_REG_WINDOW + 0x70] | 
					
						
							|  |  |  | 	ba,pt	%xcc, 2f | 
					
						
							|  |  |  | 	 stx	%i7, [%g3 + TI_REG_WINDOW + 0x78] | 
					
						
							|  |  |  | 1:	stw	%l0, [%g3 + TI_REG_WINDOW + 0x00] | 
					
						
							|  |  |  | 	stw	%l1, [%g3 + TI_REG_WINDOW + 0x04] | 
					
						
							|  |  |  | 	stw	%l2, [%g3 + TI_REG_WINDOW + 0x08] | 
					
						
							|  |  |  | 	stw	%l3, [%g3 + TI_REG_WINDOW + 0x0c] | 
					
						
							|  |  |  | 	stw	%l4, [%g3 + TI_REG_WINDOW + 0x10] | 
					
						
							|  |  |  | 	stw	%l5, [%g3 + TI_REG_WINDOW + 0x14] | 
					
						
							|  |  |  | 	stw	%l6, [%g3 + TI_REG_WINDOW + 0x18] | 
					
						
							|  |  |  | 	stw	%l7, [%g3 + TI_REG_WINDOW + 0x1c] | 
					
						
							|  |  |  | 	stw	%i0, [%g3 + TI_REG_WINDOW + 0x20] | 
					
						
							|  |  |  | 	stw	%i1, [%g3 + TI_REG_WINDOW + 0x24] | 
					
						
							|  |  |  | 	stw	%i2, [%g3 + TI_REG_WINDOW + 0x28] | 
					
						
							|  |  |  | 	stw	%i3, [%g3 + TI_REG_WINDOW + 0x2c] | 
					
						
							|  |  |  | 	stw	%i4, [%g3 + TI_REG_WINDOW + 0x30] | 
					
						
							|  |  |  | 	stw	%i5, [%g3 + TI_REG_WINDOW + 0x34] | 
					
						
							|  |  |  | 	stw	%i6, [%g3 + TI_REG_WINDOW + 0x38] | 
					
						
							|  |  |  | 	stw	%i7, [%g3 + TI_REG_WINDOW + 0x3c] | 
					
						
							|  |  |  | 2:	add	%g1, 1, %g1 | 
					
						
							|  |  |  | 	stb	%g1, [%g6 + TI_WSAVED] | 
					
						
							|  |  |  | 	rdpr	%tstate, %g1 | 
					
						
							|  |  |  | 	andcc	%g1, TSTATE_PRIV, %g0 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	saved | 
					
						
							| 
									
										
										
										
											2006-02-04 00:10:01 -08:00
										 |  |  | 	be,pn	%xcc, 1f | 
					
						
							|  |  |  | 	 and	%g1, TSTATE_CWP, %g1 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	retry | 
					
						
							| 
									
										
										
										
											2006-02-04 00:10:01 -08:00
										 |  |  | 1:	mov	FAULT_CODE_WRITE | FAULT_CODE_DTLB | FAULT_CODE_WINFIXUP, %g4 | 
					
						
							|  |  |  | 	stb	%g4, [%g6 + TI_FAULT_CODE] | 
					
						
							|  |  |  | 	stx	%g5, [%g6 + TI_FAULT_ADDR] | 
					
						
							|  |  |  | 	wrpr	%g1, %cwp | 
					
						
							|  |  |  | 	ba,pt	%xcc, etrap | 
					
						
							|  |  |  | 	 rd	%pc, %g7 | 
					
						
							|  |  |  | 	call	do_sparc64_fault | 
					
						
							|  |  |  | 	 add	%sp, PTREGS_OFF, %o0 | 
					
						
							| 
									
										
										
										
											2008-04-24 03:15:22 -07:00
										 |  |  | 	ba,a,pt	%xcc, rtrap | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | winfix_mna: | 
					
						
							| 
									
										
										
										
											2006-02-04 00:10:01 -08:00
										 |  |  | 	andn	%g3, 0x7f, %g3 | 
					
						
							|  |  |  | 	add	%g3, 0x78, %g3 | 
					
						
							|  |  |  | 	wrpr	%g3, %tnpc | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	done | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2006-02-04 00:10:01 -08:00
										 |  |  | fill_fixup_mna: | 
					
						
							|  |  |  | 	rdpr	%tstate, %g1 | 
					
						
							|  |  |  | 	and	%g1, TSTATE_CWP, %g1 | 
					
						
							|  |  |  | 	wrpr	%g1, %cwp | 
					
						
							|  |  |  | 	ba,pt	%xcc, etrap | 
					
						
							|  |  |  | 	 rd	%pc, %g7 | 
					
						
							| 
									
										
										
										
											2006-02-09 20:20:34 -08:00
										 |  |  | 	sethi	%hi(tlb_type), %g1 | 
					
						
							|  |  |  | 	lduw	[%g1 + %lo(tlb_type)], %g1 | 
					
						
							|  |  |  | 	cmp	%g1, 3 | 
					
						
							|  |  |  | 	bne,pt	%icc, 1f | 
					
						
							| 
									
										
										
										
											2006-02-04 00:10:01 -08:00
										 |  |  | 	 add	%sp, PTREGS_OFF, %o0 | 
					
						
							| 
									
										
										
										
											2006-02-18 16:39:39 -08:00
										 |  |  | 	mov	%l4, %o2 | 
					
						
							| 
									
										
										
										
											2006-02-16 01:45:49 -08:00
										 |  |  | 	call	sun4v_do_mna | 
					
						
							| 
									
										
										
										
											2006-02-18 16:39:39 -08:00
										 |  |  | 	 mov	%l5, %o1 | 
					
						
							| 
									
										
										
										
											2008-04-24 03:15:22 -07:00
										 |  |  | 	ba,a,pt	%xcc, rtrap | 
					
						
							| 
									
										
										
										
											2006-02-18 16:39:39 -08:00
										 |  |  | 1:	mov	%l4, %o1 | 
					
						
							|  |  |  | 	mov	%l5, %o2 | 
					
						
							|  |  |  | 	call	mem_address_unaligned | 
					
						
							| 
									
										
										
										
											2006-02-09 20:20:34 -08:00
										 |  |  | 	 nop | 
					
						
							| 
									
										
										
										
											2008-04-24 03:15:22 -07:00
										 |  |  | 	ba,a,pt	%xcc, rtrap | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | winfix_dax: | 
					
						
							| 
									
										
										
										
											2006-02-04 00:10:01 -08:00
										 |  |  | 	andn	%g3, 0x7f, %g3 | 
					
						
							|  |  |  | 	add	%g3, 0x74, %g3 | 
					
						
							|  |  |  | 	wrpr	%g3, %tnpc | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	done | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2006-02-04 00:10:01 -08:00
										 |  |  | fill_fixup_dax: | 
					
						
							|  |  |  | 	rdpr	%tstate, %g1 | 
					
						
							|  |  |  | 	and	%g1, TSTATE_CWP, %g1 | 
					
						
							|  |  |  | 	wrpr	%g1, %cwp | 
					
						
							|  |  |  | 	ba,pt	%xcc, etrap | 
					
						
							|  |  |  | 	 rd	%pc, %g7 | 
					
						
							| 
									
										
										
										
											2006-02-09 20:20:34 -08:00
										 |  |  | 	sethi	%hi(tlb_type), %g1 | 
					
						
							| 
									
										
										
										
											2006-02-04 00:10:01 -08:00
										 |  |  | 	mov	%l4, %o1 | 
					
						
							| 
									
										
										
										
											2006-02-09 20:20:34 -08:00
										 |  |  | 	lduw	[%g1 + %lo(tlb_type)], %g1 | 
					
						
							| 
									
										
										
										
											2006-02-04 00:10:01 -08:00
										 |  |  | 	mov	%l5, %o2 | 
					
						
							| 
									
										
										
										
											2006-02-09 20:20:34 -08:00
										 |  |  | 	cmp	%g1, 3 | 
					
						
							|  |  |  | 	bne,pt	%icc, 1f | 
					
						
							| 
									
										
										
										
											2006-02-04 00:10:01 -08:00
										 |  |  | 	 add	%sp, PTREGS_OFF, %o0 | 
					
						
							| 
									
										
										
										
											2006-02-09 20:20:34 -08:00
										 |  |  | 	call	sun4v_data_access_exception | 
					
						
							|  |  |  | 	 nop | 
					
						
							| 
									
										
										
										
											2008-04-24 03:15:22 -07:00
										 |  |  | 	ba,a,pt	%xcc, rtrap | 
					
						
							| 
									
										
										
										
											2006-02-09 20:20:34 -08:00
										 |  |  | 1:	call	spitfire_data_access_exception | 
					
						
							|  |  |  | 	 nop | 
					
						
							| 
									
										
										
										
											2008-04-24 03:15:22 -07:00
										 |  |  | 	ba,a,pt	%xcc, rtrap |