| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | /* | 
					
						
							| 
									
										
										
										
											2008-08-05 16:14:15 +01:00
										 |  |  |  * arch/arm/mach-versatile/include/mach/entry-macro.S | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  |  * | 
					
						
							|  |  |  |  * Low-level IRQ helper macros for Versatile platforms | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * This file is licensed under  the terms of the GNU General Public | 
					
						
							|  |  |  |  * 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/hardware.h> | 
					
						
							| 
									
										
										
										
											2010-01-14 19:59:37 +00:00
										 |  |  | #include <mach/platform.h> | 
					
						
							| 
									
										
										
										
											2006-01-13 21:30:48 +00:00
										 |  |  | #include <asm/hardware/vic.h> | 
					
						
							| 
									
										
										
										
											2006-01-03 17:39:34 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		.macro	disable_fiq
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		.endm | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-02-16 22:16:32 +01:00
										 |  |  | 		.macro  get_irqnr_preamble, base, tmp | 
					
						
							| 
									
										
										
										
											2007-05-12 15:25:50 +01:00
										 |  |  | 		ldr	\base, =IO_ADDRESS(VERSATILE_VIC_BASE) | 
					
						
							| 
									
										
										
										
											2007-02-16 22:16:32 +01:00
										 |  |  | 		.endm | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		.macro  arch_ret_to_user, tmp1, tmp2 | 
					
						
							|  |  |  | 		.endm | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2005-04-16 15:20:36 -07:00
										 |  |  | 		.macro	get_irqnr_and_base, irqnr, irqstat, base, tmp | 
					
						
							|  |  |  | 		ldr	\irqstat, [\base, #VIC_IRQ_STATUS]	@ get masked status | 
					
						
							|  |  |  | 		mov	\irqnr, #0 | 
					
						
							|  |  |  | 		teq	\irqstat, #0 | 
					
						
							|  |  |  | 		beq	1003f | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 1001:		tst	\irqstat, #15 | 
					
						
							|  |  |  | 		bne	1002f | 
					
						
							|  |  |  | 		add	\irqnr, \irqnr, #4 | 
					
						
							|  |  |  | 		movs	\irqstat, \irqstat, lsr #4 | 
					
						
							|  |  |  | 		bne	1001b | 
					
						
							|  |  |  | 1002:		tst	\irqstat, #1 | 
					
						
							|  |  |  | 		bne	1003f | 
					
						
							|  |  |  | 		add	\irqnr, \irqnr, #1 | 
					
						
							|  |  |  | 		movs	\irqstat, \irqstat, lsr #1 | 
					
						
							|  |  |  | 		bne	1002b | 
					
						
							|  |  |  | 1003:		/* EQ will be set if no irqs pending */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | @		clz	\irqnr, \irqstat
 | 
					
						
							|  |  |  | @1003:		/* EQ will be set if we reach MAXIRQNUM */
 | 
					
						
							|  |  |  | 		.endm | 
					
						
							|  |  |  | 
 |