| 
									
										
										
										
											2007-05-08 22:27:46 +01:00
										 |  |  | #include <linux/linkage.h> | 
					
						
							|  |  |  | #include <asm/assembler.h> | 
					
						
							|  |  |  | /* | 
					
						
							|  |  |  |  * Function: v7_early_abort | 
					
						
							|  |  |  |  * | 
					
						
							| 
									
										
										
										
											2011-06-26 16:01:26 +01:00
										 |  |  |  * Params  : r2 = pt_regs | 
					
						
							|  |  |  |  *	   : r4 = aborted context pc | 
					
						
							| 
									
										
										
										
											2011-06-26 14:35:07 +01:00
										 |  |  |  *	   : r5 = aborted context psr | 
					
						
							| 
									
										
										
										
											2007-05-08 22:27:46 +01:00
										 |  |  |  * | 
					
						
							| 
									
										
										
										
											2011-06-26 16:01:26 +01:00
										 |  |  |  * Returns : r4 - r11, r13 preserved | 
					
						
							| 
									
										
										
										
											2007-05-08 22:27:46 +01:00
										 |  |  |  * | 
					
						
							|  |  |  |  * Purpose : obtain information about current aborted instruction. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 	.align	5
 | 
					
						
							|  |  |  | ENTRY(v7_early_abort) | 
					
						
							|  |  |  | 	mrc	p15, 0, r1, c5, c0, 0		@ get FSR
 | 
					
						
							|  |  |  | 	mrc	p15, 0, r0, c6, c0, 0		@ get FAR
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* | 
					
						
							|  |  |  | 	 * V6 code adjusts the returned DFSR. | 
					
						
							|  |  |  | 	 * New designs should not need to patch up faults. | 
					
						
							|  |  |  | 	 */ | 
					
						
							| 
									
										
										
										
											2009-08-11 17:58:49 -04:00
										 |  |  | 
 | 
					
						
							|  |  |  | #if defined(CONFIG_VERIFY_PERMISSION_FAULT) | 
					
						
							|  |  |  | 	/* | 
					
						
							|  |  |  | 	 * Detect erroneous permission failures and fix | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | 	ldr	r3, =0x40d			@ On permission fault
 | 
					
						
							|  |  |  | 	and	r3, r1, r3 | 
					
						
							|  |  |  | 	cmp	r3, #0x0d | 
					
						
							| 
									
										
										
										
											2011-06-26 16:01:26 +01:00
										 |  |  | 	bne	do_DataAbort | 
					
						
							| 
									
										
										
										
											2009-08-11 17:58:49 -04:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	mcr	p15, 0, r0, c7, c8, 0   	@ Retranslate FAR
 | 
					
						
							|  |  |  | 	isb | 
					
						
							| 
									
										
										
										
											2011-06-26 14:42:02 +01:00
										 |  |  | 	mrc	p15, 0, ip, c7, c4, 0   	@ Read the PAR
 | 
					
						
							|  |  |  | 	and	r3, ip, #0x7b   		@ On translation fault
 | 
					
						
							| 
									
										
										
										
											2009-08-11 17:58:49 -04:00
										 |  |  | 	cmp	r3, #0x0b | 
					
						
							| 
									
										
										
										
											2011-06-26 16:01:26 +01:00
										 |  |  | 	bne	do_DataAbort | 
					
						
							| 
									
										
										
										
											2009-08-11 17:58:49 -04:00
										 |  |  | 	bic	r1, r1, #0xf			@ Fix up FSR FS[5:0]
 | 
					
						
							| 
									
										
										
										
											2011-06-26 14:42:02 +01:00
										 |  |  | 	and	ip, ip, #0x7e | 
					
						
							|  |  |  | 	orr	r1, r1, ip, LSR #1 | 
					
						
							| 
									
										
										
										
											2009-08-11 17:58:49 -04:00
										 |  |  | #endif | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-06-26 16:01:26 +01:00
										 |  |  | 	b	do_DataAbort | 
					
						
							| 
									
										
										
										
											2008-08-28 11:22:32 +01:00
										 |  |  | ENDPROC(v7_early_abort) |