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
 |