Subversion Repositories or1k

#ifndef _M68K_DELAY_H
#define _M68K_DELAY_H
 
/*
 * Copyright (C) 1994 Hamish Macdonald
 *
 * Delay routines, using a pre-computed "loops_per_second" value.
 */
 
extern __inline__ void __delay(int loops)
{
	__asm__ __volatile__ ("\n\tmovel %0,%/d0\n1:\tsubql #1,%/d0\n\t"
			      "bpls 1b\n"
		: /* no outputs */
		: "g" (loops)
		: "d0");
}
 
/*
 * Use only for very small delays ( < 1 msec).  Should probably use a
 * lookup table, really, as the multiplications take much too long with
 * short delays.  This is a "reasonable" implementation, though (and the
 * first constant multiplications gets optimized away if the delay is
 * a constant)  
 */
extern __inline__ void udelay(unsigned long usecs)
{
	usecs *= 0x000010c6;		/* 2**32 / 1000000 */
 
	__asm__ __volatile__ ("mulul %1,%0:%2"
	     : "=d" (usecs)
	     : "d" (usecs),
	       "d" (loops_per_sec));
	__delay(usecs);
}
 
extern __inline__ unsigned long muldiv(unsigned long a, unsigned long b, unsigned long c)
{
	__asm__ ("mulul %1,%/d0:%0\n\tdivul %2,%/d0:%0"
		 :"=d" (a)
		 :"d" (b),
		 "d" (c),
		 "0" (a)
		 :"d0");
	return a;
}
 
#endif /* defined(_M68K_DELAY_H) */