Subversion Repositories c0or1k

/*
 * Low-level irq routines.
 *
 * Copyright (C) 2010 B Labs Ltd.
 * Written by  Bahadir Balban
 * Prem Mallappa <prem.mallappa@b-labs.co.uk>
 */
 
void irq_local_disable_save(unsigned long *state)
{
	unsigned int tmp;
	__asm__ __volatile__ (
		"mrs %0, cpsr_fc \n"
		"cpsid ia \n"
		: "=r"(tmp)
		:
		: "cc"
		);
	*state = tmp;
}
 
void irq_local_restore(unsigned long state)
{
	__asm__ __volatile__ (
		"msr cpsr_fc, %0\n"
		:
		: "r"(state)
		: "cc"
		);
}
 
u8 l4_atomic_dest_readb(u8 *location)
{
	unsigned int tmp, res;
	__asm__ __volatile__ (
		"1: \n"
		"ldrex %0, [%2] \n"
		"strex %1, %3, [%2] \n"
		"teq %1, #0 \n"
		"bne 1b \n"
		: "=&r"(tmp), "=&r"(res)
		: "r"(location), "r"(0)
		: "cc", "memory"
		);
 
	return (u8)tmp;
}
 
int irqs_enabled(void)
{
	int tmp;
	__asm__ __volatile__ (
		"mrs %0, cpsr_fc\n"
		: "=r"(tmp)
		);
	if (tmp & 0x80)
		return 0;
 
	return 1;
}