Subversion Repositories or1k

#ifndef _M68K_SEGMENT_H
#define _M68K_SEGMENT_H
 
/* define constants */
/* Address spaces (FC0-FC2) */
#define USER_DATA     (1)
#ifndef USER_DS
#define USER_DS       (USER_DATA)
#endif
#define USER_PROGRAM  (2)
#define SUPER_DATA    (5)
#ifndef KERNEL_DS
#define KERNEL_DS     (SUPER_DATA)
#endif
#define SUPER_PROGRAM (6)
#define CPU_SPACE     (7)
 
#ifndef __ASSEMBLY__
 
/*
 * Uh, these should become the main single-value transfer routines..
 * They automatically use the right size if we just have the right
 * pointer type..
 */
#define put_user(x,ptr) __put_user((unsigned long)(x),(ptr),sizeof(*(ptr)))
#define get_user(ptr) ((__typeof__(*(ptr)))__get_user((ptr),sizeof(*(ptr))))
 
/*
 * This is a silly but good way to make sure that
 * the __put_user function is indeed always optimized,
 * and that we use the correct sizes..
 */
extern int bad_user_access_length(void);
 
#define __ptr(x) ((unsigned long *)(x))
 
static inline void __put_user(unsigned long x, void * y, int size)
{
	switch (size) {
		case 1:
			__asm__ ("movesb %0,%1"
				: /* no outputs */
				:"r" (x),"m" (*__ptr(y)) : "memory");
			break;
		case 2:
			__asm__ ("movesw %0,%1"
				: /* no outputs */
				:"r" (x),"m" (*__ptr(y)) : "memory");
			break;
		case 4:
			__asm__ ("movesl %0,%1"
				: /* no outputs */
				:"r" (x),"m" (*__ptr(y)) : "memory");
			break;
		default:
			bad_user_access_length();
	}
}
 
static inline unsigned long __get_user(const void * y, int size)
{
	unsigned long result;
 
	switch (size) {
		case 1:
			__asm__ ("movesb %1,%0"
				 :"=r" (result)
				 :"m" (*__ptr(y)));
			return (unsigned char) result;
		case 2:
			__asm__ ("movesw %1,%0"
				 :"=r" (result)
				 :"m" (*__ptr(y)));
			return (unsigned short) result;
		case 4:
			__asm__ ("movesl %1,%0"
				 :"=r" (result)
				 :"m" (*__ptr(y)));
			return result;
		default:
			return bad_user_access_length();
	}
}
#undef __ptr
 
/*
 * These are deprecated..
 *
 * Use "put_user()" and "get_user()" with the proper pointer types instead.
 */
 
#define get_fs_byte(addr) __get_user((const unsigned char *)(addr),1)
#define get_fs_word(addr) __get_user((const unsigned short *)(addr),2)
#define get_fs_long(addr) __get_user((const unsigned int *)(addr),4)
 
#define put_fs_byte(x,addr) __put_user((x),(unsigned char *)(addr),1)
#define put_fs_word(x,addr) __put_user((x),(unsigned short *)(addr),2)
#define put_fs_long(x,addr) __put_user((x),(unsigned int *)(addr),4)
 
#ifdef WE_REALLY_WANT_TO_USE_A_BROKEN_INTERFACE
 
static inline unsigned char get_user_byte(const char * addr)
{
	return __get_user(addr,1);
}
 
static inline unsigned short get_user_word(const short *addr)
{
	return __get_user(addr,2);
}
 
static inline unsigned long get_user_long(const int *addr)
{
	return __get_user(addr,4);
}
 
static inline void put_user_byte(char val,char *addr)
{
	__put_user(val, addr, 1);
}
 
static inline void put_user_word(short val,short * addr)
{
	__put_user(val, addr, 2);
}
 
static inline void put_user_long(unsigned long val,int * addr)
{
	__put_user(val, addr, 4);
}
 
#endif
 
