mirror of
				https://git.kernel.org/pub/scm/linux/kernel/git/chenhuacai/linux-loongson
				synced 2025-10-28 00:53:45 +00:00 
			
		
		
		
	
		
			
				
	
	
		
			344 lines
		
	
	
		
			9.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			344 lines
		
	
	
		
			9.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| #ifndef _ASM_M32R_SYSTEM_H
 | |
| #define _ASM_M32R_SYSTEM_H
 | |
| 
 | |
| /*
 | |
|  * 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.
 | |
|  *
 | |
|  * Copyright (C) 2001  Hiroyuki Kondo, Hirokazu Takata, and Hitoshi Yamamoto
 | |
|  * Copyright (C) 2004, 2006  Hirokazu Takata <takata at linux-m32r.org>
 | |
|  */
 | |
| 
 | |
| #include <asm/assembler.h>
 | |
| 
 | |
| #ifdef __KERNEL__
 | |
| 
 | |
| /*
 | |
|  * switch_to(prev, next) should switch from task `prev' to `next'
 | |
|  * `prev' will never be the same as `next'.
 | |
|  *
 | |
|  * `next' and `prev' should be task_t, but it isn't always defined
 | |
|  */
 | |
| 
 | |
| #define switch_to(prev, next, last)  do { \
 | |
| 	__asm__ __volatile__ ( \
 | |
| 		"	seth	lr, #high(1f)				\n" \
 | |
| 		"	or3	lr, lr, #low(1f)			\n" \
 | |
| 		"	st	lr, @%4  ; store old LR			\n" \
 | |
| 		"	ld	lr, @%5  ; load new LR			\n" \
 | |
| 		"	st	sp, @%2  ; store old SP			\n" \
 | |
| 		"	ld	sp, @%3  ; load new SP			\n" \
 | |
| 		"	push	%1  ; store `prev' on new stack		\n" \
 | |
| 		"	jmp	lr					\n" \
 | |
| 		"	.fillinsn					\n" \
 | |
| 		"1:							\n" \
 | |
| 		"	pop	%0  ; restore `__last' from new stack	\n" \
 | |
| 		: "=r" (last) \
 | |
| 		: "0" (prev), \
 | |
| 		  "r" (&(prev->thread.sp)), "r" (&(next->thread.sp)), \
 | |
| 		  "r" (&(prev->thread.lr)), "r" (&(next->thread.lr)) \
 | |
| 		: "memory", "lr" \
 | |
| 	); \
 | |
| } while(0)
 | |
| 
 | |
| /*
 | |
|  * On SMP systems, when the scheduler does migration-cost autodetection,
 | |
|  * it needs a way to flush as much of the CPU's caches as possible.
 | |
|  *
 | |
|  * TODO: fill this in!
 | |
|  */
 | |
| static inline void sched_cacheflush(void)
 | |
| {
 | |
| }
 | |
| 
 | |
| /* Interrupt Control */
 | |
| #if !defined(CONFIG_CHIP_M32102) && !defined(CONFIG_CHIP_M32104)
 | |
| #define local_irq_enable() \
 | |
| 	__asm__ __volatile__ ("setpsw #0x40 -> nop": : :"memory")
 | |
| #define local_irq_disable() \
 | |
| 	__asm__ __volatile__ ("clrpsw #0x40 -> nop": : :"memory")
 | |
| #else	/* CONFIG_CHIP_M32102 || CONFIG_CHIP_M32104 */
 | |
| static inline void local_irq_enable(void)
 | |
| {
 | |
| 	unsigned long tmpreg;
 | |
| 	__asm__ __volatile__(
 | |
| 		"mvfc	%0, psw;		\n\t"
 | |
| 		"or3	%0, %0, #0x0040;	\n\t"
 | |
| 		"mvtc	%0, psw;		\n\t"
 | |
| 	: "=&r" (tmpreg) : : "cbit", "memory");
 | |
| }
 | |
| 
 | |
| static inline void local_irq_disable(void)
 | |
| {
 | |
| 	unsigned long tmpreg0, tmpreg1;
 | |
| 	__asm__ __volatile__(
 | |
| 		"ld24	%0, #0	; Use 32-bit insn. \n\t"
 | |
| 		"mvfc	%1, psw	; No interrupt can be accepted here. \n\t"
 | |
| 		"mvtc	%0, psw	\n\t"
 | |
| 		"and3	%0, %1, #0xffbf	\n\t"
 | |
| 		"mvtc	%0, psw	\n\t"
 | |
| 	: "=&r" (tmpreg0), "=&r" (tmpreg1) : : "cbit", "memory");
 | |
| }
 | |
