162306a36Sopenharmony_ci/* SPDX-License-Identifier: GPL-2.0 */
262306a36Sopenharmony_ci#ifndef _M68K_IRQFLAGS_H
362306a36Sopenharmony_ci#define _M68K_IRQFLAGS_H
462306a36Sopenharmony_ci
562306a36Sopenharmony_ci#include <linux/types.h>
662306a36Sopenharmony_ci#include <linux/preempt.h>
762306a36Sopenharmony_ci#include <asm/thread_info.h>
862306a36Sopenharmony_ci#include <asm/entry.h>
962306a36Sopenharmony_ci
1062306a36Sopenharmony_cistatic inline unsigned long arch_local_save_flags(void)
1162306a36Sopenharmony_ci{
1262306a36Sopenharmony_ci	unsigned long flags;
1362306a36Sopenharmony_ci	asm volatile ("movew %%sr,%0" : "=d" (flags) : : "memory");
1462306a36Sopenharmony_ci	return flags;
1562306a36Sopenharmony_ci}
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_cistatic inline void arch_local_irq_disable(void)
1862306a36Sopenharmony_ci{
1962306a36Sopenharmony_ci#ifdef CONFIG_COLDFIRE
2062306a36Sopenharmony_ci	asm volatile (
2162306a36Sopenharmony_ci		"move	%/sr,%%d0	\n\t"
2262306a36Sopenharmony_ci		"ori.l	#0x0700,%%d0	\n\t"
2362306a36Sopenharmony_ci		"move	%%d0,%/sr	\n"
2462306a36Sopenharmony_ci		: /* no outputs */
2562306a36Sopenharmony_ci		:
2662306a36Sopenharmony_ci		: "cc", "%d0", "memory");
2762306a36Sopenharmony_ci#else
2862306a36Sopenharmony_ci	asm volatile ("oriw  #0x0700,%%sr" : : : "memory");
2962306a36Sopenharmony_ci#endif
3062306a36Sopenharmony_ci}
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_cistatic inline void arch_local_irq_enable(void)
3362306a36Sopenharmony_ci{
3462306a36Sopenharmony_ci#if defined(CONFIG_COLDFIRE)
3562306a36Sopenharmony_ci	asm volatile (
3662306a36Sopenharmony_ci		"move	%/sr,%%d0	\n\t"
3762306a36Sopenharmony_ci		"andi.l	#0xf8ff,%%d0	\n\t"
3862306a36Sopenharmony_ci		"move	%%d0,%/sr	\n"
3962306a36Sopenharmony_ci		: /* no outputs */
4062306a36Sopenharmony_ci		:
4162306a36Sopenharmony_ci		: "cc", "%d0", "memory");
4262306a36Sopenharmony_ci#else
4362306a36Sopenharmony_ci# if defined(CONFIG_MMU)
4462306a36Sopenharmony_ci	if (MACH_IS_Q40 || !hardirq_count())
4562306a36Sopenharmony_ci# endif
4662306a36Sopenharmony_ci		asm volatile (
4762306a36Sopenharmony_ci			"andiw %0,%%sr"
4862306a36Sopenharmony_ci			:
4962306a36Sopenharmony_ci			: "i" (ALLOWINT)
5062306a36Sopenharmony_ci			: "memory");
5162306a36Sopenharmony_ci#endif
5262306a36Sopenharmony_ci}
5362306a36Sopenharmony_ci
5462306a36Sopenharmony_cistatic inline unsigned long arch_local_irq_save(void)
5562306a36Sopenharmony_ci{
5662306a36Sopenharmony_ci	unsigned long flags = arch_local_save_flags();
5762306a36Sopenharmony_ci	arch_local_irq_disable();
5862306a36Sopenharmony_ci	return flags;
5962306a36Sopenharmony_ci}
6062306a36Sopenharmony_ci
6162306a36Sopenharmony_cistatic inline void arch_local_irq_restore(unsigned long flags)
6262306a36Sopenharmony_ci{
6362306a36Sopenharmony_ci	asm volatile ("movew %0,%%sr" : : "d" (flags) : "memory");
6462306a36Sopenharmony_ci}
6562306a36Sopenharmony_ci
6662306a36Sopenharmony_cistatic inline bool arch_irqs_disabled_flags(unsigned long flags)
6762306a36Sopenharmony_ci{
6862306a36Sopenharmony_ci	if (MACH_IS_ATARI) {
6962306a36Sopenharmony_ci		/* Ignore HSYNC = ipl 2 on Atari */
7062306a36Sopenharmony_ci		return (flags & ~(ALLOWINT | 0x200)) != 0;
7162306a36Sopenharmony_ci	}
7262306a36Sopenharmony_ci	return (flags & ~ALLOWINT) != 0;
7362306a36Sopenharmony_ci}
7462306a36Sopenharmony_ci
7562306a36Sopenharmony_cistatic inline bool arch_irqs_disabled(void)
7662306a36Sopenharmony_ci{
7762306a36Sopenharmony_ci	return arch_irqs_disabled_flags(arch_local_save_flags());
7862306a36Sopenharmony_ci}
7962306a36Sopenharmony_ci
8062306a36Sopenharmony_ci#endif /* _M68K_IRQFLAGS_H */
81