static inline void __generic_memcpy_tofs(void * to, const void * from, unsigned long n)
{
	unsigned long tmp;
	if (n == 0) return;
	tmp = n;
	n >>= 2;
	if (n != 0)
		__asm__ ("1:\t"
			 "movel %1@+,%/d0\n\t"
			 "movesl %/d0,%2@+\n\t"
			      "dbra %0,1b\n\t"
			      "clrw %0\n\t"
			      "subql #1,%0\n\t"
			 "bccs 1b\n\t"
			      : "=d" (n), "=a" (from), "=a" (to)
			 : "0" (n-1), "1" (from), "2" (to)
			 : "d0", "memory");
	if (tmp & 2)
		__asm__ ("movew %0@+,%/d0\n\t"
			 "movesw %/d0,%1@+\n\t"
			 : "=a" (from), "=a" (to)
			 : "0" (from), "1" (to)
			 : "d0", "memory");
	if (tmp & 1)
		__asm__ __volatile__ ("moveb %0@,%/d0\n\t"
			 "movesb %/d0,%1@\n\t"
			 : /* no outputs */
			 : "a" (from), "a" (to)
			      : "d0", "memory");
}
 
static inline void __constant_memcpy_tofs(void * to, const void * from, unsigned long n)
{
	switch (n) {
		case 0:
			return;
		case 1:
			__put_user(*(const char *) from, (char *) to, 1);
			return;
		case 2:
			__put_user(*(const short *) from, (short *) to, 2);
			return;
		case 3:
			__put_user(*(const short *) from, (short *) to, 2);
			__put_user(*(2+(const char *) from), 2+(char *) to, 1);
			return;
		case 4:
			__put_user(*(const int *) from, (int *) to, 4);
			return;
		case 8:
			__put_user(*(const int *) from, (int *) to, 4);
			__put_user(*(1+(const int *) from), 1+(int *) to, 4);
			return;
		case 12:
			__put_user(*(const int *) from, (int *) to, 4);
			__put_user(*(1+(const int *) from), 1+(int *) to, 4);
			__put_user(*(2+(const int *) from), 2+(int *) to, 4);
			return;
		case 16:
			__put_user(*(const int *) from, (int *) to, 4);
			__put_user(*(1+(const int *) from), 1+(int *) to, 4);
			__put_user(*(2+(const int *) from), 2+(int *) to, 4);
			__put_user(*(3+(const int *) from), 3+(int *) to, 4);
			return;
	}
#define COMMON(x)                     \
__asm__ __volatile__ ("1:\n\t"        \
            "movel %1@+,%/d0\n\t"     \
            "movesl %/d0,%2@+\n\t"    \
            "dbra %0,1b\n\t"          \
            "clrw %0\n\t"             \
            "subql #1,%0\n\t"         \
            "bccs 1b\n\t"             \
            x                     \
            : "=d" (n), "=a" (from), "=a" (to)    \
            : "1" (from), "2" (to), "0" (n/4-1)   \
            : "d0", "memory");
 
  switch (n % 4) {
      case 0:
          COMMON("");
          return;
      case 1:
          COMMON("moveb %1@+,%/d0; movesb %/d0,%2@+");
          return;
      case 2:
          COMMON("movew %1@+,%/d0; movesw %/d0,%2@+");
          return;
      case 3:
          COMMON("movew %1@+,%/d0; movesw %/d0,%2@+\n\t"
                 "moveb %1@+,%/d0; movesb %/d0,%2@+");
          return;
  }
#undef COMMON
}
 
static inline void __generic_memcpy_fromfs(void * to, const void * from, unsigned long n)
{
	unsigned long tmp;
	if (n == 0) return;
	tmp = n;
	n >>= 2;
	if (n != 0)
		__asm__ ("1:\t"
			 "movesl %1@+,%/d0\n\t"
			 "movel %/d0,%2@+\n\t"
			      "dbra %0,1b\n\t"
			      "clrw %0\n\t"
			      "subql #1,%0\n\t"
			 "bccs 1b\n\t"
			      : "=d" (n), "=a" (from), "=a" (to)
			 : "0" (n-1), "1" (from), "2" (to)
			 : "d0", "memory");
	if (tmp & 2)
		__asm__ ("movesw %0@+,%/d0\n\t"
			 "movew %/d0,%1@+\n\t"
			 : "=a" (from), "=a" (to)
			 : "0" (from), "1" (to)
			 : "d0", "memory");
	if (tmp & 1)
		__asm__ __volatile__ ("movesb %0@,%/d0\n\t"
			 "moveb %/d0,%1@\n\t"
			 : /* no outputs */
			 : "a" (from), "a" (to)
			      : "d0", "memory");
}
 