| #endif	/* CONFIG_CHIP_M32102 || CONFIG_CHIP_M32104 */
 | |
| 
 | |
| #define local_save_flags(x) \
 | |
| 	__asm__ __volatile__("mvfc %0,psw" : "=r"(x) : /* no input */)
 | |
| 
 | |
| #define local_irq_restore(x) \
 | |
| 	__asm__ __volatile__("mvtc %0,psw" : /* no outputs */ \
 | |
| 		: "r" (x) : "cbit", "memory")
 | |
| 
 | |
| #if !(defined(CONFIG_CHIP_M32102) || defined(CONFIG_CHIP_M32104))
 | |
| #define local_irq_save(x)				\
 | |
| 	__asm__ __volatile__(				\
 | |
|   		"mvfc	%0, psw;		\n\t"	\
 | |
| 	  	"clrpsw	#0x40 -> nop;		\n\t"	\
 | |
|   		: "=r" (x) : /* no input */ : "memory")
 | |
| #else	/* CONFIG_CHIP_M32102 || CONFIG_CHIP_M32104 */
 | |
| #define local_irq_save(x) 				\
 | |
| 	({						\
 | |
| 		unsigned long tmpreg;			\
 | |
| 		__asm__ __volatile__( 			\
 | |
| 			"ld24	%1, #0 \n\t" 		\
 | |
| 			"mvfc	%0, psw \n\t"		\
 | |
| 			"mvtc	%1, psw \n\t"		\
 | |
| 			"and3	%1, %0, #0xffbf \n\t"	\
 | |
| 			"mvtc	%1, psw \n\t" 		\
 | |
| 			: "=r" (x), "=&r" (tmpreg)	\
 | |
| 			: : "cbit", "memory");		\
 | |
| 	})
 | |
| #endif	/* CONFIG_CHIP_M32102 || CONFIG_CHIP_M32104 */
 | |
| 
 | |
| #define irqs_disabled()					\
 | |
| 	({						\
 | |
| 		unsigned long flags;			\
 | |
| 		local_save_flags(flags);		\
 | |
| 		!(flags & 0x40);			\
 | |
| 	})
 | |
| 
 | |
| #define nop()	__asm__ __volatile__ ("nop" : : )
 | |
| 
 | |
| #define xchg(ptr,x) \
 | |
| 	((__typeof__(*(ptr)))__xchg((unsigned long)(x),(ptr),sizeof(*(ptr))))
 | |
| 
 | |
| #define tas(ptr)	(xchg((ptr),1))
 | |
| 
 | |
| #ifdef CONFIG_SMP
 | |
| extern void  __xchg_called_with_bad_pointer(void);
 | |
| #endif
 | |
| 
 | |
| #ifdef CONFIG_CHIP_M32700_TS1
 | |
| #define DCACHE_CLEAR(reg0, reg1, addr)				\
 | |
| 	"seth	"reg1", #high(dcache_dummy);		\n\t"	\
 | |
| 	"or3	"reg1", "reg1", #low(dcache_dummy);	\n\t"	\
 | |
| 	"lock	"reg0", @"reg1";			\n\t"	\
 | |
| 	"add3	"reg0", "addr", #0x1000;		\n\t"	\
 | |
| 	"ld	"reg0", @"reg0";			\n\t"	\
 | |
| 	"add3	"reg0", "addr", #0x2000;		\n\t"	\
 | |
| 	"ld	"reg0", @"reg0";			\n\t"	\
 | |
| 	"unlock	"reg0", @"reg1";			\n\t"
 | |
| 	/* FIXME: This workaround code cannot handle kenrel modules
 | |
| 	 * correctly under SMP environment.
 | |
| 	 */
 | |
| #else	/* CONFIG_CHIP_M32700_TS1 */
 | |
| #define DCACHE_CLEAR(reg0, reg1, addr)
 | |
| #endif	/* CONFIG_CHIP_M32700_TS1 */
 | |
| 
 | |
| static inline unsigned long
 | |
| __xchg(unsigned long x, volatile void * ptr, int size)
 | |
