133 lines
		
	
	
	
		
			2.6 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
		
		
			
		
	
	
			133 lines
		
	
	
	
		
			2.6 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
|   | #ifndef __ASM_ARM_IRQFLAGS_H
 | ||
|  | #define __ASM_ARM_IRQFLAGS_H
 | ||
|  | 
 | ||
|  | #ifdef __KERNEL__
 | ||
|  | 
 | ||
|  | #include <asm/ptrace.h>
 | ||
|  | 
 | ||
|  | /*
 | ||
|  |  * CPU interrupt mask handling. | ||
|  |  */ | ||
|  | #if __LINUX_ARM_ARCH__ >= 6
 | ||
|  | 
 | ||
|  | #define raw_local_irq_save(x)					\
 | ||
|  | 	({							\ | ||
|  | 	__asm__ __volatile__(					\ | ||
|  | 	"mrs	%0, cpsr		@ local_irq_save\n"	\ | ||
|  | 	"cpsid	i"						\ | ||
|  | 	: "=r" (x) : : "memory", "cc");				\ | ||
|  | 	}) | ||
|  | 
 | ||
|  | #define raw_local_irq_enable()  __asm__("cpsie i	@ __sti" : : : "memory", "cc")
 | ||
|  | #define raw_local_irq_disable() __asm__("cpsid i	@ __cli" : : : "memory", "cc")
 | ||
|  | #define local_fiq_enable()  __asm__("cpsie f	@ __stf" : : : "memory", "cc")
 | ||
|  | #define local_fiq_disable() __asm__("cpsid f	@ __clf" : : : "memory", "cc")
 | ||
|  | 
 | ||
|  | #else
 | ||
|  | 
 | ||
|  | /*
 | ||
|  |  * Save the current interrupt enable state & disable IRQs | ||
|  |  */ | ||
|  | #define raw_local_irq_save(x)					\
 | ||
|  | 	({							\ | ||
|  | 		unsigned long temp;				\ | ||
|  | 		(void) (&temp == &x);				\ | ||
|  | 	__asm__ __volatile__(					\ | ||
|  | 	"mrs	%0, cpsr		@ local_irq_save\n"	\ | ||
|  | "	orr	%1, %0, #128\n"					\ | ||
|  | "	msr	cpsr_c, %1"					\ | ||
|  | 	: "=r" (x), "=r" (temp)					\ | ||
|  | 	:							\ | ||
|  | 	: "memory", "cc");					\ | ||
|  | 	}) | ||
|  | 	 | ||
|  | /*
 | ||
|  |  * Enable IRQs | ||
|  |  */ | ||
|  | #define raw_local_irq_enable()					\
 | ||
|  | 	({							\ | ||
|  | 		unsigned long temp;				\ | ||
|  | 	__asm__ __volatile__(					\ | ||
|  | 	"mrs	%0, cpsr		@ local_irq_enable\n"	\ | ||
|  | "	bic	%0, %0, #128\n"					\ | ||
|  | "	msr	cpsr_c, %0"					\ | ||
|  | 	: "=r" (temp)						\ | ||
|  | 	:							\ | ||
|  | 	: "memory", "cc");					\ | ||
|  | 	}) | ||
|  | 
 | ||
|  | /*
 | ||
|  |  * Disable IRQs | ||
|  |  */ | ||
|  | #define raw_local_irq_disable()					\
 | ||
|  | 	({							\ | ||
|  | 		unsigned long temp;				\ | ||
|  | 	__asm__ __volatile__(					\ | ||
|  | 	"mrs	%0, cpsr		@ local_irq_disable\n"	\ | ||
|  | "	orr	%0, %0, #128\n"					\ | ||
|  | "	msr	cpsr_c, %0"					\ | ||
|  | 	: "=r" (temp)						\ | ||
|  | 	:							\ | ||
|  | 	: "memory", "cc");					\ | ||
|  | 	}) | ||
|  | 
 | ||
|  | /*
 | ||
|  |  * Enable FIQs | ||
|  |  */ | ||
|  | #define local_fiq_enable()					\
 | ||
|  | 	({							\ | ||
|  | 		unsigned long temp;				\ | ||
|  | 	__asm__ __volatile__(					\ | ||
|  | 	"mrs	%0, cpsr		@ stf\n"		\ | ||
|  | "	bic	%0, %0, #64\n"					\ | ||
|  | "	msr	cpsr_c, %0"					\ | ||
|  | 	: "=r" (temp)						\ | ||
|  | 	:							\ | ||
|  | 	: "memory", "cc");					\ | ||
|  | 	}) | ||
|  | 
 | ||
|  | /*
 | ||
|  |  * Disable FIQs | ||
|  |  */ | ||
|  | #define local_fiq_disable()					\
 | ||
|  | 	({							\ | ||
|  | 		unsigned long temp;				\ | ||
|  | 	__asm__ __volatile__(					\ | ||
|  | 	"mrs	%0, cpsr		@ clf\n"		\ | ||
|  | "	orr	%0, %0, #64\n"					\ | ||
|  | "	msr	cpsr_c, %0"					\ | ||
|  | 	: "=r" (temp)						\ | ||
|  | 	:							\ | ||
|  | 	: "memory", "cc");					\ | ||
|  | 	}) | ||
|  | 
 | ||
|  | #endif
 | ||
|  | 
 | ||
|  | /*
 | ||
|  |  * Save the current interrupt enable state. | ||
|  |  */ | ||
|  | #define raw_local_save_flags(x)					\
 | ||
|  | 	({							\ | ||
|  | 	__asm__ __volatile__(					\ | ||
|  | 	"mrs	%0, cpsr		@ local_save_flags"	\ | ||
|  | 	: "=r" (x) : : "memory", "cc");				\ | ||
|  | 	}) | ||
|  | 
 | ||
|  | /*
 | ||
|  |  * restore saved IRQ & FIQ state | ||
|  |  */ | ||
|  | #define raw_local_irq_restore(x)				\
 | ||
|  | 	__asm__ __volatile__(					\ | ||
|  | 	"msr	cpsr_c, %0		@ local_irq_restore\n"	\ | ||
|  | 	:							\ | ||
|  | 	: "r" (x)						\ | ||
|  | 	: "memory", "cc") | ||
|  | 
 | ||
|  | #define raw_irqs_disabled_flags(flags)	\
 | ||
|  | ({					\ | ||
|  | 	(int)((flags) & PSR_I_BIT);	\ | ||
|  | }) | ||
|  | 
 | ||
|  | #endif
 | ||
|  | #endif
 |