1/* SPDX-License-Identifier: GPL-2.0 */
  2/*
  3 * Copyright (C) 2006 Atmark Techno, Inc.
  4 */
  5
  6#ifndef _ASM_MICROBLAZE_IRQFLAGS_H
  7#define _ASM_MICROBLAZE_IRQFLAGS_H
  8
  9#include <linux/types.h>
 10#include <asm/registers.h>
 11
 12#if CONFIG_XILINX_MICROBLAZE0_USE_MSR_INSTR
 13
 14static inline notrace unsigned long arch_local_irq_save(void)
 15{
 16	unsigned long flags;
 17	asm volatile("	msrclr %0, %1	\n"
 18		     "	nop		\n"
 19		     : "=r"(flags)
 20		     : "i"(MSR_IE)
 21		     : "memory");
 22	return flags;
 23}
 24
 25static inline notrace void arch_local_irq_disable(void)
 26{
 27	/* this uses r0 without declaring it - is that correct? */
 28	asm volatile("	msrclr r0, %0	\n"
 29		     "	nop		\n"
 30		     :
 31		     : "i"(MSR_IE)
 32		     : "memory");
 33}
 34
 35static inline notrace void arch_local_irq_enable(void)
 36{
 37	/* this uses r0 without declaring it - is that correct? */
 38	asm volatile("	msrset	r0, %0	\n"
 39		     "	nop		\n"
 40		     :
 41		     : "i"(MSR_IE)
 42		     : "memory");
 43}
 44
 45#else /* !CONFIG_XILINX_MICROBLAZE0_USE_MSR_INSTR */
 46
 47static inline notrace unsigned long arch_local_irq_save(void)
 48{
 49	unsigned long flags, tmp;
 50	asm volatile ("	mfs	%0, rmsr	\n"
 51		      "	nop			\n"
 52		      "	andi	%1, %0, %2	\n"
 53		      "	mts	rmsr, %1	\n"
 54		      "	nop			\n"
 55		      : "=r"(flags), "=r"(tmp)
 56		      : "i"(~MSR_IE)
 57		      : "memory");
 58	return flags;
 59}
 60
 61static inline notrace void arch_local_irq_disable(void)
 62{
 63	unsigned long tmp;
 64	asm volatile("	mfs	%0, rmsr	\n"
 65		     "	nop			\n"
 66		     "	andi	%0, %0, %1	\n"
 67		     "	mts	rmsr, %0	\n"
 68		     "	nop			\n"
 69		     : "=r"(tmp)
 70		     : "i"(~MSR_IE)
 71		     : "memory");
 72}
 73
 74static inline notrace void arch_local_irq_enable(void)
 75{
 76	unsigned long tmp;
 77	asm volatile("	mfs	%0, rmsr	\n"
 78		     "	nop			\n"
 79		     "	ori	%0, %0, %1	\n"
 80		     "	mts	rmsr, %0	\n"
 81		     "	nop			\n"
 82		     : "=r"(tmp)
 83		     : "i"(MSR_IE)
 84		     : "memory");
 85}
 86
 87#endif /* CONFIG_XILINX_MICROBLAZE0_USE_MSR_INSTR */
 88
 89static inline notrace unsigned long arch_local_save_flags(void)
 90{
 91	unsigned long flags;
 92	asm volatile("	mfs	%0, rmsr	\n"
 93		     "	nop			\n"
 94		     : "=r"(flags)
 95		     :
 96		     : "memory");
 97	return flags;
 98}
 99
100static inline notrace void arch_local_irq_restore(unsigned long flags)
101{
102	asm volatile("	mts	rmsr, %0	\n"
103		     "	nop			\n"
104		     :
105		     : "r"(flags)
106		     : "memory");
107}
108
109static inline notrace bool arch_irqs_disabled_flags(unsigned long flags)
110{
111	return (flags & MSR_IE) == 0;
112}
113
114static inline notrace bool arch_irqs_disabled(void)
115{
116	return arch_irqs_disabled_flags(arch_local_save_flags());
117}
118
119#endif /* _ASM_MICROBLAZE_IRQFLAGS_H */