| {
 | |
| 	unsigned long flags;
 | |
| 	unsigned long tmp = 0;
 | |
| 
 | |
| 	local_irq_save(flags);
 | |
| 
 | |
| 	switch (size) {
 | |
| #ifndef CONFIG_SMP
 | |
| 	case 1:
 | |
| 		__asm__ __volatile__ (
 | |
| 			"ldb	%0, @%2 \n\t"
 | |
| 			"stb	%1, @%2 \n\t"
 | |
| 			: "=&r" (tmp) : "r" (x), "r" (ptr) : "memory");
 | |
| 		break;
 | |
| 	case 2:
 | |
| 		__asm__ __volatile__ (
 | |
| 			"ldh	%0, @%2 \n\t"
 | |
| 			"sth	%1, @%2 \n\t"
 | |
| 			: "=&r" (tmp) : "r" (x), "r" (ptr) : "memory");
 | |
| 		break;
 | |
| 	case 4:
 | |
| 		__asm__ __volatile__ (
 | |
| 			"ld	%0, @%2 \n\t"
 | |
| 			"st	%1, @%2 \n\t"
 | |
| 			: "=&r" (tmp) : "r" (x), "r" (ptr) : "memory");
 | |
| 		break;
 | |
| #else  /* CONFIG_SMP */
 | |
| 	case 4:
 | |
| 		__asm__ __volatile__ (
 | |
| 			DCACHE_CLEAR("%0", "r4", "%2")
 | |
| 			"lock	%0, @%2;	\n\t"
 | |
| 			"unlock	%1, @%2;	\n\t"
 | |
| 			: "=&r" (tmp) : "r" (x), "r" (ptr)
 | |
| 			: "memory"
 | |
| #ifdef CONFIG_CHIP_M32700_TS1
 | |
| 			, "r4"
 | |
| #endif	/* CONFIG_CHIP_M32700_TS1 */
 | |
| 		);
 | |
| 		break;
 | |
| 	default:
 | |
| 		__xchg_called_with_bad_pointer();
 | |
| #endif  /* CONFIG_SMP */
 | |
| 	}
 | |
| 
 | |
| 	local_irq_restore(flags);
 | |
| 
 | |
| 	return (tmp);
 | |
| }
 | |
| 
 | |
| #define __HAVE_ARCH_CMPXCHG	1
 | |
| 
 | |
| static inline unsigned long
 | |
| __cmpxchg_u32(volatile unsigned int *p, unsigned int old, unsigned int new)
 | |
| {
 | |
| 	unsigned long flags;
 | |
| 	unsigned int retval;
 | |
| 
 | |
| 	local_irq_save(flags);
 | |
| 	__asm__ __volatile__ (
 | |
| 			DCACHE_CLEAR("%0", "r4", "%1")
 | |
| 			M32R_LOCK" %0, @%1;	\n"
 | |
| 		"	bne	%0, %2, 1f;	\n"
 | |
| 			M32R_UNLOCK" %3, @%1;	\n"
 | |
| 		"	bra	2f;		\n"
 | |
|                 "       .fillinsn		\n"
 | |
| 		"1:"
 | |
| 			M32R_UNLOCK" %0, @%1;	\n"
 | |
|                 "       .fillinsn		\n"
 | |
| 		"2:"
 | |
| 			: "=&r" (retval)
 | |
| 			: "r" (p), "r" (old), "r" (new)
 | |
| 			: "cbit", "memory"
 | |
| #ifdef CONFIG_CHIP_M32700_TS1
 | |
| 			, "r4"
 | |
| #endif  /* CONFIG_CHIP_M32700_TS1 */
 | |
| 		);
 | |
| 	local_irq_restore(flags);
 | |
| 
 | |
| 	return retval;
 | |
| }
 | |
| 
 | |
| /* This function doesn't exist, so you'll get a linker error
 | |
|    if something tries to do an invalid cmpxchg().  */
 | |
| extern void __cmpxchg_called_with_bad_pointer(void);
 | |
| 
 | |
| static inline unsigned long
 | |
| __cmpxchg(volatile void *ptr, unsigned long old, unsigned long new, int size)
 | |
| {
 | |
| 	switch (size) {
 | |
| 	case 4:
 | |
| 		return __cmpxchg_u32(ptr, old, new);
 | |
| #if 0	/* we don't have __cmpxchg_u64 */
 | |
| 	case 8:
 | |
| 		return __cmpxchg_u64(ptr, old, new);
 | |
| #endif /* 0 */
 | |
| 	}
 | |
| 	__cmpxchg_called_with_bad_pointer();
 | |
| 	return old;
 | |
| }
 | |
| 
 | |
