162306a36Sopenharmony_ci/*
262306a36Sopenharmony_ci * This file is subject to the terms and conditions of the GNU General Public
362306a36Sopenharmony_ci * License.  See the file "COPYING" in the main directory of this archive
462306a36Sopenharmony_ci * for more details.
562306a36Sopenharmony_ci *
662306a36Sopenharmony_ci * Copyright (C) 1994 by Waldorf Electronics
762306a36Sopenharmony_ci * Copyright (C) 1995 - 2000, 01, 03 by Ralf Baechle
862306a36Sopenharmony_ci * Copyright (C) 1999, 2000 Silicon Graphics, Inc.
962306a36Sopenharmony_ci * Copyright (C) 2007, 2014 Maciej W. Rozycki
1062306a36Sopenharmony_ci */
1162306a36Sopenharmony_ci#include <linux/delay.h>
1262306a36Sopenharmony_ci#include <linux/export.h>
1362306a36Sopenharmony_ci#include <linux/param.h>
1462306a36Sopenharmony_ci#include <linux/smp.h>
1562306a36Sopenharmony_ci#include <linux/stringify.h>
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_ci#include <asm/asm.h>
1862306a36Sopenharmony_ci#include <asm/compiler.h>
1962306a36Sopenharmony_ci
2062306a36Sopenharmony_ci#ifndef CONFIG_CPU_DADDI_WORKAROUNDS
2162306a36Sopenharmony_ci#define GCC_DADDI_IMM_ASM() "I"
2262306a36Sopenharmony_ci#else
2362306a36Sopenharmony_ci#define GCC_DADDI_IMM_ASM() "r"
2462306a36Sopenharmony_ci#endif
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_ci#ifndef CONFIG_HAVE_PLAT_DELAY
2762306a36Sopenharmony_ci
2862306a36Sopenharmony_civoid __delay(unsigned long loops)
2962306a36Sopenharmony_ci{
3062306a36Sopenharmony_ci	__asm__ __volatile__ (
3162306a36Sopenharmony_ci	"	.set	noreorder				\n"
3262306a36Sopenharmony_ci	"	.align	3					\n"
3362306a36Sopenharmony_ci	"1:	bnez	%0, 1b					\n"
3462306a36Sopenharmony_ci	"	 " __stringify(LONG_SUBU) "	%0, %1		\n"
3562306a36Sopenharmony_ci	"	.set	reorder					\n"
3662306a36Sopenharmony_ci	: "=r" (loops)
3762306a36Sopenharmony_ci	: GCC_DADDI_IMM_ASM() (1), "0" (loops));
3862306a36Sopenharmony_ci}
3962306a36Sopenharmony_ciEXPORT_SYMBOL(__delay);
4062306a36Sopenharmony_ci
4162306a36Sopenharmony_ci/*
4262306a36Sopenharmony_ci * Division by multiplication: you don't have to worry about
4362306a36Sopenharmony_ci * loss of precision.
4462306a36Sopenharmony_ci *
4562306a36Sopenharmony_ci * Use only for very small delays ( < 1 msec).	Should probably use a
4662306a36Sopenharmony_ci * lookup table, really, as the multiplications take much too long with
4762306a36Sopenharmony_ci * short delays.  This is a "reasonable" implementation, though (and the
4862306a36Sopenharmony_ci * first constant multiplications gets optimized away if the delay is
4962306a36Sopenharmony_ci * a constant)
5062306a36Sopenharmony_ci */
5162306a36Sopenharmony_ci
5262306a36Sopenharmony_civoid __udelay(unsigned long us)
5362306a36Sopenharmony_ci{
5462306a36Sopenharmony_ci	unsigned int lpj = raw_current_cpu_data.udelay_val;
5562306a36Sopenharmony_ci
5662306a36Sopenharmony_ci	__delay((us * 0x000010c7ull * HZ * lpj) >> 32);
5762306a36Sopenharmony_ci}
5862306a36Sopenharmony_ciEXPORT_SYMBOL(__udelay);
5962306a36Sopenharmony_ci
6062306a36Sopenharmony_civoid __ndelay(unsigned long ns)
6162306a36Sopenharmony_ci{
6262306a36Sopenharmony_ci	unsigned int lpj = raw_current_cpu_data.udelay_val;
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_ci	__delay((ns * 0x00000005ull * HZ * lpj) >> 32);
6562306a36Sopenharmony_ci}
6662306a36Sopenharmony_ciEXPORT_SYMBOL(__ndelay);
6762306a36Sopenharmony_ci
6862306a36Sopenharmony_ci#endif
69