124 lines
		
	
	
		
			2.7 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			124 lines
		
	
	
		
			2.7 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * Copyright (C) 2006 Atmark Techno, Inc.
 | 
						|
 *
 | 
						|
 * This file is subject to the terms and conditions of the GNU General Public
 | 
						|
 * License. See the file "COPYING" in the main directory of this archive
 | 
						|
 * for more details.
 | 
						|
 */
 | 
						|
 | 
						|
#ifndef _ASM_MICROBLAZE_IRQFLAGS_H
 | 
						|
#define _ASM_MICROBLAZE_IRQFLAGS_H
 | 
						|
 | 
						|
#include <linux/irqflags.h>
 | 
						|
 | 
						|
# if CONFIG_XILINX_MICROBLAZE0_USE_MSR_INSTR
 | 
						|
 | 
						|
# define local_irq_save(flags)				\
 | 
						|
	do {						\
 | 
						|
		asm volatile ("# local_irq_save	\n\t"	\
 | 
						|
				"msrclr %0, %1	\n\t"	\
 | 
						|
				"nop	\n\t"		\
 | 
						|
				: "=r"(flags)		\
 | 
						|
				: "i"(MSR_IE)		\
 | 
						|
				: "memory");		\
 | 
						|
	} while (0)
 | 
						|
 | 
						|
# define local_irq_disable()					\
 | 
						|
	do {							\
 | 
						|
		asm volatile ("# local_irq_disable \n\t"	\
 | 
						|
				"msrclr r0, %0 \n\t"		\
 | 
						|
				"nop	\n\t"			\
 | 
						|
				:				\
 | 
						|
				: "i"(MSR_IE)			\
 | 
						|
				: "memory");			\
 | 
						|
	} while (0)
 | 
						|
 | 
						|
# define local_irq_enable()					\
 | 
						|
	do {							\
 | 
						|
		asm volatile ("# local_irq_enable \n\t"		\
 | 
						|
				"msrset	r0, %0 \n\t"		\
 | 
						|
				"nop	\n\t"			\
 | 
						|
				:				\
 | 
						|
				: "i"(MSR_IE)			\
 | 
						|
				: "memory");			\
 | 
						|
	} while (0)
 | 
						|
 | 
						|
# else /* CONFIG_XILINX_MICROBLAZE0_USE_MSR_INSTR == 0 */
 | 
						|
 | 
						|
# define local_irq_save(flags)					\
 | 
						|
	do {							\
 | 
						|
		register unsigned tmp;				\
 | 
						|
		asm volatile ("# local_irq_save	\n\t"		\
 | 
						|
				"mfs	%0, rmsr \n\t"		\
 | 
						|
				"nop \n\t"			\
 | 
						|
				"andi	%1, %0, %2 \n\t"	\
 | 
						|
				"mts	rmsr, %1 \n\t"		\
 | 
						|
				"nop \n\t"			\
 | 
						|
				: "=r"(flags), "=r" (tmp)	\
 | 
						|
				: "i"(~MSR_IE)			\
 | 
						|
				: "memory");			\
 | 
						|
	} while (0)
 | 
						|
 | 
						|
# define local_irq_disable()					\
 | 
						|
	do {							\
 | 
						|
		register unsigned tmp;				\
 | 
						|
		asm volatile ("# local_irq_disable \n\t"	\
 | 
						|
				"mfs	%0, rmsr \n\t"		\
 | 
						|
				"nop \n\t"			\
 | 
						|
				"andi	%0, %0, %1 \n\t"	\
 | 
						|
				"mts	rmsr, %0 \n\t"		\
 | 
						|
				"nop \n\t"			\
 | 
						|
				: "=r"(tmp)			\
 | 
						|
				: "i"(~MSR_IE)			\
 | 
						|
				: "memory");			\
 | 
						|
	} while (0)
 | 
						|
 | 
						|
# define local_irq_enable()					\
 | 
						|
	do {							\
 | 
						|
		register unsigned tmp;				\
 | 
						|
		asm volatile ("# local_irq_enable \n\t"		\
 | 
						|
				"mfs	%0, rmsr \n\t"		\
 | 
						|
				"nop \n\t"			\
 | 
						|
				"ori	%0, %0, %1 \n\t"	\
 | 
						|
				"mts	rmsr, %0 \n\t"		\
 | 
						|
				"nop \n\t"			\
 | 
						|
				: "=r"(tmp)			\
 | 
						|
				: "i"(MSR_IE)			\
 | 
						|
				: "memory");			\
 | 
						|
	} while (0)
 | 
						|
 | 
						|
# endif /* CONFIG_XILINX_MICROBLAZE0_USE_MSR_INSTR */
 | 
						|
 | 
						|
#define local_save_flags(flags)					\
 | 
						|
	do {							\
 | 
						|
		asm volatile ("# local_save_flags \n\t"		\
 | 
						|
				"mfs	%0, rmsr \n\t"		\
 | 
						|
				"nop	\n\t"			\
 | 
						|
				: "=r"(flags)			\
 | 
						|
				:				\
 | 
						|
				: "memory");			\
 | 
						|
	} while (0)
 | 
						|
 | 
						|
#define local_irq_restore(flags)			\
 | 
						|
	do {						\
 | 
						|
		asm volatile ("# local_irq_restore \n\t"\
 | 
						|
				"mts	rmsr, %0 \n\t"	\
 | 
						|
				"nop	\n\t"		\
 | 
						|
				:			\
 | 
						|
				: "r"(flags)		\
 | 
						|
				: "memory");		\
 | 
						|
	} while (0)
 | 
						|
 | 
						|
static inline int irqs_disabled(void)
 | 
						|
{
 | 
						|
	unsigned long flags;
 | 
						|
 | 
						|
	local_save_flags(flags);
 | 
						|
	return ((flags & MSR_IE) == 0);
 | 
						|
}
 | 
						|
 | 
						|
#define raw_irqs_disabled irqs_disabled
 | 
						|
#define raw_irqs_disabled_flags(flags)	((flags) == 0)
 | 
						|
 | 
						|
#endif /* _ASM_MICROBLAZE_IRQFLAGS_H */
 |