static inline void __constant_memcpy_fromfs(void * to, const void * from, unsigned long n)
{
	switch (n) {
		case 0:
			return;
		case 1:
			*(char *)to = __get_user((const char *) from, 1);
			return;
		case 2:
			*(short *)to = __get_user((const short *) from, 2);
			return;
		case 3:
			*(short *) to = __get_user((const short *) from, 2);
			*((char *) to + 2) = __get_user(2+(const char *) from, 1);
			return;
		case 4:
			*(int *) to = __get_user((const int *) from, 4);
			return;
		case 8:
			*(int *) to = __get_user((const int *) from, 4);
			*(1+(int *) to) = __get_user(1+(const int *) from, 4);
			return;
		case 12:
			*(int *) to = __get_user((const int *) from, 4);
			*(1+(int *) to) = __get_user(1+(const int *) from, 4);
			*(2+(int *) to) = __get_user(2+(const int *) from, 4);
			return;
		case 16:
			*(int *) to = __get_user((const int *) from, 4);
			*(1+(int *) to) = __get_user(1+(const int *) from, 4);
			*(2+(int *) to) = __get_user(2+(const int *) from, 4);
			*(3+(int *) to) = __get_user(3+(const int *) from, 4);
			return;
	}
#define COMMON(x)                     \
__asm__ __volatile__ ("1:\n\t"        \
            "movesl %1@+,%/d0\n\t"    \
            "movel %/d0,%2@+\n\t"     \
            "dbra %0,1b\n\t"          \
            "clrw %0\n\t"             \
            "subql #1,%0\n\t"         \
            "bccs 1b\n\t"             \
            x                         \
            : "=d" (n), "=a" (from), "=a" (to)    \
            : "1" (from), "2" (to), "0" (n/4-1)   \
            : "d0", "memory");
 
  switch (n % 4) {
      case 0:
          COMMON("");
          return;
      case 1:
          COMMON("movesb %1@+,%/d0; moveb %/d0,%2@+");
          return;
      case 2:
          COMMON("movesw %1@+,%/d0; movew %/d0,%2@+");
          return;
      case 3:
          COMMON("movesw %1@+,%/d0; movew %/d0,%2@+\n\t"
                 "movesb %1@+,%/d0; moveb %/d0,%2@+");
          return;
  }
#undef COMMON
}
 
#define memcpy_fromfs(to, from, n) \
(__builtin_constant_p(n) ? \
 __constant_memcpy_fromfs((to),(from),(n)) : \
 __generic_memcpy_fromfs((to),(from),(n)))
 
#define memcpy_tofs(to, from, n) \
(__builtin_constant_p(n) ? \
 __constant_memcpy_tofs((to),(from),(n)) : \
 __generic_memcpy_tofs((to),(from),(n)))
 
/*
 * Get/set the SFC/DFC registers for MOVES instructions
 */
 
static inline unsigned long get_fs(void)
{
	unsigned long _v;
	__asm__ ("movec %/dfc,%0":"=r" (_v):);
 
	return _v;
}
 
static inline unsigned long get_ds(void)
{
    /* return the supervisor data space code */
    return KERNEL_DS;
}
 
static inline void set_fs(unsigned long val)
{
	__asm__ __volatile__ ("movec %0,%/sfc\n\t"
			      "movec %0,%/dfc\n\t"
			      : /* no outputs */ : "r" (val) : "memory");
}
 
#endif /* __ASSEMBLY__ */
 
#endif /* _M68K_SEGMENT_H */