| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | /* | 
					
						
							|  |  |  |  * The ARM LDRD and Thumb LDRSB instructions use bit 20/11 (ARM/Thumb) | 
					
						
							|  |  |  |  * differently than every other instruction, so it is set to 0 (write) | 
					
						
							|  |  |  |  * even though the instructions are read instructions. This means that | 
					
						
							|  |  |  |  * during an abort the instructions will be treated as a write and the | 
					
						
							|  |  |  |  * handler will raise a signal from unwriteable locations if they | 
					
						
							|  |  |  |  * fault. We have to specifically check for these instructions | 
					
						
							|  |  |  |  * from the abort handlers to treat them properly. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-06-26 13:42:01 +01:00
										 |  |  | 	.macro	do_thumb_abort, fsr, pc, psr, tmp | 
					
						
							|  |  |  | 	tst	\psr, #PSR_T_BIT | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	beq	not_thumb | 
					
						
							| 
									
										
										
										
											2011-06-26 13:42:01 +01:00
										 |  |  | 	ldrh	\tmp, [\pc]			@ Read aborted Thumb instruction
 | 
					
						
							|  |  |  | 	and	\tmp, \tmp, # 0xfe00		@ Mask opcode field
 | 
					
						
							|  |  |  | 	cmp	\tmp, # 0x5600			@ Is it ldrsb?
 | 
					
						
							|  |  |  | 	orreq	\tmp, \tmp, #1 << 11		@ Set L-bit if yes
 | 
					
						
							|  |  |  | 	tst	\tmp, #1 << 11			@ L = 0 -> write
 | 
					
						
							| 
									
										
										
										
											2011-09-08 18:45:40 +01:00
										 |  |  | 	orreq	\fsr, \fsr, #1 << 11		@ yes.
 | 
					
						
							| 
									
										
										
										
											2011-06-26 16:01:26 +01:00
										 |  |  | 	b	do_DataAbort | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | not_thumb: | 
					
						
							|  |  |  | 	.endm | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /* | 
					
						
							| 
									
										
										
										
											2011-06-26 13:42:01 +01:00
										 |  |  |  * We check for the following instruction encoding for LDRD. | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  |  * | 
					
						
							| 
									
										
										
										
											2011-06-26 13:42:01 +01:00
										 |  |  |  * [27:25] == 000 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  |  *   [7:4] == 1101 | 
					
						
							|  |  |  |  *    [20] == 0 | 
					
						
							|  |  |  |  */ | 
					
						
							| 
									
										
										
										
											2011-06-26 13:42:01 +01:00
										 |  |  | 	.macro	do_ldrd_abort, tmp, insn | 
					
						
							| 
									
										
										
										
											2011-06-26 13:51:44 +01:00
										 |  |  | 	tst	\insn, #0x0e100000		@ [27:25,20] == 0
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 	bne	not_ldrd | 
					
						
							| 
									
										
										
										
											2011-06-26 13:42:01 +01:00
										 |  |  | 	and	\tmp, \insn, #0x000000f0	@ [7:4] == 1101
 | 
					
						
							|  |  |  | 	cmp	\tmp, #0x000000d0 | 
					
						
							| 
									
										
										
										
											2011-06-26 16:01:26 +01:00
										 |  |  | 	beq	do_DataAbort | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | not_ldrd: | 
					
						
							|  |  |  | 	.endm | 
					
						
							|  |  |  | 
 |