| 
									
										
										
										
											2006-09-18 23:10:26 +01:00
										 |  |  | /* | 
					
						
							| 
									
										
										
										
											2008-08-05 16:14:15 +01:00
										 |  |  |  * arch/arm/mach-iop32x/include/mach/entry-macro.S | 
					
						
							| 
									
										
										
										
											2006-09-18 23:10:26 +01:00
										 |  |  |  * | 
					
						
							|  |  |  |  * Low-level IRQ helper macros for IOP32x-based platforms | 
					
						
							|  |  |  |  * | 
					
						
							| 
									
										
										
										
											2006-09-18 23:26:25 +01:00
										 |  |  |  * This file is licensed under the terms of the GNU General Public | 
					
						
							| 
									
										
										
										
											2006-09-18 23:10:26 +01:00
										 |  |  |  * License version 2. This program is licensed "as is" without any | 
					
						
							|  |  |  |  * warranty of any kind, whether express or implied. | 
					
						
							|  |  |  |  */ | 
					
						
							| 
									
										
										
										
											2008-08-05 16:14:15 +01:00
										 |  |  | #include <mach/iop32x.h> | 
					
						
							| 
									
										
										
										
											2006-09-18 23:10:26 +01:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-02-16 22:16:32 +01:00
										 |  |  | 	.macro	disable_fiq
 | 
					
						
							|  |  |  | 	.endm | 
					
						
							| 
									
										
										
										
											2006-09-18 23:10:26 +01:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-02-16 22:16:32 +01:00
										 |  |  | 	.macro get_irqnr_preamble, base, tmp | 
					
						
							|  |  |  | 	mrc	p15, 0, \tmp, c15, c1, 0 | 
					
						
							|  |  |  | 	orr	\tmp, \tmp, #(1 << 6) | 
					
						
							|  |  |  | 	mcr	p15, 0, \tmp, c15, c1, 0	@ Enable cp6 access
 | 
					
						
							|  |  |  | 	mrc	p15, 0, \tmp, c15, c1, 0 | 
					
						
							|  |  |  | 	mov	\tmp, \tmp | 
					
						
							|  |  |  | 	sub	pc, pc, #4			@ cp_wait
 | 
					
						
							|  |  |  | 	.endm | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	.macro  get_irqnr_and_base, irqnr, irqstat, base, tmp | 
					
						
							|  |  |  | 	mrc     p6, 0, \irqstat, c8, c0, 0	@ Read IINTSRC
 | 
					
						
							|  |  |  | 	cmp     \irqstat, #0 | 
					
						
							|  |  |  | 	clzne   \irqnr, \irqstat | 
					
						
							|  |  |  | 	rsbne   \irqnr, \irqnr, #31 | 
					
						
							|  |  |  | 	.endm | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	.macro arch_ret_to_user, tmp1, tmp2 | 
					
						
							|  |  |  | 	mrc	p15, 0, \tmp1, c15, c1, 0 | 
					
						
							|  |  |  | 	ands	\tmp2, \tmp1, #(1 << 6) | 
					
						
							|  |  |  | 	bicne	\tmp1, \tmp1, #(1 << 6) | 
					
						
							|  |  |  | 	mcrne	p15, 0, \tmp1, c15, c1, 0	@ Disable cp6 access
 | 
					
						
							|  |  |  | 	.endm |