| 
									
										
										
										
											2007-07-09 22:06:53 +01:00
										 |  |  | /* | 
					
						
							|  |  |  |  *  Copyright (C) 2007 Lennert Buytenhek <buytenh@wantstofly.org>
 | 
					
						
							| 
									
										
										
										
											2009-12-03 22:36:41 +02:00
										 |  |  |  *  Copyright 2004-2009 Freescale Semiconductor, Inc. All Rights Reserved. | 
					
						
							| 
									
										
										
										
											2007-07-09 22:06:53 +01:00
										 |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /* | 
					
						
							|  |  |  |  * This program is free software; you can redistribute it and/or modify
 | 
					
						
							|  |  |  |  * it under the terms of the GNU General Public License version 2 as | 
					
						
							|  |  |  |  * published by the Free Software Foundation. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2008-12-18 11:51:57 +01:00
										 |  |  | #include <mach/hardware.h> | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2008-09-09 11:29:41 +02:00
										 |  |  | #define AVIC_NIMASK	0x04 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2007-07-09 22:06:53 +01:00
										 |  |  | 	@ this macro disables fast irq (not implemented)
 | 
					
						
							|  |  |  | 	.macro	disable_fiq
 | 
					
						
							|  |  |  | 	.endm | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	.macro  get_irqnr_preamble, base, tmp | 
					
						
							| 
									
										
										
										
											2009-12-03 22:36:41 +02:00
										 |  |  | #ifndef CONFIG_MXC_TZIC | 
					
						
							| 
									
										
										
										
											2009-05-25 10:50:52 +02:00
										 |  |  | 	ldr	\base, =avic_base | 
					
						
							|  |  |  | 	ldr	\base, [\base] | 
					
						
							| 
									
										
										
										
											2008-09-09 11:29:41 +02:00
										 |  |  | #ifdef CONFIG_MXC_IRQ_PRIOR | 
					
						
							|  |  |  | 	ldr	r4, [\base, #AVIC_NIMASK] | 
					
						
							|  |  |  | #endif | 
					
						
							| 
									
										
										
										
											2009-12-03 22:36:41 +02:00
										 |  |  | #elif defined CONFIG_MXC_TZIC | 
					
						
							|  |  |  | 	ldr	\base, =tzic_base | 
					
						
							|  |  |  | 	ldr	\base, [\base] | 
					
						
							|  |  |  | #endif /* CONFIG_MXC_TZIC */ | 
					
						
							| 
									
										
										
										
											2007-07-09 22:06:53 +01:00
										 |  |  | 	.endm | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	.macro  arch_ret_to_user, tmp1, tmp2 | 
					
						
							|  |  |  | 	.endm | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	@ this macro checks which interrupt occured
 | 
					
						
							|  |  |  | 	@ and returns its number in irqnr
 | 
					
						
							|  |  |  | 	@ and returns if an interrupt occured in irqstat
 | 
					
						
							|  |  |  | 	.macro	get_irqnr_and_base, irqnr, irqstat, base, tmp | 
					
						
							| 
									
										
										
										
											2009-12-03 22:36:41 +02:00
										 |  |  | #ifndef CONFIG_MXC_TZIC | 
					
						
							| 
									
										
										
										
											2007-07-09 22:06:53 +01:00
										 |  |  | 	@ Load offset & priority of the highest priority
 | 
					
						
							|  |  |  | 	@ interrupt pending from AVIC_NIVECSR
 | 
					
						
							|  |  |  | 	ldr	\irqstat, [\base, #0x40] | 
					
						
							|  |  |  | 	@ Shift to get the decoded IRQ number, using ASR so
 | 
					
						
							|  |  |  | 	@ 'no interrupt pending' becomes 0xffffffff
 | 
					
						
							|  |  |  | 	mov	\irqnr, \irqstat, asr #16 | 
					
						
							|  |  |  | 	@ set zero flag if IRQ + 1 == 0
 | 
					
						
							|  |  |  | 	adds	\tmp, \irqnr, #1 | 
					
						
							| 
									
										
										
										
											2008-09-09 11:29:41 +02:00
										 |  |  | #ifdef CONFIG_MXC_IRQ_PRIOR | 
					
						
							|  |  |  | 	bicne	\tmp, \irqstat, #0xFFFFFFE0 | 
					
						
							|  |  |  | 	strne	\tmp, [\base, #AVIC_NIMASK] | 
					
						
							|  |  |  | 	streq	r4, [\base, #AVIC_NIMASK] | 
					
						
							| 
									
										
										
										
											2009-12-03 22:36:41 +02:00
										 |  |  | #endif | 
					
						
							|  |  |  | #elif defined CONFIG_MXC_TZIC | 
					
						
							|  |  |  | 	@ Load offset & priority of the highest priority
 | 
					
						
							|  |  |  | 	@ interrupt pending.
 | 
					
						
							|  |  |  | 	@ 0xD80 is HIPND0 register
 | 
					
						
							|  |  |  | 	mov     \irqnr, #0 | 
					
						
							|  |  |  | 	mov     \irqstat, #0x0D80 | 
					
						
							|  |  |  | 1000: | 
					
						
							|  |  |  | 	ldr     \tmp,   [\irqstat, \base] | 
					
						
							|  |  |  | 	cmp     \tmp, #0 | 
					
						
							|  |  |  | 	bne     1001f | 
					
						
							|  |  |  | 	addeq   \irqnr, \irqnr, #32 | 
					
						
							|  |  |  | 	addeq   \irqstat, \irqstat, #4 | 
					
						
							|  |  |  | 	cmp     \irqnr, #128 | 
					
						
							|  |  |  | 	blo     1000b | 
					
						
							|  |  |  | 	b       2001f | 
					
						
							|  |  |  | 1001:	mov     \irqstat, #1 | 
					
						
							|  |  |  | 1002:	tst     \tmp, \irqstat | 
					
						
							|  |  |  | 	bne     2002f | 
					
						
							|  |  |  | 	movs    \tmp, \tmp, lsr #1 | 
					
						
							|  |  |  | 	addne   \irqnr, \irqnr, #1 | 
					
						
							|  |  |  | 	bne     1002b | 
					
						
							|  |  |  | 2001: | 
					
						
							|  |  |  | 	mov  \irqnr, #0 | 
					
						
							|  |  |  | 2002: | 
					
						
							|  |  |  | 	movs \irqnr, \irqnr | 
					
						
							| 
									
										
										
										
											2008-09-09 11:29:41 +02:00
										 |  |  | #endif | 
					
						
							| 
									
										
										
										
											2007-07-09 22:06:53 +01:00
										 |  |  | 	.endm | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	@ irq priority table (not used)
 | 
					
						
							|  |  |  | 	.macro	irq_prio_table
 | 
					
						
							|  |  |  | 	.endm |