| #define cmpxchg(ptr,o,n)						 \
 | |
|   ({									 \
 | |
|      __typeof__(*(ptr)) _o_ = (o);					 \
 | |
|      __typeof__(*(ptr)) _n_ = (n);					 \
 | |
|      (__typeof__(*(ptr))) __cmpxchg((ptr), (unsigned long)_o_,		 \
 | |
| 				    (unsigned long)_n_, sizeof(*(ptr))); \
 | |
|   })
 | |
| 
 | |
| #endif  /* __KERNEL__ */
 | |
| 
 | |
| /*
 | |
|  * Memory barrier.
 | |
|  *
 | |
|  * mb() prevents loads and stores being reordered across this point.
 | |
|  * rmb() prevents loads being reordered across this point.
 | |
|  * wmb() prevents stores being reordered across this point.
 | |
|  */
 | |
| #define mb()   barrier()
 | |
| #define rmb()  mb()
 | |
| #define wmb()  mb()
 | |
| 
 | |
| /**
 | |
|  * read_barrier_depends - Flush all pending reads that subsequents reads
 | |
|  * depend on.
 | |
|  *
 | |
|  * No data-dependent reads from memory-like regions are ever reordered
 | |
|  * over this barrier.  All reads preceding this primitive are guaranteed
 | |
|  * to access memory (but not necessarily other CPUs' caches) before any
 | |
|  * reads following this primitive that depend on the data return by
 | |
|  * any of the preceding reads.  This primitive is much lighter weight than
 | |
|  * rmb() on most CPUs, and is never heavier weight than is
 | |
|  * rmb().
 | |
|  *
 | |
|  * These ordering constraints are respected by both the local CPU
 | |
|  * and the compiler.
 | |
|  *
 | |
|  * Ordering is not guaranteed by anything other than these primitives,
 | |
|  * not even by data dependencies.  See the documentation for
 | |
|  * memory_barrier() for examples and URLs to more information.
 | |
|  *
 | |
|  * For example, the following code would force ordering (the initial
 | |
|  * value of "a" is zero, "b" is one, and "p" is "&a"):
 | |
|  *
 | |
|  * <programlisting>
 | |
|  *      CPU 0                           CPU 1
 | |
|  *
 | |
|  *      b = 2;
 | |
|  *      memory_barrier();
 | |
|  *      p = &b;                         q = p;
 | |
|  *                                      read_barrier_depends();
 | |
|  *                                      d = *q;
 | |
|  * </programlisting>
 | |
|  *
 | |
|  *
 | |
|  * because the read of "*q" depends on the read of "p" and these
 | |
|  * two reads are separated by a read_barrier_depends().  However,
 | |
|  * the following code, with the same initial values for "a" and "b":
 | |
|  *
 | |
|  * <programlisting>
 | |
|  *      CPU 0                           CPU 1
 | |
|  *
 | |
|  *      a = 2;
 | |
|  *      memory_barrier();
 | |
|  *      b = 3;                          y = b;
 | |
|  *                                      read_barrier_depends();
 | |
|  *                                      x = a;
 | |
|  * </programlisting>
 | |
|  *
 | |
|  * does not enforce ordering, since there is no data dependency between
 | |
|  * the read of "a" and the read of "b".  Therefore, on some CPUs, such
 | |
|  * as Alpha, "y" could be set to 3 and "x" to 0.  Use rmb()
 | |
|  * in cases like thiswhere there are no data dependencies.
 | |
|  **/
 | |
| 
 | |
| #define read_barrier_depends()	do { } while (0)
 | |
| 
 | |
| #ifdef CONFIG_SMP
 | |
| #define smp_mb()	mb()
 | |
| #define smp_rmb()	rmb()
 | |
| #define smp_wmb()	wmb()
 | |
| #define smp_read_barrier_depends()	read_barrier_depends()
 | |
| #else
 | |
| #define smp_mb()	barrier()
 | |
| #define smp_rmb()	barrier()
 | |
| #define smp_wmb()	barrier()
 | |
| #define smp_read_barrier_depends()	do { } while (0)
 | |
| #endif
 | |
| 
 | |
| #define set_mb(var, value) do { xchg(&var, value); } while (0)
 | |
| #define set_wmb(var, value) do { var = value; wmb(); } while (0)
 | |
| 
 | |
| #define arch_align_stack(x) (x)
 | |
| 
 | |
| #endif  /* _ASM_M32R_SYSTEM_H */
 | 
